/mandos/release

To get this branch, use:
bzr branch http://bzr.recompile.se/loggerhead/mandos/release

« back to all changes in this revision

Viewing changes to plugins.d/mandosclient.c

merge +
mandosclient
        Added a adjustbuffer function.

Show diffs side-by-side

added added

removed removed

Lines of Context:
plugins.d/mandosclient.c
 
1
/*  -*- coding: utf-8 -*- */
 
2
/*
 
3
 * Mandos client - get and decrypt data from a Mandos server
 
4
 *
 
5
 * This program is partly derived from an example program for an Avahi
 
6
 * service browser, downloaded from
 
7
 * <http://avahi.org/browser/examples/core-browse-services.c>.  This
 
8
 * includes the following functions: "resolve_callback",
 
9
 * "browse_callback", and parts of "main".
 
10
 * 
 
11
 * Everything else is
 
12
 * Copyright © 2007-2008 Teddy Hogeborn & Björn Påhlsson
 
13
 * 
 
14
 * This program is free software: you can redistribute it and/or
 
15
 * modify it under the terms of the GNU General Public License as
 
16
 * published by the Free Software Foundation, either version 3 of the
 
17
 * License, or (at your option) any later version.
 
18
 * 
 
19
 * This program is distributed in the hope that it will be useful, but
 
20
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 
21
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 
22
 * General Public License for more details.
 
23
 * 
 
24
 * You should have received a copy of the GNU General Public License
 
25
 * along with this program.  If not, see
 
26
 * <http://www.gnu.org/licenses/>.
 
27
 * 
 
28
 * Contact the authors at <mandos@fukt.bsnet.se>.
 
29
 */
 
30
 
 
31
/* Needed by GPGME, specifically gpgme_data_seek() */
 
32
#define _LARGEFILE_SOURCE
 
33
#define _FILE_OFFSET_BITS 64
 
34
 
 
35
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY() */
 
36
 
 
37
#include <stdio.h>
 
38
#include <assert.h>
 
39
#include <stdlib.h>
 
40
#include <time.h>
 
41
#include <net/if.h>             /* if_nametoindex */
 
42
#include <sys/ioctl.h>          /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
 
43
                                   SIOCSIFFLAGS */
 
44
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
 
45
                                   SIOCSIFFLAGS */
 
46
 
 
47
#include <avahi-core/core.h>
 
48
#include <avahi-core/lookup.h>
 
49
#include <avahi-core/log.h>
 
50
#include <avahi-common/simple-watch.h>
 
51
#include <avahi-common/malloc.h>
 
52
#include <avahi-common/error.h>
 
53
 
 
54
/* Mandos client part */
 
55
#include <sys/types.h>          /* socket(), inet_pton() */
 
56
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
 
57
                                   struct in6_addr, inet_pton() */
 
58
#include <gnutls/gnutls.h>      /* All GnuTLS stuff */
 
59
#include <gnutls/openpgp.h>     /* GnuTLS with openpgp stuff */
 
60
 
 
61
#include <unistd.h>             /* close() */
 
62
#include <netinet/in.h>
 
63
#include <stdbool.h>            /* true */
 
64
#include <string.h>             /* memset */
 
65
#include <arpa/inet.h>          /* inet_pton() */
 
66
#include <iso646.h>             /* not */
 
67
#include <net/if.h>             /* IF_NAMESIZE */
 
68
 
 
69
/* GPGME */
 
70
#include <errno.h>              /* perror() */
 
71
#include <gpgme.h>
 
72
 
 
73
/* getopt_long */
 
74
#include <getopt.h>
 
75
 
 
76
#define BUFFER_SIZE 256
 
77
 
 
78
static const char *keydir = "/conf/conf.d/mandos";
 
79
static const char *pubkeyfile = "pubkey.txt";
 
80
static const char *seckeyfile = "seckey.txt";
 
81
 
 
82
bool debug = false;
 
83
 
 
84
const char mandos_protocol_version[] = "1";
 
85
 
 
86
/* Used for passing in values through all the callback functions */
 
87
typedef struct {
 
88
  AvahiSimplePoll *simple_poll;
 
89
  AvahiServer *server;
 
90
  gnutls_certificate_credentials_t cred;
 
91
  unsigned int dh_bits;
 
92
  const char *priority;
 
93
} mandos_context;
 
94
 
 
95
size_t adjustbuffer(char **buffer, size_t buffer_length,
 
96
                  size_t buffer_capacity){
 
97
  if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
98
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
 
99
    if (buffer == NULL){
 
100
      return 0;
 
101
    }
 
102
    buffer_capacity += BUFFER_SIZE;
 
103
  }
 
104
  return buffer_capacity;
 
105
}
 
106
 
 
107
/* 
 
108
 * Decrypt OpenPGP data using keyrings in HOMEDIR.
 
109
 * Returns -1 on error
 
110
 */
 
111
static ssize_t pgp_packet_decrypt (const char *cryptotext,
 
112
                                   size_t crypto_size,
 
113
                                   char **plaintext,
 
114
                                   const char *homedir){
 
115
  gpgme_data_t dh_crypto, dh_plain;
 
116
  gpgme_ctx_t ctx;
 
117
  gpgme_error_t rc;
 
118
  ssize_t ret;
 
119
  size_t plaintext_capacity = 0;
 
120
  ssize_t plaintext_length = 0;
 
121
  gpgme_engine_info_t engine_info;
 
122
  
 
123
  if (debug){
 
124
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
 
125
  }
 
126
  
 
127
  /* Init GPGME */
 
128
  gpgme_check_version(NULL);
 
129
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
 
130
  if (rc != GPG_ERR_NO_ERROR){
 
131
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
 
132
            gpgme_strsource(rc), gpgme_strerror(rc));
 
133
    return -1;
 
134
  }
 
135
  
 
136
  /* Set GPGME home directory for the OpenPGP engine only */
 
137
  rc = gpgme_get_engine_info (&engine_info);
 
138
  if (rc != GPG_ERR_NO_ERROR){
 
139
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
 
140
            gpgme_strsource(rc), gpgme_strerror(rc));
 
141
    return -1;
 
142
  }
 
143
  while(engine_info != NULL){
 
144
    if(engine_info->protocol == GPGME_PROTOCOL_OpenPGP){
 
145
      gpgme_set_engine_info(GPGME_PROTOCOL_OpenPGP,
 
146
                            engine_info->file_name, homedir);
 
147
      break;
 
148
    }
 
149
    engine_info = engine_info->next;
 
150
  }
 
151
  if(engine_info == NULL){
 
152
    fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
 
153
    return -1;
 
154
  }
 
155
  
 
156
  /* Create new GPGME data buffer from memory cryptotext */
 
157
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
 
158
                               0);
 
159
  if (rc != GPG_ERR_NO_ERROR){
 
160
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
 
161
            gpgme_strsource(rc), gpgme_strerror(rc));
 
162
    return -1;
 
163
  }
 
164
  
 
165
  /* Create new empty GPGME data buffer for the plaintext */
 
166
  rc = gpgme_data_new(&dh_plain);
 
167
  if (rc != GPG_ERR_NO_ERROR){
 
168
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
 
169
            gpgme_strsource(rc), gpgme_strerror(rc));
 
170
    gpgme_data_release(dh_crypto);
 
171
    return -1;
 
172
  }
 
173
  
 
174
  /* Create new GPGME "context" */
 
175
  rc = gpgme_new(&ctx);
 
176
  if (rc != GPG_ERR_NO_ERROR){
 
177
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
 
178
            gpgme_strsource(rc), gpgme_strerror(rc));
 
179
    plaintext_length = -1;
 
180
    goto decrypt_end;
 
181
  }
 
182
  
 
183
  /* Decrypt data from the cryptotext data buffer to the plaintext
 
184
     data buffer */
 
185
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
 
186
  if (rc != GPG_ERR_NO_ERROR){
 
187
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
 
188
            gpgme_strsource(rc), gpgme_strerror(rc));
 
189
    plaintext_length = -1;
 
190
    goto decrypt_end;
 
191
  }
 
192
  
 
193
  if(debug){
 
194
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
 
195
  }
 
196
  
 
197
  if (debug){
 
198
    gpgme_decrypt_result_t result;
 
199
    result = gpgme_op_decrypt_result(ctx);
 
200
    if (result == NULL){
 
201
      fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
202
    } else {
 
203
      fprintf(stderr, "Unsupported algorithm: %s\n",
 
204
              result->unsupported_algorithm);
 
205
      fprintf(stderr, "Wrong key usage: %d\n",
 
206
              result->wrong_key_usage);
 
207
      if(result->file_name != NULL){
 
208
        fprintf(stderr, "File name: %s\n", result->file_name);
 
209
      }
 
210
      gpgme_recipient_t recipient;
 
211
      recipient = result->recipients;
 
212
      if(recipient){
 
213
        while(recipient != NULL){
 
214
          fprintf(stderr, "Public key algorithm: %s\n",
 
215
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
 
216
          fprintf(stderr, "Key ID: %s\n", recipient->keyid);
 
217
          fprintf(stderr, "Secret key available: %s\n",
 
218
                  recipient->status == GPG_ERR_NO_SECKEY
 
219
                  ? "No" : "Yes");
 
220
          recipient = recipient->next;
 
221
        }
 
222
      }
 
223
    }
 
224
  }
 
225
  
 
226
  /* Seek back to the beginning of the GPGME plaintext data buffer */
 
227
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
 
228
    perror("pgpme_data_seek");
 
229
    plaintext_length = -1;
 
230
    goto decrypt_end;
 
231
  }
 
232
  
 
233
  *plaintext = NULL;
 
234
  while(true){
 
235
    plaintext_capacity = adjustbuffer(plaintext, (size_t)plaintext_length,
 
236
                                      plaintext_capacity);
 
237
    if (plaintext_capacity == 0){
 
238
        perror("adjustbuffer");
 
239
        plaintext_length = -1;
 
240
        goto decrypt_end;
 
241
    }
 
242
    
 
243
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
 
244
                          BUFFER_SIZE);
 
245
    /* Print the data, if any */
 
246
    if (ret == 0){
 
247
      /* EOF */
 
248
      break;
 
249
    }
 
250
    if(ret < 0){
 
251
      perror("gpgme_data_read");
 
252
      plaintext_length = -1;
 
253
      goto decrypt_end;
 
254
    }
 
255
    plaintext_length += ret;
 
256
  }
 
257
 
 
258
  if(debug){
 
259
    fprintf(stderr, "Decrypted password is: ");
 
260
    for(ssize_t i = 0; i < plaintext_length; i++){
 
261
      fprintf(stderr, "%02hhX ", (*plaintext)[i]);
 
262
    }
 
263
    fprintf(stderr, "\n");
 
264
  }
 
265
  
 
266
 decrypt_end:
 
267
  
 
268
  /* Delete the GPGME cryptotext data buffer */
 
269
  gpgme_data_release(dh_crypto);
 
270
  
 
271
  /* Delete the GPGME plaintext data buffer */
 
272
  gpgme_data_release(dh_plain);
 
273
  return plaintext_length;
 
274
}
 
275
 
 
276
static const char * safer_gnutls_strerror (int value) {
 
277
  const char *ret = gnutls_strerror (value);
 
278
  if (ret == NULL)
 
279
    ret = "(unknown)";
 
280
  return ret;
 
281
}
 
282
 
 
283
/* GnuTLS log function callback */
 
284
static void debuggnutls(__attribute__((unused)) int level,
 
285
                        const char* string){
 
286
  fprintf(stderr, "GnuTLS: %s", string);
 
287
}
 
288
 
 
289
static int initgnutls(mandos_context *mc, gnutls_session_t *session,
 
290
                      gnutls_dh_params_t *dh_params){
 
291
  int ret;
 
292
  
 
293
  if(debug){
 
294
    fprintf(stderr, "Initializing GnuTLS\n");
 
295
  }
 
296
 
 
297
  if ((ret = gnutls_global_init ())
 
298
      != GNUTLS_E_SUCCESS) {
 
299
    fprintf (stderr, "GnuTLS global_init: %s\n",
 
300
             safer_gnutls_strerror(ret));
 
301
    return -1;
 
302
  }
 
303
  
 
304
  if (debug){
 
305
    /* "Use a log level over 10 to enable all debugging options."
 
306
     * - GnuTLS manual
 
307
     */
 
308
    gnutls_global_set_log_level(11);
 
309
    gnutls_global_set_log_function(debuggnutls);
 
310
  }
 
311
  
 
312
  /* OpenPGP credentials */
 
313
  if ((ret = gnutls_certificate_allocate_credentials (&mc->cred))
 
314
      != GNUTLS_E_SUCCESS) {
 
315
    fprintf (stderr, "GnuTLS memory error: %s\n",
 
316
             safer_gnutls_strerror(ret));
 
317
    return -1;
 
318
  }
 
319
  
 
320
  if(debug){
 
321
    fprintf(stderr, "Attempting to use OpenPGP certificate %s"
 
322
            " and keyfile %s as GnuTLS credentials\n", pubkeyfile,
 
323
            seckeyfile);
 
324
  }
 
325
  
 
326
  ret = gnutls_certificate_set_openpgp_key_file
 
327
    (mc->cred, pubkeyfile, seckeyfile, GNUTLS_OPENPGP_FMT_BASE64);
 
328
  if (ret != GNUTLS_E_SUCCESS) {
 
329
    fprintf(stderr,
 
330
            "Error[%d] while reading the OpenPGP key pair ('%s',"
 
331
            " '%s')\n", ret, pubkeyfile, seckeyfile);
 
332
    fprintf(stdout, "The GnuTLS error is: %s\n",
 
333
            safer_gnutls_strerror(ret));
 
334
    return -1;
 
335
  }
 
336
  
 
337
  /* GnuTLS server initialization */
 
338
  ret = gnutls_dh_params_init(dh_params);
 
339
  if (ret != GNUTLS_E_SUCCESS) {
 
340
    fprintf (stderr, "Error in GnuTLS DH parameter initialization:"
 
341
             " %s\n", safer_gnutls_strerror(ret));
 
342
    return -1;
 
343
  }
 
344
  ret = gnutls_dh_params_generate2(*dh_params, mc->dh_bits);
 
345
  if (ret != GNUTLS_E_SUCCESS) {
 
346
    fprintf (stderr, "Error in GnuTLS prime generation: %s\n",
 
347
             safer_gnutls_strerror(ret));
 
348
    return -1;
 
349
  }
 
350
  
 
351
  gnutls_certificate_set_dh_params(mc->cred, *dh_params);
 
352
  
 
353
  /* GnuTLS session creation */
 
354
  ret = gnutls_init(session, GNUTLS_SERVER);
 
355
  if (ret != GNUTLS_E_SUCCESS){
 
356
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
 
357
            safer_gnutls_strerror(ret));
 
358
  }
 
359
  
 
360
  {
 
361
    const char *err;
 
362
    ret = gnutls_priority_set_direct(*session, mc->priority, &err);
 
363
    if (ret != GNUTLS_E_SUCCESS) {
 
364
      fprintf(stderr, "Syntax error at: %s\n", err);
 
365
      fprintf(stderr, "GnuTLS error: %s\n",
 
366
              safer_gnutls_strerror(ret));
 
367
      return -1;
 
368
    }
 
369
  }
 
370
  
 
371
  ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
 
372
                               mc->cred);
 
373
  if (ret != GNUTLS_E_SUCCESS) {
 
374
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
 
375
            safer_gnutls_strerror(ret));
 
376
    return -1;
 
377
  }
 
378
  
 
379
  /* ignore client certificate if any. */
 
380
  gnutls_certificate_server_set_request (*session,
 
381
                                         GNUTLS_CERT_IGNORE);
 
382
  
 
383
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
 
384
  
 
385
  return 0;
 
386
}
 
387
 
 
388
/* Avahi log function callback */
 
389
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
 
390
                      __attribute__((unused)) const char *txt){}
 
391
 
 
392
/* Called when a Mandos server is found */
 
393
static int start_mandos_communication(const char *ip, uint16_t port,
 
394
                                      AvahiIfIndex if_index,
 
395
                                      mandos_context *mc){
 
396
  int ret, tcp_sd;
 
397
  struct sockaddr_in6 to;
 
398
  char *buffer = NULL;
 
399
  char *decrypted_buffer;
 
400
  size_t buffer_length = 0;
 
401
  size_t buffer_capacity = 0;
 
402
  ssize_t decrypted_buffer_size;
 
403
  size_t written;
 
404
  int retval = 0;
 
405
  char interface[IF_NAMESIZE];
 
406
  gnutls_session_t session;
 
407
  gnutls_dh_params_t dh_params;
 
408
  
 
409
  ret = initgnutls (mc, &session, &dh_params);
 
410
  if (ret != 0){
 
411
    return -1;
 
412
  }
 
413
  
 
414
  if(debug){
 
415
    fprintf(stderr, "Setting up a tcp connection to %s, port %d\n",
 
416
            ip, port);
 
417
  }
 
418
  
 
419
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
 
420
  if(tcp_sd < 0) {
 
421
    perror("socket");
 
422
    return -1;
 
423
  }
 
424
 
 
425
  if(debug){
 
426
    if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
427
      perror("if_indextoname");
 
428
      return -1;
 
429
    }
 
430
    fprintf(stderr, "Binding to interface %s\n", interface);
 
431
  }
 
432
  
 
433
  memset(&to,0,sizeof(to));     /* Spurious warning */
 
434
  to.sin6_family = AF_INET6;
 
435
  /* It would be nice to have a way to detect if we were passed an
 
436
     IPv4 address here.   Now we assume an IPv6 address. */
 
437
  ret = inet_pton(AF_INET6, ip, &to.sin6_addr);
 
438
  if (ret < 0 ){
 
439
    perror("inet_pton");
 
440
    return -1;
 
441
  }
 
442
  if(ret == 0){
 
443
    fprintf(stderr, "Bad address: %s\n", ip);
 
444
    return -1;
 
445
  }
 
446
  to.sin6_port = htons(port);   /* Spurious warning */
 
447
  
 
448
  to.sin6_scope_id = (uint32_t)if_index;
 
449
  
 
450
  if(debug){
 
451
    fprintf(stderr, "Connection to: %s, port %d\n", ip, port);
 
452
    char addrstr[INET6_ADDRSTRLEN] = "";
 
453
    if(inet_ntop(to.sin6_family, &(to.sin6_addr), addrstr,
 
454
                 sizeof(addrstr)) == NULL){
 
455
      perror("inet_ntop");
 
456
    } else {
 
457
      if(strcmp(addrstr, ip) != 0){
 
458
        fprintf(stderr, "Canonical address form: %s\n", addrstr);
 
459
      }
 
460
    }
 
461
  }
 
462
  
 
463
  ret = connect(tcp_sd, (struct sockaddr *) &to, sizeof(to));
 
464
  if (ret < 0){
 
465
    perror("connect");
 
466
    return -1;
 
467
  }
 
468
 
 
469
  const char *out = mandos_protocol_version;
 
470
  written = 0;
 
471
  while (true){
 
472
    size_t out_size = strlen(out);
 
473
    ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
 
474
                                   out_size - written));
 
475
    if (ret == -1){
 
476
      perror("write");
 
477
      retval = -1;
 
478
      goto mandos_end;
 
479
    }
 
480
    written += (size_t)ret;
 
481
    if(written < out_size){
 
482
      continue;
 
483
    } else {
 
484
      if (out == mandos_protocol_version){
 
485
        written = 0;
 
486
        out = "\r\n";
 
487
      } else {
 
488
        break;
 
489
      }
 
490
    }
 
491
  }
 
492
 
 
493
  if(debug){
 
494
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
 
495
  }
 
496
  
 
497
  gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
 
498
  
 
499
  ret = gnutls_handshake (session);
 
500
  
 
501
  if (ret != GNUTLS_E_SUCCESS){
 
502
    if(debug){
 
503
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
 
504
      gnutls_perror (ret);
 
505
    }
 
506
    retval = -1;
 
507
    goto mandos_end;
 
508
  }
 
509
  
 
510
  /* Read OpenPGP packet that contains the wanted password */
 
511
  
 
512
  if(debug){
 
513
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
 
514
            ip);
 
515
  }
 
516
 
 
517
  while(true){
 
518
    buffer_capacity = adjustbuffer(&buffer, buffer_length, buffer_capacity);
 
519
    if (buffer_capacity == 0){
 
520
      perror("adjustbuffer");
 
521
      retval = -1;
 
522
      goto mandos_end;
 
523
    }
 
524
    
 
525
    ret = gnutls_record_recv(session, buffer+buffer_length,
 
526
                             BUFFER_SIZE);
 
527
    if (ret == 0){
 
528
      break;
 
529
    }
 
530
    if (ret < 0){
 
531
      switch(ret){
 
532
      case GNUTLS_E_INTERRUPTED:
 
533
      case GNUTLS_E_AGAIN:
 
534
        break;
 
535
      case GNUTLS_E_REHANDSHAKE:
 
536
        ret = gnutls_handshake (session);
 
537
        if (ret < 0){
 
538
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
 
539
          gnutls_perror (ret);
 
540
          retval = -1;
 
541
          goto mandos_end;
 
542
        }
 
543
        break;
 
544
      default:
 
545
        fprintf(stderr, "Unknown error while reading data from"
 
546
                " encrypted session with Mandos server\n");
 
547
        retval = -1;
 
548
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
549
        goto mandos_end;
 
550
      }
 
551
    } else {
 
552
      buffer_length += (size_t) ret;
 
553
    }
 
554
  }
 
555
  
 
556
  if(debug){
 
557
    fprintf(stderr, "Closing TLS session\n");
 
558
  }
 
559
  
 
560
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
561
  
 
562
  if (buffer_length > 0){
 
563
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
 
564
                                               buffer_length,
 
565
                                               &decrypted_buffer,
 
566
                                               keydir);
 
567
    if (decrypted_buffer_size >= 0){
 
568
      written = 0;
 
569
      while(written < (size_t) decrypted_buffer_size){
 
570
        ret = (int)fwrite (decrypted_buffer + written, 1,
 
571
                           (size_t)decrypted_buffer_size - written,
 
572
                           stdout);
 
573
        if(ret == 0 and ferror(stdout)){
 
574
          if(debug){
 
575
            fprintf(stderr, "Error writing encrypted data: %s\n",
 
576
                    strerror(errno));
 
577
          }
 
578
          retval = -1;
 
579
          break;
 
580
        }
 
581
        written += (size_t)ret;
 
582
      }
 
583
      free(decrypted_buffer);
 
584
    } else {
 
585
      retval = -1;
 
586
    }
 
587
  }
 
588
  
 
589
  /* Shutdown procedure */
 
590
  
 
591
 mandos_end:
 
592
  free(buffer);
 
593
  close(tcp_sd);
 
594
  gnutls_deinit (session);
 
595
  gnutls_certificate_free_credentials (mc->cred);
 
596
  gnutls_global_deinit ();
 
597
  return retval;
 
598
}
 
599
 
 
600
static void resolve_callback(AvahiSServiceResolver *r,
 
601
                             AvahiIfIndex interface,
 
602
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
603
                             AvahiResolverEvent event,
 
604
                             const char *name,
 
605
                             const char *type,
 
606
                             const char *domain,
 
607
                             const char *host_name,
 
608
                             const AvahiAddress *address,
 
609
                             uint16_t port,
 
610
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
 
611
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
612
                             flags,
 
613
                             void* userdata) {
 
614
  mandos_context *mc = userdata;
 
615
  assert(r);                    /* Spurious warning */
 
616
  
 
617
  /* Called whenever a service has been resolved successfully or
 
618
     timed out */
 
619
  
 
620
  switch (event) {
 
621
  default:
 
622
  case AVAHI_RESOLVER_FAILURE:
 
623
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
 
624
            " of type '%s' in domain '%s': %s\n", name, type, domain,
 
625
            avahi_strerror(avahi_server_errno(mc->server)));
 
626
    break;
 
627
    
 
628
  case AVAHI_RESOLVER_FOUND:
 
629
    {
 
630
      char ip[AVAHI_ADDRESS_STR_MAX];
 
631
      avahi_address_snprint(ip, sizeof(ip), address);
 
632
      if(debug){
 
633
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %d) on"
 
634
                " port %d\n", name, host_name, ip, interface, port);
 
635
      }
 
636
      int ret = start_mandos_communication(ip, port, interface, mc);
 
637
      if (ret == 0){
 
638
        exit(EXIT_SUCCESS);
 
639
      }
 
640
    }
 
641
  }
 
642
  avahi_s_service_resolver_free(r);
 
643
}
 
644
 
 
645
static void browse_callback( AvahiSServiceBrowser *b,
 
646
                             AvahiIfIndex interface,
 
647
                             AvahiProtocol protocol,
 
648
                             AvahiBrowserEvent event,
 
649
                             const char *name,
 
650
                             const char *type,
 
651
                             const char *domain,
 
652
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
653
                             flags,
 
654
                             void* userdata) {
 
655
  mandos_context *mc = userdata;
 
656
  assert(b);                    /* Spurious warning */
 
657
  
 
658
  /* Called whenever a new services becomes available on the LAN or
 
659
     is removed from the LAN */
 
660
  
 
661
  switch (event) {
 
662
  default:
 
663
  case AVAHI_BROWSER_FAILURE:
 
664
    
 
665
    fprintf(stderr, "(Avahi browser) %s\n",
 
666
            avahi_strerror(avahi_server_errno(mc->server)));
 
667
    avahi_simple_poll_quit(mc->simple_poll);
 
668
    return;
 
669
    
 
670
  case AVAHI_BROWSER_NEW:
 
671
    /* We ignore the returned Avahi resolver object. In the callback
 
672
       function we free it. If the Avahi server is terminated before
 
673
       the callback function is called the Avahi server will free the
 
674
       resolver for us. */
 
675
    
 
676
    if (!(avahi_s_service_resolver_new(mc->server, interface,
 
677
                                       protocol, name, type, domain,
 
678
                                       AVAHI_PROTO_INET6, 0,
 
679
                                       resolve_callback, mc)))
 
680
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
 
681
              name, avahi_strerror(avahi_server_errno(mc->server)));
 
682
    break;
 
683
    
 
684
  case AVAHI_BROWSER_REMOVE:
 
685
    break;
 
686
    
 
687
  case AVAHI_BROWSER_ALL_FOR_NOW:
 
688
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
 
689
    if(debug){
 
690
      fprintf(stderr, "No Mandos server found, still searching...\n");
 
691
    }
 
692
    break;
 
693
  }
 
694
}
 
695
 
 
696
/* Combines file name and path and returns the malloced new
 
697
   string. some sane checks could/should be added */
 
698
static const char *combinepath(const char *first, const char *second){
 
699
  size_t f_len = strlen(first);
 
700
  size_t s_len = strlen(second);
 
701
  char *tmp = malloc(f_len + s_len + 2);
 
702
  if (tmp == NULL){
 
703
    return NULL;
 
704
  }
 
705
  if(f_len > 0){
 
706
    memcpy(tmp, first, f_len);  /* Spurious warning */
 
707
  }
 
708
  tmp[f_len] = '/';
 
709
  if(s_len > 0){
 
710
    memcpy(tmp + f_len + 1, second, s_len); /* Spurious warning */
 
711
  }
 
712
  tmp[f_len + 1 + s_len] = '\0';
 
713
  return tmp;
 
714
}
 
715
 
 
716
 
 
717
int main(int argc, char *argv[]){
 
718
    AvahiSServiceBrowser *sb = NULL;
 
719
    int error;
 
720
    int ret;
 
721
    int exitcode = EXIT_SUCCESS;
 
722
    const char *interface = "eth0";
 
723
    struct ifreq network;
 
724
    int sd;
 
725
    char *connect_to = NULL;
 
726
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
 
727
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
 
728
                          .dh_bits = 1024, .priority = "SECURE256"};
 
729
    
 
730
    {
 
731
      /* Temporary int to get the address of for getopt_long */
 
732
      int debug_int = debug ? 1 : 0;
 
733
      while (true){
 
734
        struct option long_options[] = {
 
735
          {"debug", no_argument, &debug_int, 1},
 
736
          {"connect", required_argument, NULL, 'c'},
 
737
          {"interface", required_argument, NULL, 'i'},
 
738
          {"keydir", required_argument, NULL, 'd'},
 
739
          {"seckey", required_argument, NULL, 's'},
 
740
          {"pubkey", required_argument, NULL, 'p'},
 
741
          {"dh-bits", required_argument, NULL, 'D'},
 
742
          {"priority", required_argument, NULL, 'P'},
 
743
          {0, 0, 0, 0} };
 
744
      
 
745
        int option_index = 0;
 
746
        ret = getopt_long (argc, argv, "i:", long_options,
 
747
                           &option_index);
 
748
      
 
749
        if (ret == -1){
 
750
          break;
 
751
        }
 
752
      
 
753
        switch(ret){
 
754
        case 0:
 
755
          break;
 
756
        case 'i':
 
757
          interface = optarg;
 
758
          break;
 
759
        case 'c':
 
760
          connect_to = optarg;
 
761
          break;
 
762
        case 'd':
 
763
          keydir = optarg;
 
764
          break;
 
765
        case 'p':
 
766
          pubkeyfile = optarg;
 
767
          break;
 
768
        case 's':
 
769
          seckeyfile = optarg;
 
770
          break;
 
771
        case 'D':
 
772
          errno = 0;
 
773
          mc.dh_bits = (unsigned int) strtol(optarg, NULL, 10);
 
774
          if (errno){
 
775
            perror("strtol");
 
776
            exit(EXIT_FAILURE);
 
777
          }
 
778
          break;
 
779
        case 'P':
 
780
          mc.priority = optarg;
 
781
          break;
 
782
        case '?':
 
783
        default:
 
784
          /* getopt_long() has already printed a message about the
 
785
             unrcognized option, so just exit. */
 
786
          exit(EXIT_FAILURE);
 
787
        }
 
788
      }
 
789
      /* Set the global debug flag from the temporary int */
 
790
      debug = debug_int ? true : false;
 
791
    }
 
792
    
 
793
    pubkeyfile = combinepath(keydir, pubkeyfile);
 
794
    if (pubkeyfile == NULL){
 
795
      perror("combinepath");
 
796
      exitcode = EXIT_FAILURE;
 
797
      goto end;
 
798
    }
 
799
    
 
800
    seckeyfile = combinepath(keydir, seckeyfile);
 
801
    if (seckeyfile == NULL){
 
802
      perror("combinepath");
 
803
      goto end;
 
804
    }
 
805
    
 
806
    if_index = (AvahiIfIndex) if_nametoindex(interface);
 
807
    if(if_index == 0){
 
808
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
 
809
      exit(EXIT_FAILURE);
 
810
    }
 
811
    
 
812
    if(connect_to != NULL){
 
813
      /* Connect directly, do not use Zeroconf */
 
814
      /* (Mainly meant for debugging) */
 
815
      char *address = strrchr(connect_to, ':');
 
816
      if(address == NULL){
 
817
        fprintf(stderr, "No colon in address\n");
 
818
        exit(EXIT_FAILURE);
 
819
      }
 
820
      errno = 0;
 
821
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
 
822
      if(errno){
 
823
        perror("Bad port number");
 
824
        exit(EXIT_FAILURE);
 
825
      }
 
826
      *address = '\0';
 
827
      address = connect_to;
 
828
      ret = start_mandos_communication(address, port, if_index, &mc);
 
829
      if(ret < 0){
 
830
        exit(EXIT_FAILURE);
 
831
      } else {
 
832
        exit(EXIT_SUCCESS);
 
833
      }
 
834
    }
 
835
    
 
836
    /* If the interface is down, bring it up */
 
837
    {
 
838
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
839
      if(sd < 0) {
 
840
        perror("socket");
 
841
        exitcode = EXIT_FAILURE;
 
842
        goto end;
 
843
      }
 
844
      strcpy(network.ifr_name, interface); /* Spurious warning */
 
845
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
846
      if(ret == -1){
 
847
        perror("ioctl SIOCGIFFLAGS");
 
848
        exitcode = EXIT_FAILURE;
 
849
        goto end;
 
850
      }
 
851
      if((network.ifr_flags & IFF_UP) == 0){
 
852
        network.ifr_flags |= IFF_UP;
 
853
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
854
        if(ret == -1){
 
855
          perror("ioctl SIOCSIFFLAGS");
 
856
          exitcode = EXIT_FAILURE;
 
857
          goto end;
 
858
        }
 
859
      }
 
860
      close(sd);
 
861
    }
 
862
    
 
863
    if (not debug){
 
864
      avahi_set_log_function(empty_log);
 
865
    }
 
866
    
 
867
    /* Initialize the pseudo-RNG for Avahi */
 
868
    srand((unsigned int) time(NULL));
 
869
    
 
870
    /* Allocate main Avahi loop object */
 
871
    mc.simple_poll = avahi_simple_poll_new();
 
872
    if (mc.simple_poll == NULL) {
 
873
        fprintf(stderr, "Avahi: Failed to create simple poll"
 
874
                " object.\n");
 
875
        exitcode = EXIT_FAILURE;
 
876
        goto end;
 
877
    }
 
878
 
 
879
    {
 
880
      AvahiServerConfig config;
 
881
      /* Do not publish any local Zeroconf records */
 
882
      avahi_server_config_init(&config);
 
883
      config.publish_hinfo = 0;
 
884
      config.publish_addresses = 0;
 
885
      config.publish_workstation = 0;
 
886
      config.publish_domain = 0;
 
887
 
 
888
      /* Allocate a new server */
 
889
      mc.server = avahi_server_new(avahi_simple_poll_get
 
890
                                   (mc.simple_poll), &config, NULL,
 
891
                                   NULL, &error);
 
892
    
 
893
      /* Free the Avahi configuration data */
 
894
      avahi_server_config_free(&config);
 
895
    }
 
896
    
 
897
    /* Check if creating the Avahi server object succeeded */
 
898
    if (mc.server == NULL) {
 
899
        fprintf(stderr, "Failed to create Avahi server: %s\n",
 
900
                avahi_strerror(error));
 
901
        exitcode = EXIT_FAILURE;
 
902
        goto end;
 
903
    }
 
904
    
 
905
    /* Create the Avahi service browser */
 
906
    sb = avahi_s_service_browser_new(mc.server, if_index,
 
907
                                     AVAHI_PROTO_INET6,
 
908
                                     "_mandos._tcp", NULL, 0,
 
909
                                     browse_callback, &mc);
 
910
    if (sb == NULL) {
 
911
        fprintf(stderr, "Failed to create service browser: %s\n",
 
912
                avahi_strerror(avahi_server_errno(mc.server)));
 
913
        exitcode = EXIT_FAILURE;
 
914
        goto end;
 
915
    }
 
916
    
 
917
    /* Run the main loop */
 
918
 
 
919
    if (debug){
 
920
      fprintf(stderr, "Starting Avahi loop search\n");
 
921
    }
 
922
    
 
923
    avahi_simple_poll_loop(mc.simple_poll);
 
924
    
 
925
 end:
 
926
 
 
927
    if (debug){
 
928
      fprintf(stderr, "%s exiting\n", argv[0]);
 
929
    }
 
930
    
 
931
    /* Cleanup things */
 
932
    if (sb != NULL)
 
933
        avahi_s_service_browser_free(sb);
 
934
    
 
935
    if (mc.server != NULL)
 
936
        avahi_server_free(mc.server);
 
937
 
 
938
    if (mc.simple_poll != NULL)
 
939
        avahi_simple_poll_free(mc.simple_poll);
 
940
    free(pubkeyfile);
 
941
    free(seckeyfile);
 
942
    
 
943
    return exitcode;
 
944
}