/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/mandos-client.c

* initramfs-tools-hook: Whitespace change only.

Show diffs side-by-side

added added

removed removed

Lines of Context:
1
1
/*  -*- coding: utf-8 -*- */
2
2
/*
3
 
 * Mandos client - get and decrypt data from a Mandos server
 
3
 * Mandos-client - get and decrypt data from a Mandos server
4
4
 *
5
5
 * This program is partly derived from an example program for an Avahi
6
6
 * service browser, downloaded from
9
9
 * "browse_callback", and parts of "main".
10
10
 * 
11
11
 * Everything else is
12
 
 * Copyright © 2007-2008 Teddy Hogeborn & Björn Påhlsson
 
12
 * Copyright © 2008,2009 Teddy Hogeborn
 
13
 * Copyright © 2008,2009 Björn Påhlsson
13
14
 * 
14
15
 * This program is free software: you can redistribute it and/or
15
16
 * modify it under the terms of the GNU General Public License as
35
36
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY(), asprintf() */
36
37
 
37
38
#include <stdio.h>              /* fprintf(), stderr, fwrite(),
38
 
                                   stdout, ferror() */
 
39
                                   stdout, ferror(), sscanf(),
 
40
                                   remove() */
39
41
#include <stdint.h>             /* uint16_t, uint32_t */
40
42
#include <stddef.h>             /* NULL, size_t, ssize_t */
41
43
#include <stdlib.h>             /* free(), EXIT_SUCCESS, EXIT_FAILURE,
42
44
                                   srand() */
43
 
#include <stdbool.h>            /* bool, true */
 
45
#include <stdbool.h>            /* bool, false, true */
44
46
#include <string.h>             /* memset(), strcmp(), strlen(),
45
47
                                   strerror(), asprintf(), strcpy() */
46
 
#include <sys/ioctl.h>          /* ioctl */
 
48
#include <sys/ioctl.h>          /* ioctl */
47
49
#include <sys/types.h>          /* socket(), inet_pton(), sockaddr,
48
50
                                   sockaddr_in6, PF_INET6,
49
 
                                   SOCK_STREAM, INET6_ADDRSTRLEN,
50
 
                                   uid_t, gid_t, open(), opendir(), DIR */
 
51
                                   SOCK_STREAM, uid_t, gid_t, open(),
 
52
                                   opendir(), DIR */
51
53
#include <sys/stat.h>           /* open() */
52
54
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
53
 
                                   struct in6_addr, inet_pton(),
54
 
                                   connect() */
 
55
                                   inet_pton(), connect() */
55
56
#include <fcntl.h>              /* open() */
56
 
#include <dirent.h>             /* opendir(), struct dirent, readdir() */
57
 
#include <inttypes.h>           /* PRIu16 */
 
57
#include <dirent.h>             /* opendir(), struct dirent, readdir()
 
58
                                 */
 
59
#include <inttypes.h>           /* PRIu16, intmax_t, SCNdMAX */
58
60
#include <assert.h>             /* assert() */
59
61
#include <errno.h>              /* perror(), errno */
60
 
#include <time.h>               /* time() */
 
62
#include <time.h>               /* nanosleep(), time() */
61
63
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
62
64
                                   SIOCSIFFLAGS, if_indextoname(),
63
65
                                   if_nametoindex(), IF_NAMESIZE */
64
 
#include <netinet/in.h>
 
66
#include <netinet/in.h>         /* IN6_IS_ADDR_LINKLOCAL,
 
67
                                   INET_ADDRSTRLEN, INET6_ADDRSTRLEN
 
68
                                */
65
69
#include <unistd.h>             /* close(), SEEK_SET, off_t, write(),
66
70
                                   getuid(), getgid(), setuid(),
67
71
                                   setgid() */
68
72
#include <arpa/inet.h>          /* inet_pton(), htons */
69
 
#include <iso646.h>             /* not, and */
 
73
#include <iso646.h>             /* not, or, and */
70
74
#include <argp.h>               /* struct argp_option, error_t, struct
71
75
                                   argp_state, struct argp,
72
76
                                   argp_parse(), ARGP_KEY_ARG,
73
77
                                   ARGP_KEY_END, ARGP_ERR_UNKNOWN */
 
78
#ifdef __linux__
 
79
#include <sys/klog.h>           /* klogctl() */
 
80
#endif
74
81
 
75
82
/* Avahi */
76
83
/* All Avahi types, constants and functions
89
96
                                   gnutls_*
90
97
                                   init_gnutls_session(),
91
98
                                   GNUTLS_* */
92
 
#include <gnutls/openpgp.h>     /* gnutls_certificate_set_openpgp_key_file(),
 
99
#include <gnutls/openpgp.h>
 
100
                          /* gnutls_certificate_set_openpgp_key_file(),
93
101
                                   GNUTLS_OPENPGP_FMT_BASE64 */
94
102
 
95
103
/* GPGME */
101
109
 
102
110
#define BUFFER_SIZE 256
103
111
 
104
 
/*
105
 
  #define PATHDIR "/conf/conf.d/mandos"
106
 
*/
107
 
 
108
112
#define PATHDIR "/conf/conf.d/mandos"
109
113
#define SECKEY "seckey.txt"
110
114
#define PUBKEY "pubkey.txt"
111
115
 
112
116
bool debug = false;
113
117
static const char mandos_protocol_version[] = "1";
114
 
const char *argp_program_version = "mandos-client 1.0";
 
118
const char *argp_program_version = "mandos-client " VERSION;
115
119
const char *argp_program_bug_address = "<mandos@fukt.bsnet.se>";
116
120
 
117
121
/* Used for passing in values through the Avahi callback functions */
132
136
 */
133
137
size_t adjustbuffer(char **buffer, size_t buffer_length,
134
138
                  size_t buffer_capacity){
135
 
  if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
139
  if(buffer_length + BUFFER_SIZE > buffer_capacity){
136
140
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
137
 
    if (buffer == NULL){
 
141
    if(buffer == NULL){
138
142
      return 0;
139
143
    }
140
144
    buffer_capacity += BUFFER_SIZE;
153
157
  
154
158
  
155
159
  /*
156
 
   * Helper function to insert pub and seckey to the enigne keyring.
 
160
   * Helper function to insert pub and seckey to the engine keyring.
157
161
   */
158
162
  bool import_key(const char *filename){
159
163
    int fd;
160
164
    gpgme_data_t pgp_data;
161
165
    
162
 
    fd = TEMP_FAILURE_RETRY(open(filename, O_RDONLY));
 
166
    fd = (int)TEMP_FAILURE_RETRY(open(filename, O_RDONLY));
163
167
    if(fd == -1){
164
168
      perror("open");
165
169
      return false;
166
170
    }
167
171
    
168
172
    rc = gpgme_data_new_from_fd(&pgp_data, fd);
169
 
    if (rc != GPG_ERR_NO_ERROR){
 
173
    if(rc != GPG_ERR_NO_ERROR){
170
174
      fprintf(stderr, "bad gpgme_data_new_from_fd: %s: %s\n",
171
175
              gpgme_strsource(rc), gpgme_strerror(rc));
172
176
      return false;
173
177
    }
174
178
    
175
179
    rc = gpgme_op_import(mc->ctx, pgp_data);
176
 
    if (rc != GPG_ERR_NO_ERROR){
 
180
    if(rc != GPG_ERR_NO_ERROR){
177
181
      fprintf(stderr, "bad gpgme_op_import: %s: %s\n",
178
182
              gpgme_strsource(rc), gpgme_strerror(rc));
179
183
      return false;
180
184
    }
181
185
    
182
 
    ret = TEMP_FAILURE_RETRY(close(fd));
 
186
    ret = (int)TEMP_FAILURE_RETRY(close(fd));
183
187
    if(ret == -1){
184
188
      perror("close");
185
189
    }
187
191
    return true;
188
192
  }
189
193
  
190
 
  if (debug){
 
194
  if(debug){
191
195
    fprintf(stderr, "Initialize gpgme\n");
192
196
  }
193
197
  
194
198
  /* Init GPGME */
195
199
  gpgme_check_version(NULL);
196
200
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
197
 
  if (rc != GPG_ERR_NO_ERROR){
 
201
  if(rc != GPG_ERR_NO_ERROR){
198
202
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
199
203
            gpgme_strsource(rc), gpgme_strerror(rc));
200
204
    return false;
201
205
  }
202
206
  
203
207
    /* Set GPGME home directory for the OpenPGP engine only */
204
 
  rc = gpgme_get_engine_info (&engine_info);
205
 
  if (rc != GPG_ERR_NO_ERROR){
 
208
  rc = gpgme_get_engine_info(&engine_info);
 
209
  if(rc != GPG_ERR_NO_ERROR){
206
210
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
207
211
            gpgme_strsource(rc), gpgme_strerror(rc));
208
212
    return false;
222
226
  
223
227
  /* Create new GPGME "context" */
224
228
  rc = gpgme_new(&(mc->ctx));
225
 
  if (rc != GPG_ERR_NO_ERROR){
 
229
  if(rc != GPG_ERR_NO_ERROR){
226
230
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
227
231
            gpgme_strsource(rc), gpgme_strerror(rc));
228
232
    return false;
229
233
  }
230
234
  
231
 
  if (not import_key(pubkey) or not import_key(seckey)){
 
235
  if(not import_key(pubkey) or not import_key(seckey)){
232
236
    return false;
233
237
  }
234
238
  
239
243
 * Decrypt OpenPGP data.
240
244
 * Returns -1 on error
241
245
 */
242
 
static ssize_t pgp_packet_decrypt (const mandos_context *mc,
243
 
                                   const char *cryptotext,
244
 
                                   size_t crypto_size,
245
 
                                   char **plaintext){
 
246
static ssize_t pgp_packet_decrypt(const mandos_context *mc,
 
247
                                  const char *cryptotext,
 
248
                                  size_t crypto_size,
 
249
                                  char **plaintext){
246
250
  gpgme_data_t dh_crypto, dh_plain;
247
251
  gpgme_error_t rc;
248
252
  ssize_t ret;
249
253
  size_t plaintext_capacity = 0;
250
254
  ssize_t plaintext_length = 0;
251
255
  
252
 
  if (debug){
 
256
  if(debug){
253
257
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
254
258
  }
255
259
  
256
260
  /* Create new GPGME data buffer from memory cryptotext */
257
261
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
258
262
                               0);
259
 
  if (rc != GPG_ERR_NO_ERROR){
 
263
  if(rc != GPG_ERR_NO_ERROR){
260
264
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
261
265
            gpgme_strsource(rc), gpgme_strerror(rc));
262
266
    return -1;
264
268
  
265
269
  /* Create new empty GPGME data buffer for the plaintext */
266
270
  rc = gpgme_data_new(&dh_plain);
267
 
  if (rc != GPG_ERR_NO_ERROR){
 
271
  if(rc != GPG_ERR_NO_ERROR){
268
272
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
269
273
            gpgme_strsource(rc), gpgme_strerror(rc));
270
274
    gpgme_data_release(dh_crypto);
274
278
  /* Decrypt data from the cryptotext data buffer to the plaintext
275
279
     data buffer */
276
280
  rc = gpgme_op_decrypt(mc->ctx, dh_crypto, dh_plain);
277
 
  if (rc != GPG_ERR_NO_ERROR){
 
281
  if(rc != GPG_ERR_NO_ERROR){
278
282
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
279
283
            gpgme_strsource(rc), gpgme_strerror(rc));
280
284
    plaintext_length = -1;
281
 
    if (debug){
 
285
    if(debug){
282
286
      gpgme_decrypt_result_t result;
283
287
      result = gpgme_op_decrypt_result(mc->ctx);
284
 
      if (result == NULL){
 
288
      if(result == NULL){
285
289
        fprintf(stderr, "gpgme_op_decrypt_result failed\n");
286
290
      } else {
287
291
        fprintf(stderr, "Unsupported algorithm: %s\n",
314
318
  }
315
319
  
316
320
  /* Seek back to the beginning of the GPGME plaintext data buffer */
317
 
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
 
321
  if(gpgme_data_seek(dh_plain, (off_t)0, SEEK_SET) == -1){
318
322
    perror("gpgme_data_seek");
319
323
    plaintext_length = -1;
320
324
    goto decrypt_end;
325
329
    plaintext_capacity = adjustbuffer(plaintext,
326
330
                                      (size_t)plaintext_length,
327
331
                                      plaintext_capacity);
328
 
    if (plaintext_capacity == 0){
 
332
    if(plaintext_capacity == 0){
329
333
        perror("adjustbuffer");
330
334
        plaintext_length = -1;
331
335
        goto decrypt_end;
334
338
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
335
339
                          BUFFER_SIZE);
336
340
    /* Print the data, if any */
337
 
    if (ret == 0){
 
341
    if(ret == 0){
338
342
      /* EOF */
339
343
      break;
340
344
    }
364
368
  return plaintext_length;
365
369
}
366
370
 
367
 
static const char * safer_gnutls_strerror (int value) {
368
 
  const char *ret = gnutls_strerror (value); /* Spurious warning */
369
 
  if (ret == NULL)
 
371
static const char * safer_gnutls_strerror(int value){
 
372
  const char *ret = gnutls_strerror(value); /* Spurious warning from
 
373
                                               -Wunreachable-code */
 
374
  if(ret == NULL)
370
375
    ret = "(unknown)";
371
376
  return ret;
372
377
}
387
392
  }
388
393
  
389
394
  ret = gnutls_global_init();
390
 
  if (ret != GNUTLS_E_SUCCESS) {
391
 
    fprintf (stderr, "GnuTLS global_init: %s\n",
392
 
             safer_gnutls_strerror(ret));
 
395
  if(ret != GNUTLS_E_SUCCESS){
 
396
    fprintf(stderr, "GnuTLS global_init: %s\n",
 
397
            safer_gnutls_strerror(ret));
393
398
    return -1;
394
399
  }
395
400
  
396
 
  if (debug){
 
401
  if(debug){
397
402
    /* "Use a log level over 10 to enable all debugging options."
398
403
     * - GnuTLS manual
399
404
     */
403
408
  
404
409
  /* OpenPGP credentials */
405
410
  gnutls_certificate_allocate_credentials(&mc->cred);
406
 
  if (ret != GNUTLS_E_SUCCESS){
407
 
    fprintf (stderr, "GnuTLS memory error: %s\n", /* Spurious
408
 
                                                     warning */
409
 
             safer_gnutls_strerror(ret));
410
 
    gnutls_global_deinit ();
 
411
  if(ret != GNUTLS_E_SUCCESS){
 
412
    fprintf(stderr, "GnuTLS memory error: %s\n", /* Spurious warning
 
413
                                                    from
 
414
                                                    -Wunreachable-code
 
415
                                                 */
 
416
            safer_gnutls_strerror(ret));
 
417
    gnutls_global_deinit();
411
418
    return -1;
412
419
  }
413
420
  
420
427
  ret = gnutls_certificate_set_openpgp_key_file
421
428
    (mc->cred, pubkeyfilename, seckeyfilename,
422
429
     GNUTLS_OPENPGP_FMT_BASE64);
423
 
  if (ret != GNUTLS_E_SUCCESS) {
 
430
  if(ret != GNUTLS_E_SUCCESS){
424
431
    fprintf(stderr,
425
432
            "Error[%d] while reading the OpenPGP key pair ('%s',"
426
433
            " '%s')\n", ret, pubkeyfilename, seckeyfilename);
431
438
  
432
439
  /* GnuTLS server initialization */
433
440
  ret = gnutls_dh_params_init(&mc->dh_params);
434
 
  if (ret != GNUTLS_E_SUCCESS) {
435
 
    fprintf (stderr, "Error in GnuTLS DH parameter initialization:"
436
 
             " %s\n", safer_gnutls_strerror(ret));
 
441
  if(ret != GNUTLS_E_SUCCESS){
 
442
    fprintf(stderr, "Error in GnuTLS DH parameter initialization:"
 
443
            " %s\n", safer_gnutls_strerror(ret));
437
444
    goto globalfail;
438
445
  }
439
446
  ret = gnutls_dh_params_generate2(mc->dh_params, mc->dh_bits);
440
 
  if (ret != GNUTLS_E_SUCCESS) {
441
 
    fprintf (stderr, "Error in GnuTLS prime generation: %s\n",
442
 
             safer_gnutls_strerror(ret));
 
447
  if(ret != GNUTLS_E_SUCCESS){
 
448
    fprintf(stderr, "Error in GnuTLS prime generation: %s\n",
 
449
            safer_gnutls_strerror(ret));
443
450
    goto globalfail;
444
451
  }
445
452
  
460
467
  int ret;
461
468
  /* GnuTLS session creation */
462
469
  ret = gnutls_init(session, GNUTLS_SERVER);
463
 
  if (ret != GNUTLS_E_SUCCESS){
 
470
  if(ret != GNUTLS_E_SUCCESS){
464
471
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
465
472
            safer_gnutls_strerror(ret));
466
473
  }
468
475
  {
469
476
    const char *err;
470
477
    ret = gnutls_priority_set_direct(*session, mc->priority, &err);
471
 
    if (ret != GNUTLS_E_SUCCESS) {
 
478
    if(ret != GNUTLS_E_SUCCESS){
472
479
      fprintf(stderr, "Syntax error at: %s\n", err);
473
480
      fprintf(stderr, "GnuTLS error: %s\n",
474
481
              safer_gnutls_strerror(ret));
475
 
      gnutls_deinit (*session);
 
482
      gnutls_deinit(*session);
476
483
      return -1;
477
484
    }
478
485
  }
479
486
  
480
487
  ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
481
488
                               mc->cred);
482
 
  if (ret != GNUTLS_E_SUCCESS) {
 
489
  if(ret != GNUTLS_E_SUCCESS){
483
490
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
484
491
            safer_gnutls_strerror(ret));
485
 
    gnutls_deinit (*session);
 
492
    gnutls_deinit(*session);
486
493
    return -1;
487
494
  }
488
495
  
489
496
  /* ignore client certificate if any. */
490
 
  gnutls_certificate_server_set_request (*session,
491
 
                                         GNUTLS_CERT_IGNORE);
 
497
  gnutls_certificate_server_set_request(*session,
 
498
                                        GNUTLS_CERT_IGNORE);
492
499
  
493
 
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
 
500
  gnutls_dh_set_prime_bits(*session, mc->dh_bits);
494
501
  
495
502
  return 0;
496
503
}
502
509
/* Called when a Mandos server is found */
503
510
static int start_mandos_communication(const char *ip, uint16_t port,
504
511
                                      AvahiIfIndex if_index,
505
 
                                      mandos_context *mc){
 
512
                                      mandos_context *mc, int af){
506
513
  int ret, tcp_sd;
507
 
  union { struct sockaddr in; struct sockaddr_in6 in6; } to;
 
514
  ssize_t sret;
 
515
  union {
 
516
    struct sockaddr_in in;
 
517
    struct sockaddr_in6 in6;
 
518
  } to;
508
519
  char *buffer = NULL;
509
520
  char *decrypted_buffer;
510
521
  size_t buffer_length = 0;
512
523
  ssize_t decrypted_buffer_size;
513
524
  size_t written;
514
525
  int retval = 0;
515
 
  char interface[IF_NAMESIZE];
516
526
  gnutls_session_t session;
517
 
  
518
 
  ret = init_gnutls_session (mc, &session);
519
 
  if (ret != 0){
 
527
  int pf;                       /* Protocol family */
 
528
  
 
529
  switch(af){
 
530
  case AF_INET6:
 
531
    pf = PF_INET6;
 
532
    break;
 
533
  case AF_INET:
 
534
    pf = PF_INET;
 
535
    break;
 
536
  default:
 
537
    fprintf(stderr, "Bad address family: %d\n", af);
 
538
    return -1;
 
539
  }
 
540
  
 
541
  ret = init_gnutls_session(mc, &session);
 
542
  if(ret != 0){
520
543
    return -1;
521
544
  }
522
545
  
523
546
  if(debug){
524
 
    fprintf(stderr, "Setting up a tcp connection to %s, port %" PRIu16
 
547
    fprintf(stderr, "Setting up a TCP connection to %s, port %" PRIu16
525
548
            "\n", ip, port);
526
549
  }
527
550
  
528
 
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
529
 
  if(tcp_sd < 0) {
 
551
  tcp_sd = socket(pf, SOCK_STREAM, 0);
 
552
  if(tcp_sd < 0){
530
553
    perror("socket");
531
554
    return -1;
532
555
  }
533
556
  
534
 
  if(debug){
535
 
    if(if_indextoname((unsigned int)if_index, interface) == NULL){
536
 
      perror("if_indextoname");
537
 
      return -1;
538
 
    }
539
 
    fprintf(stderr, "Binding to interface %s\n", interface);
540
 
  }
541
 
  
542
557
  memset(&to, 0, sizeof(to));
543
 
  to.in6.sin6_family = AF_INET6;
544
 
  /* It would be nice to have a way to detect if we were passed an
545
 
     IPv4 address here.   Now we assume an IPv6 address. */
546
 
  ret = inet_pton(AF_INET6, ip, &to.in6.sin6_addr);
547
 
  if (ret < 0 ){
 
558
  if(af == AF_INET6){
 
559
    to.in6.sin6_family = (uint16_t)af;
 
560
    ret = inet_pton(af, ip, &to.in6.sin6_addr);
 
561
  } else {                      /* IPv4 */
 
562
    to.in.sin_family = (sa_family_t)af;
 
563
    ret = inet_pton(af, ip, &to.in.sin_addr);
 
564
  }
 
565
  if(ret < 0 ){
548
566
    perror("inet_pton");
549
567
    return -1;
550
568
  }
552
570
    fprintf(stderr, "Bad address: %s\n", ip);
553
571
    return -1;
554
572
  }
555
 
  to.in6.sin6_port = htons(port); /* Spurious warning */
556
 
  
557
 
  to.in6.sin6_scope_id = (uint32_t)if_index;
 
573
  if(af == AF_INET6){
 
574
    to.in6.sin6_port = htons(port); /* Spurious warnings from
 
575
                                       -Wconversion and
 
576
                                       -Wunreachable-code */
 
577
    
 
578
    if(IN6_IS_ADDR_LINKLOCAL /* Spurious warnings from */
 
579
       (&to.in6.sin6_addr)){ /* -Wstrict-aliasing=2 or lower and
 
580
                              -Wunreachable-code*/
 
581
      if(if_index == AVAHI_IF_UNSPEC){
 
582
        fprintf(stderr, "An IPv6 link-local address is incomplete"
 
583
                " without a network interface\n");
 
584
        return -1;
 
585
      }
 
586
      /* Set the network interface number as scope */
 
587
      to.in6.sin6_scope_id = (uint32_t)if_index;
 
588
    }
 
589
  } else {
 
590
    to.in.sin_port = htons(port); /* Spurious warnings from
 
591
                                     -Wconversion and
 
592
                                     -Wunreachable-code */
 
593
  }
558
594
  
559
595
  if(debug){
560
 
    fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
561
 
            port);
562
 
    char addrstr[INET6_ADDRSTRLEN] = "";
563
 
    if(inet_ntop(to.in6.sin6_family, &(to.in6.sin6_addr), addrstr,
564
 
                 sizeof(addrstr)) == NULL){
 
596
    if(af == AF_INET6 and if_index != AVAHI_IF_UNSPEC){
 
597
      char interface[IF_NAMESIZE];
 
598
      if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
599
        perror("if_indextoname");
 
600
      } else {
 
601
        fprintf(stderr, "Connection to: %s%%%s, port %" PRIu16 "\n",
 
602
                ip, interface, port);
 
603
      }
 
604
    } else {
 
605
      fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
 
606
              port);
 
607
    }
 
608
    char addrstr[(INET_ADDRSTRLEN > INET6_ADDRSTRLEN) ?
 
609
                 INET_ADDRSTRLEN : INET6_ADDRSTRLEN] = "";
 
610
    const char *pcret;
 
611
    if(af == AF_INET6){
 
612
      pcret = inet_ntop(af, &(to.in6.sin6_addr), addrstr,
 
613
                        sizeof(addrstr));
 
614
    } else {
 
615
      pcret = inet_ntop(af, &(to.in.sin_addr), addrstr,
 
616
                        sizeof(addrstr));
 
617
    }
 
618
    if(pcret == NULL){
565
619
      perror("inet_ntop");
566
620
    } else {
567
621
      if(strcmp(addrstr, ip) != 0){
570
624
    }
571
625
  }
572
626
  
573
 
  ret = connect(tcp_sd, &to.in, sizeof(to));
574
 
  if (ret < 0){
 
627
  if(af == AF_INET6){
 
628
    ret = connect(tcp_sd, &to.in6, sizeof(to));
 
629
  } else {
 
630
    ret = connect(tcp_sd, &to.in, sizeof(to)); /* IPv4 */
 
631
  }
 
632
  if(ret < 0){
575
633
    perror("connect");
576
634
    return -1;
577
635
  }
578
636
  
579
637
  const char *out = mandos_protocol_version;
580
638
  written = 0;
581
 
  while (true){
 
639
  while(true){
582
640
    size_t out_size = strlen(out);
583
 
    ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
 
641
    ret = (int)TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
584
642
                                   out_size - written));
585
 
    if (ret == -1){
 
643
    if(ret == -1){
586
644
      perror("write");
587
645
      retval = -1;
588
646
      goto mandos_end;
591
649
    if(written < out_size){
592
650
      continue;
593
651
    } else {
594
 
      if (out == mandos_protocol_version){
 
652
      if(out == mandos_protocol_version){
595
653
        written = 0;
596
654
        out = "\r\n";
597
655
      } else {
604
662
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
605
663
  }
606
664
  
607
 
  gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
 
665
  gnutls_transport_set_ptr(session, (gnutls_transport_ptr_t) tcp_sd);
608
666
  
609
667
  do{
610
 
    ret = gnutls_handshake (session);
 
668
    ret = gnutls_handshake(session);
611
669
  } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
612
670
  
613
 
  if (ret != GNUTLS_E_SUCCESS){
 
671
  if(ret != GNUTLS_E_SUCCESS){
614
672
    if(debug){
615
673
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
616
 
      gnutls_perror (ret);
 
674
      gnutls_perror(ret);
617
675
    }
618
676
    retval = -1;
619
677
    goto mandos_end;
622
680
  /* Read OpenPGP packet that contains the wanted password */
623
681
  
624
682
  if(debug){
625
 
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
 
683
    fprintf(stderr, "Retrieving OpenPGP encrypted password from %s\n",
626
684
            ip);
627
685
  }
628
686
  
629
687
  while(true){
630
688
    buffer_capacity = adjustbuffer(&buffer, buffer_length,
631
689
                                   buffer_capacity);
632
 
    if (buffer_capacity == 0){
 
690
    if(buffer_capacity == 0){
633
691
      perror("adjustbuffer");
634
692
      retval = -1;
635
693
      goto mandos_end;
636
694
    }
637
695
    
638
 
    ret = gnutls_record_recv(session, buffer+buffer_length,
639
 
                             BUFFER_SIZE);
640
 
    if (ret == 0){
 
696
    sret = gnutls_record_recv(session, buffer+buffer_length,
 
697
                              BUFFER_SIZE);
 
698
    if(sret == 0){
641
699
      break;
642
700
    }
643
 
    if (ret < 0){
644
 
      switch(ret){
 
701
    if(sret < 0){
 
702
      switch(sret){
645
703
      case GNUTLS_E_INTERRUPTED:
646
704
      case GNUTLS_E_AGAIN:
647
705
        break;
648
706
      case GNUTLS_E_REHANDSHAKE:
649
707
        do{
650
 
          ret = gnutls_handshake (session);
 
708
          ret = gnutls_handshake(session);
651
709
        } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
652
 
        if (ret < 0){
 
710
        if(ret < 0){
653
711
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
654
 
          gnutls_perror (ret);
 
712
          gnutls_perror(ret);
655
713
          retval = -1;
656
714
          goto mandos_end;
657
715
        }
660
718
        fprintf(stderr, "Unknown error while reading data from"
661
719
                " encrypted session with Mandos server\n");
662
720
        retval = -1;
663
 
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
721
        gnutls_bye(session, GNUTLS_SHUT_RDWR);
664
722
        goto mandos_end;
665
723
      }
666
724
    } else {
667
 
      buffer_length += (size_t) ret;
 
725
      buffer_length += (size_t) sret;
668
726
    }
669
727
  }
670
728
  
672
730
    fprintf(stderr, "Closing TLS session\n");
673
731
  }
674
732
  
675
 
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
733
  gnutls_bye(session, GNUTLS_SHUT_RDWR);
676
734
  
677
 
  if (buffer_length > 0){
 
735
  if(buffer_length > 0){
678
736
    decrypted_buffer_size = pgp_packet_decrypt(mc, buffer,
679
737
                                               buffer_length,
680
738
                                               &decrypted_buffer);
681
 
    if (decrypted_buffer_size >= 0){
 
739
    if(decrypted_buffer_size >= 0){
682
740
      written = 0;
683
741
      while(written < (size_t) decrypted_buffer_size){
684
 
        ret = (int)fwrite (decrypted_buffer + written, 1,
685
 
                           (size_t)decrypted_buffer_size - written,
686
 
                           stdout);
 
742
        ret = (int)fwrite(decrypted_buffer + written, 1,
 
743
                          (size_t)decrypted_buffer_size - written,
 
744
                          stdout);
687
745
        if(ret == 0 and ferror(stdout)){
688
746
          if(debug){
689
747
            fprintf(stderr, "Error writing encrypted data: %s\n",
706
764
  
707
765
 mandos_end:
708
766
  free(buffer);
709
 
  ret = TEMP_FAILURE_RETRY(close(tcp_sd));
 
767
  ret = (int)TEMP_FAILURE_RETRY(close(tcp_sd));
710
768
  if(ret == -1){
711
769
    perror("close");
712
770
  }
713
 
  gnutls_deinit (session);
 
771
  gnutls_deinit(session);
714
772
  return retval;
715
773
}
716
774
 
717
775
static void resolve_callback(AvahiSServiceResolver *r,
718
776
                             AvahiIfIndex interface,
719
 
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
777
                             AvahiProtocol proto,
720
778
                             AvahiResolverEvent event,
721
779
                             const char *name,
722
780
                             const char *type,
727
785
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
728
786
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
729
787
                             flags,
730
 
                             void* userdata) {
 
788
                             void* userdata){
731
789
  mandos_context *mc = userdata;
732
790
  assert(r);
733
791
  
734
792
  /* Called whenever a service has been resolved successfully or
735
793
     timed out */
736
794
  
737
 
  switch (event) {
 
795
  switch(event){
738
796
  default:
739
797
  case AVAHI_RESOLVER_FAILURE:
740
798
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
748
806
      avahi_address_snprint(ip, sizeof(ip), address);
749
807
      if(debug){
750
808
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %"
751
 
                PRIu16 ") on port %d\n", name, host_name, ip,
752
 
                interface, port);
 
809
                PRIdMAX ") on port %" PRIu16 "\n", name, host_name,
 
810
                ip, (intmax_t)interface, port);
753
811
      }
754
 
      int ret = start_mandos_communication(ip, port, interface, mc);
755
 
      if (ret == 0){
 
812
      int ret = start_mandos_communication(ip, port, interface, mc,
 
813
                                           avahi_proto_to_af(proto));
 
814
      if(ret == 0){
756
815
        avahi_simple_poll_quit(mc->simple_poll);
757
816
      }
758
817
    }
760
819
  avahi_s_service_resolver_free(r);
761
820
}
762
821
 
763
 
static void browse_callback( AvahiSServiceBrowser *b,
764
 
                             AvahiIfIndex interface,
765
 
                             AvahiProtocol protocol,
766
 
                             AvahiBrowserEvent event,
767
 
                             const char *name,
768
 
                             const char *type,
769
 
                             const char *domain,
770
 
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
771
 
                             flags,
772
 
                             void* userdata) {
 
822
static void browse_callback(AvahiSServiceBrowser *b,
 
823
                            AvahiIfIndex interface,
 
824
                            AvahiProtocol protocol,
 
825
                            AvahiBrowserEvent event,
 
826
                            const char *name,
 
827
                            const char *type,
 
828
                            const char *domain,
 
829
                            AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
830
                            flags,
 
831
                            void* userdata){
773
832
  mandos_context *mc = userdata;
774
833
  assert(b);
775
834
  
776
835
  /* Called whenever a new services becomes available on the LAN or
777
836
     is removed from the LAN */
778
837
  
779
 
  switch (event) {
 
838
  switch(event){
780
839
  default:
781
840
  case AVAHI_BROWSER_FAILURE:
782
841
    
791
850
       the callback function is called the Avahi server will free the
792
851
       resolver for us. */
793
852
    
794
 
    if (!(avahi_s_service_resolver_new(mc->server, interface,
 
853
    if(!(avahi_s_service_resolver_new(mc->server, interface,
795
854
                                       protocol, name, type, domain,
796
855
                                       AVAHI_PROTO_INET6, 0,
797
856
                                       resolve_callback, mc)))
812
871
}
813
872
 
814
873
int main(int argc, char *argv[]){
815
 
    AvahiSServiceBrowser *sb = NULL;
816
 
    int error;
817
 
    int ret;
818
 
    int exitcode = EXIT_SUCCESS;
819
 
    const char *interface = "eth0";
820
 
    struct ifreq network;
821
 
    int sd;
822
 
    uid_t uid;
823
 
    gid_t gid;
824
 
    char *connect_to = NULL;
825
 
    char tempdir[] = "/tmp/mandosXXXXXX";
826
 
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
827
 
    const char *seckey = PATHDIR "/" SECKEY;
828
 
    const char *pubkey = PATHDIR "/" PUBKEY;
829
 
    
830
 
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
831
 
                          .dh_bits = 1024, .priority = "SECURE256"
832
 
                          ":!CTYPE-X.509:+CTYPE-OPENPGP" };
833
 
    bool gnutls_initalized = false;
834
 
    bool gpgme_initalized = false;
835
 
    
836
 
    {
837
 
      struct argp_option options[] = {
838
 
        { .name = "debug", .key = 128,
839
 
          .doc = "Debug mode", .group = 3 },
840
 
        { .name = "connect", .key = 'c',
841
 
          .arg = "ADDRESS:PORT",
842
 
          .doc = "Connect directly to a specific Mandos server",
843
 
          .group = 1 },
844
 
        { .name = "interface", .key = 'i',
845
 
          .arg = "NAME",
846
 
          .doc = "Interface that will be used to search for Mandos"
847
 
          " servers",
848
 
          .group = 1 },
849
 
        { .name = "seckey", .key = 's',
850
 
          .arg = "FILE",
851
 
          .doc = "OpenPGP secret key file base name",
852
 
          .group = 1 },
853
 
        { .name = "pubkey", .key = 'p',
854
 
          .arg = "FILE",
855
 
          .doc = "OpenPGP public key file base name",
856
 
          .group = 2 },
857
 
        { .name = "dh-bits", .key = 129,
858
 
          .arg = "BITS",
859
 
          .doc = "Bit length of the prime number used in the"
860
 
          " Diffie-Hellman key exchange",
861
 
          .group = 2 },
862
 
        { .name = "priority", .key = 130,
863
 
          .arg = "STRING",
864
 
          .doc = "GnuTLS priority string for the TLS handshake",
865
 
          .group = 1 },
866
 
        { .name = NULL }
867
 
      };
868
 
      
869
 
      error_t parse_opt (int key, char *arg,
870
 
                         struct argp_state *state) {
871
 
        /* Get the INPUT argument from `argp_parse', which we know is
872
 
           a pointer to our plugin list pointer. */
873
 
        switch (key) {
874
 
        case 128:               /* --debug */
875
 
          debug = true;
876
 
          break;
877
 
        case 'c':               /* --connect */
878
 
          connect_to = arg;
879
 
          break;
880
 
        case 'i':               /* --interface */
881
 
          interface = arg;
882
 
          break;
883
 
        case 's':               /* --seckey */
884
 
          seckey = arg;
885
 
          break;
886
 
        case 'p':               /* --pubkey */
887
 
          pubkey = arg;
888
 
          break;
889
 
        case 129:               /* --dh-bits */
890
 
          errno = 0;
891
 
          mc.dh_bits = (unsigned int) strtol(arg, NULL, 10);
892
 
          if (errno){
893
 
            perror("strtol");
894
 
            exit(EXIT_FAILURE);
 
874
  AvahiSServiceBrowser *sb = NULL;
 
875
  int error;
 
876
  int ret;
 
877
  intmax_t tmpmax;
 
878
  int numchars;
 
879
  int exitcode = EXIT_SUCCESS;
 
880
  const char *interface = "eth0";
 
881
  struct ifreq network;
 
882
  int sd;
 
883
  uid_t uid;
 
884
  gid_t gid;
 
885
  char *connect_to = NULL;
 
886
  char tempdir[] = "/tmp/mandosXXXXXX";
 
887
  bool tempdir_created = false;
 
888
  AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
 
889
  const char *seckey = PATHDIR "/" SECKEY;
 
890
  const char *pubkey = PATHDIR "/" PUBKEY;
 
891
  
 
892
  mandos_context mc = { .simple_poll = NULL, .server = NULL,
 
893
                        .dh_bits = 1024, .priority = "SECURE256"
 
894
                        ":!CTYPE-X.509:+CTYPE-OPENPGP" };
 
895
  bool gnutls_initialized = false;
 
896
  bool gpgme_initialized = false;
 
897
  double delay = 2.5;
 
898
  
 
899
  {
 
900
    struct argp_option options[] = {
 
901
      { .name = "debug", .key = 128,
 
902
        .doc = "Debug mode", .group = 3 },
 
903
      { .name = "connect", .key = 'c',
 
904
        .arg = "ADDRESS:PORT",
 
905
        .doc = "Connect directly to a specific Mandos server",
 
906
        .group = 1 },
 
907
      { .name = "interface", .key = 'i',
 
908
        .arg = "NAME",
 
909
        .doc = "Network interface that will be used to search for"
 
910
        " Mandos servers",
 
911
        .group = 1 },
 
912
      { .name = "seckey", .key = 's',
 
913
        .arg = "FILE",
 
914
        .doc = "OpenPGP secret key file base name",
 
915
        .group = 1 },
 
916
      { .name = "pubkey", .key = 'p',
 
917
        .arg = "FILE",
 
918
        .doc = "OpenPGP public key file base name",
 
919
        .group = 2 },
 
920
      { .name = "dh-bits", .key = 129,
 
921
        .arg = "BITS",
 
922
        .doc = "Bit length of the prime number used in the"
 
923
        " Diffie-Hellman key exchange",
 
924
        .group = 2 },
 
925
      { .name = "priority", .key = 130,
 
926
        .arg = "STRING",
 
927
        .doc = "GnuTLS priority string for the TLS handshake",
 
928
        .group = 1 },
 
929
      { .name = "delay", .key = 131,
 
930
        .arg = "SECONDS",
 
931
        .doc = "Maximum delay to wait for interface startup",
 
932
        .group = 2 },
 
933
      { .name = NULL }
 
934
    };
 
935
    
 
936
    error_t parse_opt(int key, char *arg,
 
937
                      struct argp_state *state){
 
938
      switch(key){
 
939
      case 128:                 /* --debug */
 
940
        debug = true;
 
941
        break;
 
942
      case 'c':                 /* --connect */
 
943
        connect_to = arg;
 
944
        break;
 
945
      case 'i':                 /* --interface */
 
946
        interface = arg;
 
947
        break;
 
948
      case 's':                 /* --seckey */
 
949
        seckey = arg;
 
950
        break;
 
951
      case 'p':                 /* --pubkey */
 
952
        pubkey = arg;
 
953
        break;
 
954
      case 129:                 /* --dh-bits */
 
955
        ret = sscanf(arg, "%" SCNdMAX "%n", &tmpmax, &numchars);
 
956
        if(ret < 1 or tmpmax != (typeof(mc.dh_bits))tmpmax
 
957
           or arg[numchars] != '\0'){
 
958
          fprintf(stderr, "Bad number of DH bits\n");
 
959
          exit(EXIT_FAILURE);
 
960
        }
 
961
        mc.dh_bits = (typeof(mc.dh_bits))tmpmax;
 
962
        break;
 
963
      case 130:                 /* --priority */
 
964
        mc.priority = arg;
 
965
        break;
 
966
      case 131:                 /* --delay */
 
967
        ret = sscanf(arg, "%lf%n", &delay, &numchars);
 
968
        if(ret < 1 or arg[numchars] != '\0'){
 
969
          fprintf(stderr, "Bad delay\n");
 
970
          exit(EXIT_FAILURE);
 
971
        }
 
972
        break;
 
973
      case ARGP_KEY_ARG:
 
974
        argp_usage(state);
 
975
      case ARGP_KEY_END:
 
976
        break;
 
977
      default:
 
978
        return ARGP_ERR_UNKNOWN;
 
979
      }
 
980
      return 0;
 
981
    }
 
982
    
 
983
    struct argp argp = { .options = options, .parser = parse_opt,
 
984
                         .args_doc = "",
 
985
                         .doc = "Mandos client -- Get and decrypt"
 
986
                         " passwords from a Mandos server" };
 
987
    ret = argp_parse(&argp, argc, argv, 0, 0, NULL);
 
988
    if(ret == ARGP_ERR_UNKNOWN){
 
989
      fprintf(stderr, "Unknown error while parsing arguments\n");
 
990
      exitcode = EXIT_FAILURE;
 
991
      goto end;
 
992
    }
 
993
  }
 
994
  
 
995
  /* If the interface is down, bring it up */
 
996
  if(interface[0] != '\0'){
 
997
#ifdef __linux__
 
998
    /* Lower kernel loglevel to KERN_NOTICE to avoid KERN_INFO
 
999
       messages to mess up the prompt */
 
1000
    ret = klogctl(8, NULL, 5);
 
1001
    bool restore_loglevel = true;
 
1002
    if(ret == -1){
 
1003
      restore_loglevel = false;
 
1004
      perror("klogctl");
 
1005
    }
 
1006
#endif
 
1007
    
 
1008
    sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
1009
    if(sd < 0){
 
1010
      perror("socket");
 
1011
      exitcode = EXIT_FAILURE;
 
1012
#ifdef __linux__
 
1013
      if(restore_loglevel){
 
1014
        ret = klogctl(7, NULL, 0);
 
1015
        if(ret == -1){
 
1016
          perror("klogctl");
 
1017
        }
 
1018
      }
 
1019
#endif
 
1020
      goto end;
 
1021
    }
 
1022
    strcpy(network.ifr_name, interface);
 
1023
    ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
1024
    if(ret == -1){
 
1025
      perror("ioctl SIOCGIFFLAGS");
 
1026
#ifdef __linux__
 
1027
      if(restore_loglevel){
 
1028
        ret = klogctl(7, NULL, 0);
 
1029
        if(ret == -1){
 
1030
          perror("klogctl");
 
1031
        }
 
1032
      }
 
1033
#endif
 
1034
      exitcode = EXIT_FAILURE;
 
1035
      goto end;
 
1036
    }
 
1037
    if((network.ifr_flags & IFF_UP) == 0){
 
1038
      network.ifr_flags |= IFF_UP;
 
1039
      ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
1040
      if(ret == -1){
 
1041
        perror("ioctl SIOCSIFFLAGS");
 
1042
        exitcode = EXIT_FAILURE;
 
1043
#ifdef __linux__
 
1044
        if(restore_loglevel){
 
1045
          ret = klogctl(7, NULL, 0);
 
1046
          if(ret == -1){
 
1047
            perror("klogctl");
895
1048
          }
896
 
          break;
897
 
        case 130:               /* --priority */
898
 
          mc.priority = arg;
899
 
          break;
900
 
        case ARGP_KEY_ARG:
901
 
          argp_usage (state);
902
 
        case ARGP_KEY_END:
903
 
          break;
904
 
        default:
905
 
          return ARGP_ERR_UNKNOWN;
906
1049
        }
907
 
        return 0;
908
 
      }
909
 
      
910
 
      struct argp argp = { .options = options, .parser = parse_opt,
911
 
                           .args_doc = "",
912
 
                           .doc = "Mandos client -- Get and decrypt"
913
 
                           " passwords from a Mandos server" };
914
 
      ret = argp_parse (&argp, argc, argv, 0, 0, NULL);
915
 
      if (ret == ARGP_ERR_UNKNOWN){
916
 
        fprintf(stderr, "Unknown error while parsing arguments\n");
917
 
        exitcode = EXIT_FAILURE;
 
1050
#endif
918
1051
        goto end;
919
1052
      }
920
1053
    }
921
 
    
922
 
    /* If the interface is down, bring it up */
923
 
    {
924
 
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
925
 
      if(sd < 0) {
926
 
        perror("socket");
927
 
        exitcode = EXIT_FAILURE;
928
 
        goto end;
929
 
      }
930
 
      strcpy(network.ifr_name, interface);
 
1054
    /* sleep checking until interface is running */
 
1055
    for(int i=0; i < delay * 4; i++){
931
1056
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
932
1057
      if(ret == -1){
933
1058
        perror("ioctl SIOCGIFFLAGS");
934
 
        exitcode = EXIT_FAILURE;
935
 
        goto end;
936
 
      }
937
 
      if((network.ifr_flags & IFF_UP) == 0){
938
 
        network.ifr_flags |= IFF_UP;
939
 
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
940
 
        if(ret == -1){
941
 
          perror("ioctl SIOCSIFFLAGS");
942
 
          exitcode = EXIT_FAILURE;
943
 
          goto end;
944
 
        }
945
 
      }
946
 
      ret = TEMP_FAILURE_RETRY(close(sd));
 
1059
      } else if(network.ifr_flags & IFF_RUNNING){
 
1060
        break;
 
1061
      }
 
1062
      struct timespec sleeptime = { .tv_nsec = 250000000 };
 
1063
      ret = nanosleep(&sleeptime, NULL);
 
1064
      if(ret == -1 and errno != EINTR){
 
1065
        perror("nanosleep");
 
1066
      }
 
1067
    }
 
1068
    ret = (int)TEMP_FAILURE_RETRY(close(sd));
 
1069
    if(ret == -1){
 
1070
      perror("close");
 
1071
    }
 
1072
#ifdef __linux__
 
1073
    if(restore_loglevel){
 
1074
      /* Restores kernel loglevel to default */
 
1075
      ret = klogctl(7, NULL, 0);
947
1076
      if(ret == -1){
948
 
        perror("close");
 
1077
        perror("klogctl");
949
1078
      }
950
1079
    }
951
 
    
952
 
    uid = getuid();
953
 
    gid = getgid();
954
 
    
955
 
    ret = setuid(uid);
956
 
    if (ret == -1){
957
 
      perror("setuid");
958
 
    }
959
 
    
960
 
    setgid(gid);
961
 
    if (ret == -1){
962
 
      perror("setgid");
963
 
    }
964
 
    
965
 
    ret = init_gnutls_global(&mc, pubkey, seckey);
966
 
    if (ret == -1){
967
 
      fprintf(stderr, "init_gnutls_global failed\n");
968
 
      exitcode = EXIT_FAILURE;
969
 
      goto end;
970
 
    } else {
971
 
      gnutls_initalized = true;
972
 
    }
973
 
    
974
 
    if(mkdtemp(tempdir) == NULL){
975
 
      perror("mkdtemp");
976
 
      tempdir[0] = '\0';
977
 
      goto end;
978
 
    }
979
 
    
980
 
    if(not init_gpgme(&mc, pubkey, seckey, tempdir)){
981
 
      fprintf(stderr, "gpgme_initalized failed\n");
982
 
      exitcode = EXIT_FAILURE;
983
 
      goto end;
984
 
    } else {
985
 
      gpgme_initalized = true;
986
 
    }
987
 
    
 
1080
#endif
 
1081
  }
 
1082
  
 
1083
  uid = getuid();
 
1084
  gid = getgid();
 
1085
  
 
1086
  errno = 0;
 
1087
  setgid(gid);
 
1088
  if(ret == -1){
 
1089
    perror("setgid");
 
1090
  }
 
1091
  
 
1092
  ret = setuid(uid);
 
1093
  if(ret == -1){
 
1094
    perror("setuid");
 
1095
  }
 
1096
  
 
1097
  ret = init_gnutls_global(&mc, pubkey, seckey);
 
1098
  if(ret == -1){
 
1099
    fprintf(stderr, "init_gnutls_global failed\n");
 
1100
    exitcode = EXIT_FAILURE;
 
1101
    goto end;
 
1102
  } else {
 
1103
    gnutls_initialized = true;
 
1104
  }
 
1105
  
 
1106
  if(mkdtemp(tempdir) == NULL){
 
1107
    perror("mkdtemp");
 
1108
    goto end;
 
1109
  }
 
1110
  tempdir_created = true;
 
1111
  
 
1112
  if(not init_gpgme(&mc, pubkey, seckey, tempdir)){
 
1113
    fprintf(stderr, "init_gpgme failed\n");
 
1114
    exitcode = EXIT_FAILURE;
 
1115
    goto end;
 
1116
  } else {
 
1117
    gpgme_initialized = true;
 
1118
  }
 
1119
  
 
1120
  if(interface[0] != '\0'){
988
1121
    if_index = (AvahiIfIndex) if_nametoindex(interface);
989
1122
    if(if_index == 0){
990
1123
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
991
 
      exit(EXIT_FAILURE);
992
 
    }
993
 
    
994
 
    if(connect_to != NULL){
995
 
      /* Connect directly, do not use Zeroconf */
996
 
      /* (Mainly meant for debugging) */
997
 
      char *address = strrchr(connect_to, ':');
998
 
      if(address == NULL){
999
 
        fprintf(stderr, "No colon in address\n");
1000
 
        exitcode = EXIT_FAILURE;
1001
 
        goto end;
1002
 
      }
1003
 
      errno = 0;
1004
 
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
1005
 
      if(errno){
1006
 
        perror("Bad port number");
1007
 
        exitcode = EXIT_FAILURE;
1008
 
        goto end;
1009
 
      }
1010
 
      *address = '\0';
1011
 
      address = connect_to;
1012
 
      ret = start_mandos_communication(address, port, if_index, &mc);
1013
 
      if(ret < 0){
1014
 
        exitcode = EXIT_FAILURE;
1015
 
      } else {
1016
 
        exitcode = EXIT_SUCCESS;
1017
 
      }
1018
 
      goto end;
1019
 
    }
1020
 
    
1021
 
    if (not debug){
1022
 
      avahi_set_log_function(empty_log);
1023
 
    }
1024
 
    
1025
 
    /* Initialize the pseudo-RNG for Avahi */
1026
 
    srand((unsigned int) time(NULL));
1027
 
    
1028
 
    /* Allocate main Avahi loop object */
1029
 
    mc.simple_poll = avahi_simple_poll_new();
1030
 
    if (mc.simple_poll == NULL) {
1031
 
        fprintf(stderr, "Avahi: Failed to create simple poll"
1032
 
                " object.\n");
1033
 
        exitcode = EXIT_FAILURE;
1034
 
        goto end;
1035
 
    }
1036
 
    
1037
 
    {
1038
 
      AvahiServerConfig config;
1039
 
      /* Do not publish any local Zeroconf records */
1040
 
      avahi_server_config_init(&config);
1041
 
      config.publish_hinfo = 0;
1042
 
      config.publish_addresses = 0;
1043
 
      config.publish_workstation = 0;
1044
 
      config.publish_domain = 0;
1045
 
      
1046
 
      /* Allocate a new server */
1047
 
      mc.server = avahi_server_new(avahi_simple_poll_get
1048
 
                                   (mc.simple_poll), &config, NULL,
1049
 
                                   NULL, &error);
1050
 
      
1051
 
      /* Free the Avahi configuration data */
1052
 
      avahi_server_config_free(&config);
1053
 
    }
1054
 
    
1055
 
    /* Check if creating the Avahi server object succeeded */
1056
 
    if (mc.server == NULL) {
1057
 
        fprintf(stderr, "Failed to create Avahi server: %s\n",
1058
 
                avahi_strerror(error));
1059
 
        exitcode = EXIT_FAILURE;
1060
 
        goto end;
1061
 
    }
1062
 
    
1063
 
    /* Create the Avahi service browser */
1064
 
    sb = avahi_s_service_browser_new(mc.server, if_index,
1065
 
                                     AVAHI_PROTO_INET6,
1066
 
                                     "_mandos._tcp", NULL, 0,
1067
 
                                     browse_callback, &mc);
1068
 
    if (sb == NULL) {
1069
 
        fprintf(stderr, "Failed to create service browser: %s\n",
1070
 
                avahi_strerror(avahi_server_errno(mc.server)));
1071
 
        exitcode = EXIT_FAILURE;
1072
 
        goto end;
1073
 
    }
1074
 
    
1075
 
    /* Run the main loop */
1076
 
    
1077
 
    if (debug){
1078
 
      fprintf(stderr, "Starting Avahi loop search\n");
1079
 
    }
1080
 
    
1081
 
    avahi_simple_poll_loop(mc.simple_poll);
1082
 
    
 
1124
      exitcode = EXIT_FAILURE;
 
1125
      goto end;
 
1126
    }
 
1127
  }
 
1128
  
 
1129
  if(connect_to != NULL){
 
1130
    /* Connect directly, do not use Zeroconf */
 
1131
    /* (Mainly meant for debugging) */
 
1132
    char *address = strrchr(connect_to, ':');
 
1133
    if(address == NULL){
 
1134
      fprintf(stderr, "No colon in address\n");
 
1135
      exitcode = EXIT_FAILURE;
 
1136
      goto end;
 
1137
    }
 
1138
    uint16_t port;
 
1139
    ret = sscanf(address+1, "%" SCNdMAX "%n", &tmpmax, &numchars);
 
1140
    if(ret < 1 or tmpmax != (uint16_t)tmpmax
 
1141
       or address[numchars+1] != '\0'){
 
1142
      fprintf(stderr, "Bad port number\n");
 
1143
      exitcode = EXIT_FAILURE;
 
1144
      goto end;
 
1145
    }
 
1146
    port = (uint16_t)tmpmax;
 
1147
    *address = '\0';
 
1148
    address = connect_to;
 
1149
    /* Colon in address indicates IPv6 */
 
1150
    int af;
 
1151
    if(strchr(address, ':') != NULL){
 
1152
      af = AF_INET6;
 
1153
    } else {
 
1154
      af = AF_INET;
 
1155
    }
 
1156
    ret = start_mandos_communication(address, port, if_index, &mc,
 
1157
                                     af);
 
1158
    if(ret < 0){
 
1159
      exitcode = EXIT_FAILURE;
 
1160
    } else {
 
1161
      exitcode = EXIT_SUCCESS;
 
1162
    }
 
1163
    goto end;
 
1164
  }
 
1165
  
 
1166
  if(not debug){
 
1167
    avahi_set_log_function(empty_log);
 
1168
  }
 
1169
  
 
1170
  /* Initialize the pseudo-RNG for Avahi */
 
1171
  srand((unsigned int) time(NULL));
 
1172
  
 
1173
  /* Allocate main Avahi loop object */
 
1174
  mc.simple_poll = avahi_simple_poll_new();
 
1175
  if(mc.simple_poll == NULL){
 
1176
    fprintf(stderr, "Avahi: Failed to create simple poll object.\n");
 
1177
    exitcode = EXIT_FAILURE;
 
1178
    goto end;
 
1179
  }
 
1180
  
 
1181
  {
 
1182
    AvahiServerConfig config;
 
1183
    /* Do not publish any local Zeroconf records */
 
1184
    avahi_server_config_init(&config);
 
1185
    config.publish_hinfo = 0;
 
1186
    config.publish_addresses = 0;
 
1187
    config.publish_workstation = 0;
 
1188
    config.publish_domain = 0;
 
1189
    
 
1190
    /* Allocate a new server */
 
1191
    mc.server = avahi_server_new(avahi_simple_poll_get
 
1192
                                 (mc.simple_poll), &config, NULL,
 
1193
                                 NULL, &error);
 
1194
    
 
1195
    /* Free the Avahi configuration data */
 
1196
    avahi_server_config_free(&config);
 
1197
  }
 
1198
  
 
1199
  /* Check if creating the Avahi server object succeeded */
 
1200
  if(mc.server == NULL){
 
1201
    fprintf(stderr, "Failed to create Avahi server: %s\n",
 
1202
            avahi_strerror(error));
 
1203
    exitcode = EXIT_FAILURE;
 
1204
    goto end;
 
1205
  }
 
1206
  
 
1207
  /* Create the Avahi service browser */
 
1208
  sb = avahi_s_service_browser_new(mc.server, if_index,
 
1209
                                   AVAHI_PROTO_INET6, "_mandos._tcp",
 
1210
                                   NULL, 0, browse_callback, &mc);
 
1211
  if(sb == NULL){
 
1212
    fprintf(stderr, "Failed to create service browser: %s\n",
 
1213
            avahi_strerror(avahi_server_errno(mc.server)));
 
1214
    exitcode = EXIT_FAILURE;
 
1215
    goto end;
 
1216
  }
 
1217
  
 
1218
  /* Run the main loop */
 
1219
  
 
1220
  if(debug){
 
1221
    fprintf(stderr, "Starting Avahi loop search\n");
 
1222
  }
 
1223
  
 
1224
  avahi_simple_poll_loop(mc.simple_poll);
 
1225
  
1083
1226
 end:
1084
 
    
1085
 
    if (debug){
1086
 
      fprintf(stderr, "%s exiting\n", argv[0]);
1087
 
    }
1088
 
    
1089
 
    /* Cleanup things */
1090
 
    if (sb != NULL)
1091
 
        avahi_s_service_browser_free(sb);
1092
 
    
1093
 
    if (mc.server != NULL)
1094
 
        avahi_server_free(mc.server);
1095
 
    
1096
 
    if (mc.simple_poll != NULL)
1097
 
        avahi_simple_poll_free(mc.simple_poll);
1098
 
    
1099
 
    if (gnutls_initalized){
1100
 
      gnutls_certificate_free_credentials(mc.cred);
1101
 
      gnutls_global_deinit ();
1102
 
      gnutls_dh_params_deinit(mc.dh_params);
1103
 
    }
1104
 
    
1105
 
    if(gpgme_initalized){
1106
 
      gpgme_release(mc.ctx);
1107
 
    }
1108
 
    
1109
 
    /* Removes the temp directory used by GPGME */
1110
 
    if(tempdir[0] != '\0'){
1111
 
      DIR *d;
1112
 
      struct dirent *direntry;
1113
 
      d = opendir(tempdir);
1114
 
      if(d == NULL){
 
1227
  
 
1228
  if(debug){
 
1229
    fprintf(stderr, "%s exiting\n", argv[0]);
 
1230
  }
 
1231
  
 
1232
  /* Cleanup things */
 
1233
  if(sb != NULL)
 
1234
    avahi_s_service_browser_free(sb);
 
1235
  
 
1236
  if(mc.server != NULL)
 
1237
    avahi_server_free(mc.server);
 
1238
  
 
1239
  if(mc.simple_poll != NULL)
 
1240
    avahi_simple_poll_free(mc.simple_poll);
 
1241
  
 
1242
  if(gnutls_initialized){
 
1243
    gnutls_certificate_free_credentials(mc.cred);
 
1244
    gnutls_global_deinit();
 
1245
    gnutls_dh_params_deinit(mc.dh_params);
 
1246
  }
 
1247
  
 
1248
  if(gpgme_initialized){
 
1249
    gpgme_release(mc.ctx);
 
1250
  }
 
1251
  
 
1252
  /* Removes the temp directory used by GPGME */
 
1253
  if(tempdir_created){
 
1254
    DIR *d;
 
1255
    struct dirent *direntry;
 
1256
    d = opendir(tempdir);
 
1257
    if(d == NULL){
 
1258
      if(errno != ENOENT){
1115
1259
        perror("opendir");
1116
 
      } else {
1117
 
        while(true){
1118
 
          direntry = readdir(d);
1119
 
          if(direntry == NULL){
1120
 
            break;
1121
 
          }
1122
 
          if (direntry->d_type == DT_REG){
1123
 
            char *fullname = NULL;
1124
 
            ret = asprintf(&fullname, "%s/%s", tempdir,
1125
 
                           direntry->d_name);
1126
 
            if(ret < 0){
1127
 
              perror("asprintf");
1128
 
              continue;
1129
 
            }
1130
 
            ret = unlink(fullname);
1131
 
            if(ret == -1){
1132
 
              fprintf(stderr, "unlink(\"%s\"): %s",
1133
 
                      fullname, strerror(errno));
1134
 
            }
1135
 
            free(fullname);
1136
 
          }
1137
 
        }
1138
 
        closedir(d);
1139
 
      }
1140
 
      ret = rmdir(tempdir);
1141
 
      if(ret == -1){
1142
 
        perror("rmdir");
1143
 
      }
1144
 
    }
1145
 
          
1146
 
    return exitcode;
 
1260
      }
 
1261
    } else {
 
1262
      while(true){
 
1263
        direntry = readdir(d);
 
1264
        if(direntry == NULL){
 
1265
          break;
 
1266
        }
 
1267
        /* Skip "." and ".." */
 
1268
        if(direntry->d_name[0] == '.'
 
1269
           and (direntry->d_name[1] == '\0'
 
1270
                or (direntry->d_name[1] == '.'
 
1271
                    and direntry->d_name[2] == '\0'))){
 
1272
          continue;
 
1273
        }
 
1274
        char *fullname = NULL;
 
1275
        ret = asprintf(&fullname, "%s/%s", tempdir,
 
1276
                       direntry->d_name);
 
1277
        if(ret < 0){
 
1278
          perror("asprintf");
 
1279
          continue;
 
1280
        }
 
1281
        ret = remove(fullname);
 
1282
        if(ret == -1){
 
1283
          fprintf(stderr, "remove(\"%s\"): %s\n", fullname,
 
1284
                  strerror(errno));
 
1285
        }
 
1286
        free(fullname);
 
1287
      }
 
1288
      closedir(d);
 
1289
    }
 
1290
    ret = rmdir(tempdir);
 
1291
    if(ret == -1 and errno != ENOENT){
 
1292
      perror("rmdir");
 
1293
    }
 
1294
  }
 
1295
  
 
1296
  return exitcode;
1147
1297
}