/mandos/trunk

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

« back to all changes in this revision

Viewing changes to plugins.d/mandos-client.c

  • Committer: Teddy Hogeborn
  • Date: 2009-09-07 23:48:17 UTC
  • Revision ID: teddy@fukt.bsnet.se-20090907234817-op1lgg9gpruejsiv
* initramfs-tools-hook: Bug fix: Really install user-supplied plugins.
                        Bug fix: Warn about empty plugin directory.

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
29
30
 */
30
31
 
31
32
/* Needed by GPGME, specifically gpgme_data_seek() */
 
33
#ifndef _LARGEFILE_SOURCE
32
34
#define _LARGEFILE_SOURCE
 
35
#endif
 
36
#ifndef _FILE_OFFSET_BITS
33
37
#define _FILE_OFFSET_BITS 64
34
 
 
35
 
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY() */
36
 
 
37
 
#include <stdio.h>              /* fprintf(), stderr, fwrite(), stdout,
38
 
                                   ferror() */
 
38
#endif
 
39
 
 
40
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY(), asprintf() */
 
41
 
 
42
#include <stdio.h>              /* fprintf(), stderr, fwrite(),
 
43
                                   stdout, ferror(), remove() */
39
44
#include <stdint.h>             /* uint16_t, uint32_t */
40
45
#include <stddef.h>             /* NULL, size_t, ssize_t */
41
46
#include <stdlib.h>             /* free(), EXIT_SUCCESS, EXIT_FAILURE,
42
 
                                   srand() */
43
 
#include <stdbool.h>            /* bool, true */
 
47
                                   srand(), strtof() */
 
48
#include <stdbool.h>            /* bool, false, true */
44
49
#include <string.h>             /* memset(), strcmp(), strlen(),
45
 
                                   strerror(), memcpy(), strcpy() */
46
 
#include <sys/ioctl.h>          /* ioctl */
47
 
#include <net/if.h>             /* ifreq, SIOCGIFFLAGS, SIOCSIFFLAGS,
48
 
                                   IFF_UP */
 
50
                                   strerror(), asprintf(), strcpy() */
 
51
#include <sys/ioctl.h>          /* ioctl */
49
52
#include <sys/types.h>          /* socket(), inet_pton(), sockaddr,
50
53
                                   sockaddr_in6, PF_INET6,
51
 
                                   SOCK_STREAM, INET6_ADDRSTRLEN,
52
 
                                   uid_t, gid_t */
53
 
#include <inttypes.h>           /* PRIu16 */
 
54
                                   SOCK_STREAM, uid_t, gid_t, open(),
 
55
                                   opendir(), DIR */
 
56
#include <sys/stat.h>           /* open() */
54
57
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
55
 
                                   struct in6_addr, inet_pton(),
56
 
                                   connect() */
 
58
                                   inet_pton(), connect() */
 
59
#include <fcntl.h>              /* open() */
 
60
#include <dirent.h>             /* opendir(), struct dirent, readdir()
 
61
                                 */
 
62
#include <inttypes.h>           /* PRIu16, PRIdMAX, intmax_t,
 
63
                                   strtoimax() */
57
64
#include <assert.h>             /* assert() */
58
65
#include <errno.h>              /* perror(), errno */
59
 
#include <time.h>               /* time() */
 
66
#include <time.h>               /* nanosleep(), time() */
60
67
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
61
68
                                   SIOCSIFFLAGS, if_indextoname(),
62
69
                                   if_nametoindex(), IF_NAMESIZE */
 
70
#include <netinet/in.h>         /* IN6_IS_ADDR_LINKLOCAL,
 
71
                                   INET_ADDRSTRLEN, INET6_ADDRSTRLEN
 
72
                                */
63
73
#include <unistd.h>             /* close(), SEEK_SET, off_t, write(),
64
74
                                   getuid(), getgid(), setuid(),
65
75
                                   setgid() */
66
 
#include <netinet/in.h>
67
76
#include <arpa/inet.h>          /* inet_pton(), htons */
68
 
#include <iso646.h>             /* not, and */
 
77
#include <iso646.h>             /* not, or, and */
69
78
#include <argp.h>               /* struct argp_option, error_t, struct
70
79
                                   argp_state, struct argp,
71
80
                                   argp_parse(), ARGP_KEY_ARG,
72
81
                                   ARGP_KEY_END, ARGP_ERR_UNKNOWN */
 
82
#include <signal.h>             /* sigemptyset(), sigaddset(),
 
83
                                   sigaction(), SIGTERM, sig_atomic_t,
 
84
                                   raise() */
 
85
 
 
86
#ifdef __linux__
 
87
#include <sys/klog.h>           /* klogctl() */
 
88
#endif  /* __linux__ */
73
89
 
74
90
/* Avahi */
75
91
/* All Avahi types, constants and functions
83
99
#include <avahi-common/error.h>
84
100
 
85
101
/* GnuTLS */
86
 
#include <gnutls/gnutls.h>      /* All GnuTLS types, constants and functions
 
102
#include <gnutls/gnutls.h>      /* All GnuTLS types, constants and
 
103
                                   functions:
87
104
                                   gnutls_*
88
105
                                   init_gnutls_session(),
89
106
                                   GNUTLS_* */
90
 
#include <gnutls/openpgp.h>     /* gnutls_certificate_set_openpgp_key_file(),
 
107
#include <gnutls/openpgp.h>
 
108
                          /* gnutls_certificate_set_openpgp_key_file(),
91
109
                                   GNUTLS_OPENPGP_FMT_BASE64 */
92
110
 
93
111
/* GPGME */
94
 
#include <gpgme.h>              /* All GPGME types, constants and functions
 
112
#include <gpgme.h>              /* All GPGME types, constants and
 
113
                                   functions:
95
114
                                   gpgme_*
96
115
                                   GPGME_PROTOCOL_OpenPGP,
97
116
                                   GPG_ERR_NO_* */
98
117
 
99
118
#define BUFFER_SIZE 256
100
119
 
 
120
#define PATHDIR "/conf/conf.d/mandos"
 
121
#define SECKEY "seckey.txt"
 
122
#define PUBKEY "pubkey.txt"
 
123
 
101
124
bool debug = false;
102
 
static const char *keydir = "/conf/conf.d/mandos";
103
125
static const char mandos_protocol_version[] = "1";
104
 
const char *argp_program_version = "password-request 1.0";
 
126
const char *argp_program_version = "mandos-client " VERSION;
105
127
const char *argp_program_bug_address = "<mandos@fukt.bsnet.se>";
106
128
 
107
129
/* Used for passing in values through the Avahi callback functions */
112
134
  unsigned int dh_bits;
113
135
  gnutls_dh_params_t dh_params;
114
136
  const char *priority;
 
137
  gpgme_ctx_t ctx;
115
138
} mandos_context;
116
139
 
 
140
/* global context so signal handler can reach it*/
 
141
mandos_context mc = { .simple_poll = NULL, .server = NULL,
 
142
                      .dh_bits = 1024, .priority = "SECURE256"
 
143
                      ":!CTYPE-X.509:+CTYPE-OPENPGP" };
 
144
 
117
145
/*
118
 
 * Make room in "buffer" for at least BUFFER_SIZE additional bytes.
119
 
 * "buffer_capacity" is how much is currently allocated,
 
146
 * Make additional room in "buffer" for at least BUFFER_SIZE more
 
147
 * bytes. "buffer_capacity" is how much is currently allocated,
120
148
 * "buffer_length" is how much is already used.
121
149
 */
122
 
size_t adjustbuffer(char **buffer, size_t buffer_length,
 
150
size_t incbuffer(char **buffer, size_t buffer_length,
123
151
                  size_t buffer_capacity){
124
 
  if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
152
  if(buffer_length + BUFFER_SIZE > buffer_capacity){
125
153
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
126
 
    if (buffer == NULL){
 
154
    if(buffer == NULL){
127
155
      return 0;
128
156
    }
129
157
    buffer_capacity += BUFFER_SIZE;
132
160
}
133
161
 
134
162
/* 
135
 
 * Decrypt OpenPGP data using keyrings in HOMEDIR.
136
 
 * Returns -1 on error
 
163
 * Initialize GPGME.
137
164
 */
138
 
static ssize_t pgp_packet_decrypt (const char *cryptotext,
139
 
                                   size_t crypto_size,
140
 
                                   char **plaintext,
141
 
                                   const char *homedir){
142
 
  gpgme_data_t dh_crypto, dh_plain;
143
 
  gpgme_ctx_t ctx;
 
165
static bool init_gpgme(const char *seckey,
 
166
                       const char *pubkey, const char *tempdir){
144
167
  gpgme_error_t rc;
145
 
  ssize_t ret;
146
 
  size_t plaintext_capacity = 0;
147
 
  ssize_t plaintext_length = 0;
148
168
  gpgme_engine_info_t engine_info;
149
169
  
150
 
  if (debug){
151
 
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
 
170
  
 
171
  /*
 
172
   * Helper function to insert pub and seckey to the engine keyring.
 
173
   */
 
174
  bool import_key(const char *filename){
 
175
    int ret;
 
176
    int fd;
 
177
    gpgme_data_t pgp_data;
 
178
    
 
179
    fd = (int)TEMP_FAILURE_RETRY(open(filename, O_RDONLY));
 
180
    if(fd == -1){
 
181
      perror("open");
 
182
      return false;
 
183
    }
 
184
    
 
185
    rc = gpgme_data_new_from_fd(&pgp_data, fd);
 
186
    if(rc != GPG_ERR_NO_ERROR){
 
187
      fprintf(stderr, "bad gpgme_data_new_from_fd: %s: %s\n",
 
188
              gpgme_strsource(rc), gpgme_strerror(rc));
 
189
      return false;
 
190
    }
 
191
    
 
192
    rc = gpgme_op_import(mc.ctx, pgp_data);
 
193
    if(rc != GPG_ERR_NO_ERROR){
 
194
      fprintf(stderr, "bad gpgme_op_import: %s: %s\n",
 
195
              gpgme_strsource(rc), gpgme_strerror(rc));
 
196
      return false;
 
197
    }
 
198
    
 
199
    ret = (int)TEMP_FAILURE_RETRY(close(fd));
 
200
    if(ret == -1){
 
201
      perror("close");
 
202
    }
 
203
    gpgme_data_release(pgp_data);
 
204
    return true;
 
205
  }
 
206
  
 
207
  if(debug){
 
208
    fprintf(stderr, "Initializing GPGME\n");
152
209
  }
153
210
  
154
211
  /* Init GPGME */
155
212
  gpgme_check_version(NULL);
156
213
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
157
 
  if (rc != GPG_ERR_NO_ERROR){
 
214
  if(rc != GPG_ERR_NO_ERROR){
158
215
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
159
216
            gpgme_strsource(rc), gpgme_strerror(rc));
160
 
    return -1;
 
217
    return false;
161
218
  }
162
219
  
163
 
  /* Set GPGME home directory for the OpenPGP engine only */
164
 
  rc = gpgme_get_engine_info (&engine_info);
165
 
  if (rc != GPG_ERR_NO_ERROR){
 
220
    /* Set GPGME home directory for the OpenPGP engine only */
 
221
  rc = gpgme_get_engine_info(&engine_info);
 
222
  if(rc != GPG_ERR_NO_ERROR){
166
223
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
167
224
            gpgme_strsource(rc), gpgme_strerror(rc));
168
 
    return -1;
 
225
    return false;
169
226
  }
170
227
  while(engine_info != NULL){
171
228
    if(engine_info->protocol == GPGME_PROTOCOL_OpenPGP){
172
229
      gpgme_set_engine_info(GPGME_PROTOCOL_OpenPGP,
173
 
                            engine_info->file_name, homedir);
 
230
                            engine_info->file_name, tempdir);
174
231
      break;
175
232
    }
176
233
    engine_info = engine_info->next;
177
234
  }
178
235
  if(engine_info == NULL){
179
 
    fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
180
 
    return -1;
 
236
    fprintf(stderr, "Could not set GPGME home dir to %s\n", tempdir);
 
237
    return false;
 
238
  }
 
239
  
 
240
  /* Create new GPGME "context" */
 
241
  rc = gpgme_new(&(mc.ctx));
 
242
  if(rc != GPG_ERR_NO_ERROR){
 
243
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
 
244
            gpgme_strsource(rc), gpgme_strerror(rc));
 
245
    return false;
 
246
  }
 
247
  
 
248
  if(not import_key(pubkey) or not import_key(seckey)){
 
249
    return false;
 
250
  }
 
251
  
 
252
  return true;
 
253
}
 
254
 
 
255
/* 
 
256
 * Decrypt OpenPGP data.
 
257
 * Returns -1 on error
 
258
 */
 
259
static ssize_t pgp_packet_decrypt(const char *cryptotext,
 
260
                                  size_t crypto_size,
 
261
                                  char **plaintext){
 
262
  gpgme_data_t dh_crypto, dh_plain;
 
263
  gpgme_error_t rc;
 
264
  ssize_t ret;
 
265
  size_t plaintext_capacity = 0;
 
266
  ssize_t plaintext_length = 0;
 
267
  
 
268
  if(debug){
 
269
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
181
270
  }
182
271
  
183
272
  /* Create new GPGME data buffer from memory cryptotext */
184
273
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
185
274
                               0);
186
 
  if (rc != GPG_ERR_NO_ERROR){
 
275
  if(rc != GPG_ERR_NO_ERROR){
187
276
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
188
277
            gpgme_strsource(rc), gpgme_strerror(rc));
189
278
    return -1;
191
280
  
192
281
  /* Create new empty GPGME data buffer for the plaintext */
193
282
  rc = gpgme_data_new(&dh_plain);
194
 
  if (rc != GPG_ERR_NO_ERROR){
 
283
  if(rc != GPG_ERR_NO_ERROR){
195
284
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
196
285
            gpgme_strsource(rc), gpgme_strerror(rc));
197
286
    gpgme_data_release(dh_crypto);
198
287
    return -1;
199
288
  }
200
289
  
201
 
  /* Create new GPGME "context" */
202
 
  rc = gpgme_new(&ctx);
203
 
  if (rc != GPG_ERR_NO_ERROR){
204
 
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
205
 
            gpgme_strsource(rc), gpgme_strerror(rc));
206
 
    plaintext_length = -1;
207
 
    goto decrypt_end;
208
 
  }
209
 
  
210
290
  /* Decrypt data from the cryptotext data buffer to the plaintext
211
291
     data buffer */
212
 
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
213
 
  if (rc != GPG_ERR_NO_ERROR){
 
292
  rc = gpgme_op_decrypt(mc.ctx, dh_crypto, dh_plain);
 
293
  if(rc != GPG_ERR_NO_ERROR){
214
294
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
215
295
            gpgme_strsource(rc), gpgme_strerror(rc));
216
296
    plaintext_length = -1;
217
 
    goto decrypt_end;
218
 
  }
219
 
  
220
 
  if(debug){
221
 
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
222
 
  }
223
 
  
224
 
  if (debug){
225
 
    gpgme_decrypt_result_t result;
226
 
    result = gpgme_op_decrypt_result(ctx);
227
 
    if (result == NULL){
228
 
      fprintf(stderr, "gpgme_op_decrypt_result failed\n");
229
 
    } else {
230
 
      fprintf(stderr, "Unsupported algorithm: %s\n",
231
 
              result->unsupported_algorithm);
232
 
      fprintf(stderr, "Wrong key usage: %u\n",
233
 
              result->wrong_key_usage);
234
 
      if(result->file_name != NULL){
235
 
        fprintf(stderr, "File name: %s\n", result->file_name);
236
 
      }
237
 
      gpgme_recipient_t recipient;
238
 
      recipient = result->recipients;
239
 
      if(recipient){
 
297
    if(debug){
 
298
      gpgme_decrypt_result_t result;
 
299
      result = gpgme_op_decrypt_result(mc.ctx);
 
300
      if(result == NULL){
 
301
        fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
302
      } else {
 
303
        fprintf(stderr, "Unsupported algorithm: %s\n",
 
304
                result->unsupported_algorithm);
 
305
        fprintf(stderr, "Wrong key usage: %u\n",
 
306
                result->wrong_key_usage);
 
307
        if(result->file_name != NULL){
 
308
          fprintf(stderr, "File name: %s\n", result->file_name);
 
309
        }
 
310
        gpgme_recipient_t recipient;
 
311
        recipient = result->recipients;
240
312
        while(recipient != NULL){
241
313
          fprintf(stderr, "Public key algorithm: %s\n",
242
314
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
248
320
        }
249
321
      }
250
322
    }
 
323
    goto decrypt_end;
 
324
  }
 
325
  
 
326
  if(debug){
 
327
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
251
328
  }
252
329
  
253
330
  /* Seek back to the beginning of the GPGME plaintext data buffer */
254
 
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
255
 
    perror("pgpme_data_seek");
 
331
  if(gpgme_data_seek(dh_plain, (off_t)0, SEEK_SET) == -1){
 
332
    perror("gpgme_data_seek");
256
333
    plaintext_length = -1;
257
334
    goto decrypt_end;
258
335
  }
259
336
  
260
337
  *plaintext = NULL;
261
338
  while(true){
262
 
    plaintext_capacity = adjustbuffer(plaintext,
 
339
    plaintext_capacity = incbuffer(plaintext,
263
340
                                      (size_t)plaintext_length,
264
341
                                      plaintext_capacity);
265
 
    if (plaintext_capacity == 0){
266
 
        perror("adjustbuffer");
 
342
    if(plaintext_capacity == 0){
 
343
        perror("incbuffer");
267
344
        plaintext_length = -1;
268
345
        goto decrypt_end;
269
346
    }
271
348
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
272
349
                          BUFFER_SIZE);
273
350
    /* Print the data, if any */
274
 
    if (ret == 0){
 
351
    if(ret == 0){
275
352
      /* EOF */
276
353
      break;
277
354
    }
282
359
    }
283
360
    plaintext_length += ret;
284
361
  }
285
 
 
 
362
  
286
363
  if(debug){
287
364
    fprintf(stderr, "Decrypted password is: ");
288
365
    for(ssize_t i = 0; i < plaintext_length; i++){
301
378
  return plaintext_length;
302
379
}
303
380
 
304
 
static const char * safer_gnutls_strerror (int value) {
305
 
  const char *ret = gnutls_strerror (value);
306
 
  if (ret == NULL)
 
381
static const char * safer_gnutls_strerror(int value){
 
382
  const char *ret = gnutls_strerror(value); /* Spurious warning from
 
383
                                               -Wunreachable-code */
 
384
  if(ret == NULL)
307
385
    ret = "(unknown)";
308
386
  return ret;
309
387
}
314
392
  fprintf(stderr, "GnuTLS: %s", string);
315
393
}
316
394
 
317
 
static int init_gnutls_global(mandos_context *mc,
318
 
                              const char *pubkeyfile,
319
 
                              const char *seckeyfile){
 
395
static int init_gnutls_global(const char *pubkeyfilename,
 
396
                              const char *seckeyfilename){
320
397
  int ret;
321
398
  
322
399
  if(debug){
324
401
  }
325
402
  
326
403
  ret = gnutls_global_init();
327
 
  if (ret != GNUTLS_E_SUCCESS) {
328
 
    fprintf (stderr, "GnuTLS global_init: %s\n",
329
 
             safer_gnutls_strerror(ret));
 
404
  if(ret != GNUTLS_E_SUCCESS){
 
405
    fprintf(stderr, "GnuTLS global_init: %s\n",
 
406
            safer_gnutls_strerror(ret));
330
407
    return -1;
331
408
  }
332
409
  
333
 
  if (debug){
 
410
  if(debug){
334
411
    /* "Use a log level over 10 to enable all debugging options."
335
412
     * - GnuTLS manual
336
413
     */
339
416
  }
340
417
  
341
418
  /* OpenPGP credentials */
342
 
  gnutls_certificate_allocate_credentials(&mc->cred);
343
 
  if (ret != GNUTLS_E_SUCCESS){
344
 
    fprintf (stderr, "GnuTLS memory error: %s\n",
345
 
             safer_gnutls_strerror(ret));
346
 
    gnutls_global_deinit ();
 
419
  gnutls_certificate_allocate_credentials(&mc.cred);
 
420
  if(ret != GNUTLS_E_SUCCESS){
 
421
    fprintf(stderr, "GnuTLS memory error: %s\n", /* Spurious warning
 
422
                                                    from
 
423
                                                    -Wunreachable-code
 
424
                                                 */
 
425
            safer_gnutls_strerror(ret));
 
426
    gnutls_global_deinit();
347
427
    return -1;
348
428
  }
349
429
  
350
430
  if(debug){
351
 
    fprintf(stderr, "Attempting to use OpenPGP certificate %s"
352
 
            " and keyfile %s as GnuTLS credentials\n", pubkeyfile,
353
 
            seckeyfile);
 
431
    fprintf(stderr, "Attempting to use OpenPGP public key %s and"
 
432
            " secret key %s as GnuTLS credentials\n", pubkeyfilename,
 
433
            seckeyfilename);
354
434
  }
355
435
  
356
436
  ret = gnutls_certificate_set_openpgp_key_file
357
 
    (mc->cred, pubkeyfile, seckeyfile, GNUTLS_OPENPGP_FMT_BASE64);
358
 
  if (ret != GNUTLS_E_SUCCESS) {
 
437
    (mc.cred, pubkeyfilename, seckeyfilename,
 
438
     GNUTLS_OPENPGP_FMT_BASE64);
 
439
  if(ret != GNUTLS_E_SUCCESS){
359
440
    fprintf(stderr,
360
441
            "Error[%d] while reading the OpenPGP key pair ('%s',"
361
 
            " '%s')\n", ret, pubkeyfile, seckeyfile);
362
 
    fprintf(stdout, "The GnuTLS error is: %s\n",
 
442
            " '%s')\n", ret, pubkeyfilename, seckeyfilename);
 
443
    fprintf(stderr, "The GnuTLS error is: %s\n",
363
444
            safer_gnutls_strerror(ret));
364
445
    goto globalfail;
365
446
  }
366
447
  
367
448
  /* GnuTLS server initialization */
368
 
  ret = gnutls_dh_params_init(&mc->dh_params);
369
 
  if (ret != GNUTLS_E_SUCCESS) {
370
 
    fprintf (stderr, "Error in GnuTLS DH parameter initialization:"
371
 
             " %s\n", safer_gnutls_strerror(ret));
372
 
    goto globalfail;
373
 
  }
374
 
  ret = gnutls_dh_params_generate2(mc->dh_params, mc->dh_bits);
375
 
  if (ret != GNUTLS_E_SUCCESS) {
376
 
    fprintf (stderr, "Error in GnuTLS prime generation: %s\n",
377
 
             safer_gnutls_strerror(ret));
378
 
    goto globalfail;
379
 
  }
380
 
  
381
 
  gnutls_certificate_set_dh_params(mc->cred, mc->dh_params);
382
 
 
 
449
  ret = gnutls_dh_params_init(&mc.dh_params);
 
450
  if(ret != GNUTLS_E_SUCCESS){
 
451
    fprintf(stderr, "Error in GnuTLS DH parameter initialization:"
 
452
            " %s\n", safer_gnutls_strerror(ret));
 
453
    goto globalfail;
 
454
  }
 
455
  ret = gnutls_dh_params_generate2(mc.dh_params, mc.dh_bits);
 
456
  if(ret != GNUTLS_E_SUCCESS){
 
457
    fprintf(stderr, "Error in GnuTLS prime generation: %s\n",
 
458
            safer_gnutls_strerror(ret));
 
459
    goto globalfail;
 
460
  }
 
461
  
 
462
  gnutls_certificate_set_dh_params(mc.cred, mc.dh_params);
 
463
  
383
464
  return 0;
384
 
 
 
465
  
385
466
 globalfail:
386
 
 
387
 
  gnutls_certificate_free_credentials(mc->cred);
 
467
  
 
468
  gnutls_certificate_free_credentials(mc.cred);
388
469
  gnutls_global_deinit();
 
470
  gnutls_dh_params_deinit(mc.dh_params);
389
471
  return -1;
390
 
 
391
472
}
392
473
 
393
 
static int init_gnutls_session(mandos_context *mc,
394
 
                               gnutls_session_t *session){
 
474
static int init_gnutls_session(gnutls_session_t *session){
395
475
  int ret;
396
476
  /* GnuTLS session creation */
397
477
  ret = gnutls_init(session, GNUTLS_SERVER);
398
 
  if (ret != GNUTLS_E_SUCCESS){
 
478
  if(ret != GNUTLS_E_SUCCESS){
399
479
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
400
480
            safer_gnutls_strerror(ret));
401
481
  }
402
482
  
403
483
  {
404
484
    const char *err;
405
 
    ret = gnutls_priority_set_direct(*session, mc->priority, &err);
406
 
    if (ret != GNUTLS_E_SUCCESS) {
 
485
    ret = gnutls_priority_set_direct(*session, mc.priority, &err);
 
486
    if(ret != GNUTLS_E_SUCCESS){
407
487
      fprintf(stderr, "Syntax error at: %s\n", err);
408
488
      fprintf(stderr, "GnuTLS error: %s\n",
409
489
              safer_gnutls_strerror(ret));
410
 
      gnutls_deinit (*session);
 
490
      gnutls_deinit(*session);
411
491
      return -1;
412
492
    }
413
493
  }
414
494
  
415
495
  ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
416
 
                               mc->cred);
417
 
  if (ret != GNUTLS_E_SUCCESS) {
 
496
                               mc.cred);
 
497
  if(ret != GNUTLS_E_SUCCESS){
418
498
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
419
499
            safer_gnutls_strerror(ret));
420
 
    gnutls_deinit (*session);
 
500
    gnutls_deinit(*session);
421
501
    return -1;
422
502
  }
423
503
  
424
504
  /* ignore client certificate if any. */
425
 
  gnutls_certificate_server_set_request (*session,
426
 
                                         GNUTLS_CERT_IGNORE);
 
505
  gnutls_certificate_server_set_request(*session,
 
506
                                        GNUTLS_CERT_IGNORE);
427
507
  
428
 
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
 
508
  gnutls_dh_set_prime_bits(*session, mc.dh_bits);
429
509
  
430
510
  return 0;
431
511
}
434
514
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
435
515
                      __attribute__((unused)) const char *txt){}
436
516
 
 
517
sig_atomic_t quit_now = 0;
 
518
int signal_received = 0;
 
519
 
437
520
/* Called when a Mandos server is found */
438
521
static int start_mandos_communication(const char *ip, uint16_t port,
439
522
                                      AvahiIfIndex if_index,
440
 
                                      mandos_context *mc){
441
 
  int ret, tcp_sd;
442
 
  union { struct sockaddr in; struct sockaddr_in6 in6; } to;
 
523
                                      int af){
 
524
  int ret, tcp_sd = -1;
 
525
  ssize_t sret;
 
526
  union {
 
527
    struct sockaddr_in in;
 
528
    struct sockaddr_in6 in6;
 
529
  } to;
443
530
  char *buffer = NULL;
444
531
  char *decrypted_buffer;
445
532
  size_t buffer_length = 0;
446
533
  size_t buffer_capacity = 0;
447
 
  ssize_t decrypted_buffer_size;
448
534
  size_t written;
449
535
  int retval = 0;
450
 
  char interface[IF_NAMESIZE];
451
536
  gnutls_session_t session;
452
 
  
453
 
  ret = init_gnutls_session (mc, &session);
454
 
  if (ret != 0){
 
537
  int pf;                       /* Protocol family */
 
538
  
 
539
  if(quit_now){
 
540
    return -1;
 
541
  }
 
542
  
 
543
  switch(af){
 
544
  case AF_INET6:
 
545
    pf = PF_INET6;
 
546
    break;
 
547
  case AF_INET:
 
548
    pf = PF_INET;
 
549
    break;
 
550
  default:
 
551
    fprintf(stderr, "Bad address family: %d\n", af);
 
552
    return -1;
 
553
  }
 
554
  
 
555
  ret = init_gnutls_session(&session);
 
556
  if(ret != 0){
455
557
    return -1;
456
558
  }
457
559
  
458
560
  if(debug){
459
 
    fprintf(stderr, "Setting up a tcp connection to %s, port %" PRIu16
 
561
    fprintf(stderr, "Setting up a TCP connection to %s, port %" PRIu16
460
562
            "\n", ip, port);
461
563
  }
462
564
  
463
 
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
464
 
  if(tcp_sd < 0) {
 
565
  tcp_sd = socket(pf, SOCK_STREAM, 0);
 
566
  if(tcp_sd < 0){
465
567
    perror("socket");
466
 
    return -1;
467
 
  }
468
 
 
469
 
  if(debug){
470
 
    if(if_indextoname((unsigned int)if_index, interface) == NULL){
471
 
      perror("if_indextoname");
472
 
      return -1;
473
 
    }
474
 
    fprintf(stderr, "Binding to interface %s\n", interface);
475
 
  }
476
 
  
477
 
  memset(&to,0,sizeof(to));     /* Spurious warning */
478
 
  to.in6.sin6_family = AF_INET6;
479
 
  /* It would be nice to have a way to detect if we were passed an
480
 
     IPv4 address here.   Now we assume an IPv6 address. */
481
 
  ret = inet_pton(AF_INET6, ip, &to.in6.sin6_addr);
482
 
  if (ret < 0 ){
 
568
    retval = -1;
 
569
    goto mandos_end;
 
570
  }
 
571
  
 
572
  if(quit_now){
 
573
    goto mandos_end;
 
574
  }
 
575
  
 
576
  memset(&to, 0, sizeof(to));
 
577
  if(af == AF_INET6){
 
578
    to.in6.sin6_family = (sa_family_t)af;
 
579
    ret = inet_pton(af, ip, &to.in6.sin6_addr);
 
580
  } else {                      /* IPv4 */
 
581
    to.in.sin_family = (sa_family_t)af;
 
582
    ret = inet_pton(af, ip, &to.in.sin_addr);
 
583
  }
 
584
  if(ret < 0 ){
483
585
    perror("inet_pton");
484
 
    return -1;
 
586
    retval = -1;
 
587
    goto mandos_end;
485
588
  }
486
589
  if(ret == 0){
487
590
    fprintf(stderr, "Bad address: %s\n", ip);
488
 
    return -1;
489
 
  }
490
 
  to.in6.sin6_port = htons(port);       /* Spurious warning */
 
591
    retval = -1;
 
592
    goto mandos_end;
 
593
  }
 
594
  if(af == AF_INET6){
 
595
    to.in6.sin6_port = htons(port); /* Spurious warnings from
 
596
                                       -Wconversion and
 
597
                                       -Wunreachable-code */
 
598
    
 
599
    if(IN6_IS_ADDR_LINKLOCAL /* Spurious warnings from */
 
600
       (&to.in6.sin6_addr)){ /* -Wstrict-aliasing=2 or lower and
 
601
                              -Wunreachable-code*/
 
602
      if(if_index == AVAHI_IF_UNSPEC){
 
603
        fprintf(stderr, "An IPv6 link-local address is incomplete"
 
604
                " without a network interface\n");
 
605
        retval = -1;
 
606
        goto mandos_end;
 
607
      }
 
608
      /* Set the network interface number as scope */
 
609
      to.in6.sin6_scope_id = (uint32_t)if_index;
 
610
    }
 
611
  } else {
 
612
    to.in.sin_port = htons(port); /* Spurious warnings from
 
613
                                     -Wconversion and
 
614
                                     -Wunreachable-code */
 
615
  }
491
616
  
492
 
  to.in6.sin6_scope_id = (uint32_t)if_index;
 
617
  if(quit_now){
 
618
    goto mandos_end;
 
619
  }
493
620
  
494
621
  if(debug){
495
 
    fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
496
 
            port);
497
 
    char addrstr[INET6_ADDRSTRLEN] = "";
498
 
    if(inet_ntop(to.in6.sin6_family, &(to.in6.sin6_addr), addrstr,
499
 
                 sizeof(addrstr)) == NULL){
 
622
    if(af == AF_INET6 and if_index != AVAHI_IF_UNSPEC){
 
623
      char interface[IF_NAMESIZE];
 
624
      if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
625
        perror("if_indextoname");
 
626
      } else {
 
627
        fprintf(stderr, "Connection to: %s%%%s, port %" PRIu16 "\n",
 
628
                ip, interface, port);
 
629
      }
 
630
    } else {
 
631
      fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
 
632
              port);
 
633
    }
 
634
    char addrstr[(INET_ADDRSTRLEN > INET6_ADDRSTRLEN) ?
 
635
                 INET_ADDRSTRLEN : INET6_ADDRSTRLEN] = "";
 
636
    const char *pcret;
 
637
    if(af == AF_INET6){
 
638
      pcret = inet_ntop(af, &(to.in6.sin6_addr), addrstr,
 
639
                        sizeof(addrstr));
 
640
    } else {
 
641
      pcret = inet_ntop(af, &(to.in.sin_addr), addrstr,
 
642
                        sizeof(addrstr));
 
643
    }
 
644
    if(pcret == NULL){
500
645
      perror("inet_ntop");
501
646
    } else {
502
647
      if(strcmp(addrstr, ip) != 0){
505
650
    }
506
651
  }
507
652
  
508
 
  ret = connect(tcp_sd, &to.in, sizeof(to));
509
 
  if (ret < 0){
 
653
  if(quit_now){
 
654
    goto mandos_end;
 
655
  }
 
656
  
 
657
  if(af == AF_INET6){
 
658
    ret = connect(tcp_sd, &to.in6, sizeof(to));
 
659
  } else {
 
660
    ret = connect(tcp_sd, &to.in, sizeof(to)); /* IPv4 */
 
661
  }
 
662
  if(ret < 0){
510
663
    perror("connect");
511
 
    return -1;
512
 
  }
513
 
 
 
664
    retval = -1;
 
665
    goto mandos_end;
 
666
  }
 
667
  
 
668
  if(quit_now){
 
669
    goto mandos_end;
 
670
  }
 
671
  
514
672
  const char *out = mandos_protocol_version;
515
673
  written = 0;
516
 
  while (true){
 
674
  while(true){
517
675
    size_t out_size = strlen(out);
518
 
    ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
 
676
    ret = (int)TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
519
677
                                   out_size - written));
520
 
    if (ret == -1){
 
678
    if(ret == -1){
521
679
      perror("write");
522
680
      retval = -1;
523
681
      goto mandos_end;
526
684
    if(written < out_size){
527
685
      continue;
528
686
    } else {
529
 
      if (out == mandos_protocol_version){
 
687
      if(out == mandos_protocol_version){
530
688
        written = 0;
531
689
        out = "\r\n";
532
690
      } else {
533
691
        break;
534
692
      }
535
693
    }
 
694
  
 
695
    if(quit_now){
 
696
      goto mandos_end;
 
697
    }
536
698
  }
537
 
 
 
699
  
538
700
  if(debug){
539
701
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
540
702
  }
541
703
  
542
 
  gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
543
 
 
544
 
  do{
545
 
    ret = gnutls_handshake (session);
 
704
  if(quit_now){
 
705
    goto mandos_end;
 
706
  }
 
707
  
 
708
  gnutls_transport_set_ptr(session, (gnutls_transport_ptr_t) tcp_sd);
 
709
  
 
710
  if(quit_now){
 
711
    goto mandos_end;
 
712
  }
 
713
  
 
714
  do {
 
715
    ret = gnutls_handshake(session);
 
716
    if(quit_now){
 
717
      goto mandos_end;
 
718
    }
546
719
  } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
547
720
  
548
 
  if (ret != GNUTLS_E_SUCCESS){
 
721
  if(ret != GNUTLS_E_SUCCESS){
549
722
    if(debug){
550
723
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
551
 
      gnutls_perror (ret);
 
724
      gnutls_perror(ret);
552
725
    }
553
726
    retval = -1;
554
727
    goto mandos_end;
557
730
  /* Read OpenPGP packet that contains the wanted password */
558
731
  
559
732
  if(debug){
560
 
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
 
733
    fprintf(stderr, "Retrieving OpenPGP encrypted password from %s\n",
561
734
            ip);
562
735
  }
563
 
 
 
736
  
564
737
  while(true){
565
 
    buffer_capacity = adjustbuffer(&buffer, buffer_length,
 
738
    
 
739
    if(quit_now){
 
740
      goto mandos_end;
 
741
    }
 
742
    
 
743
    buffer_capacity = incbuffer(&buffer, buffer_length,
566
744
                                   buffer_capacity);
567
 
    if (buffer_capacity == 0){
568
 
      perror("adjustbuffer");
 
745
    if(buffer_capacity == 0){
 
746
      perror("incbuffer");
569
747
      retval = -1;
570
748
      goto mandos_end;
571
749
    }
572
750
    
573
 
    ret = gnutls_record_recv(session, buffer+buffer_length,
574
 
                             BUFFER_SIZE);
575
 
    if (ret == 0){
 
751
    if(quit_now){
 
752
      goto mandos_end;
 
753
    }
 
754
    
 
755
    sret = gnutls_record_recv(session, buffer+buffer_length,
 
756
                              BUFFER_SIZE);
 
757
    if(sret == 0){
576
758
      break;
577
759
    }
578
 
    if (ret < 0){
579
 
      switch(ret){
 
760
    if(sret < 0){
 
761
      switch(sret){
580
762
      case GNUTLS_E_INTERRUPTED:
581
763
      case GNUTLS_E_AGAIN:
582
764
        break;
583
765
      case GNUTLS_E_REHANDSHAKE:
584
 
        do{
585
 
          ret = gnutls_handshake (session);
 
766
        do {
 
767
          ret = gnutls_handshake(session);
 
768
          
 
769
          if(quit_now){
 
770
            goto mandos_end;
 
771
          }
586
772
        } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
587
 
        if (ret < 0){
 
773
        if(ret < 0){
588
774
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
589
 
          gnutls_perror (ret);
 
775
          gnutls_perror(ret);
590
776
          retval = -1;
591
777
          goto mandos_end;
592
778
        }
595
781
        fprintf(stderr, "Unknown error while reading data from"
596
782
                " encrypted session with Mandos server\n");
597
783
        retval = -1;
598
 
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
784
        gnutls_bye(session, GNUTLS_SHUT_RDWR);
599
785
        goto mandos_end;
600
786
      }
601
787
    } else {
602
 
      buffer_length += (size_t) ret;
 
788
      buffer_length += (size_t) sret;
603
789
    }
604
790
  }
605
791
  
607
793
    fprintf(stderr, "Closing TLS session\n");
608
794
  }
609
795
  
610
 
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
611
 
  
612
 
  if (buffer_length > 0){
 
796
  if(quit_now){
 
797
    goto mandos_end;
 
798
  }
 
799
  
 
800
  gnutls_bye(session, GNUTLS_SHUT_RDWR);
 
801
  
 
802
  if(quit_now){
 
803
    goto mandos_end;
 
804
  }
 
805
  
 
806
  if(buffer_length > 0){
 
807
    ssize_t decrypted_buffer_size;
613
808
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
614
809
                                               buffer_length,
615
 
                                               &decrypted_buffer,
616
 
                                               keydir);
617
 
    if (decrypted_buffer_size >= 0){
 
810
                                               &decrypted_buffer);
 
811
    if(decrypted_buffer_size >= 0){
 
812
      
618
813
      written = 0;
619
814
      while(written < (size_t) decrypted_buffer_size){
620
 
        ret = (int)fwrite (decrypted_buffer + written, 1,
621
 
                           (size_t)decrypted_buffer_size - written,
622
 
                           stdout);
 
815
        if(quit_now){
 
816
          goto mandos_end;
 
817
        }
 
818
        
 
819
        ret = (int)fwrite(decrypted_buffer + written, 1,
 
820
                          (size_t)decrypted_buffer_size - written,
 
821
                          stdout);
623
822
        if(ret == 0 and ferror(stdout)){
624
823
          if(debug){
625
824
            fprintf(stderr, "Error writing encrypted data: %s\n",
634
833
    } else {
635
834
      retval = -1;
636
835
    }
 
836
  } else {
 
837
    retval = -1;
637
838
  }
638
839
  
639
840
  /* Shutdown procedure */
640
841
  
641
842
 mandos_end:
642
843
  free(buffer);
643
 
  close(tcp_sd);
644
 
  gnutls_deinit (session);
 
844
  if(tcp_sd >= 0){
 
845
    ret = (int)TEMP_FAILURE_RETRY(close(tcp_sd));
 
846
  }
 
847
  if(ret == -1){
 
848
    perror("close");
 
849
  }
 
850
  gnutls_deinit(session);
 
851
  if(quit_now){
 
852
    retval = -1;
 
853
  }
645
854
  return retval;
646
855
}
647
856
 
648
857
static void resolve_callback(AvahiSServiceResolver *r,
649
858
                             AvahiIfIndex interface,
650
 
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
859
                             AvahiProtocol proto,
651
860
                             AvahiResolverEvent event,
652
861
                             const char *name,
653
862
                             const char *type,
658
867
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
659
868
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
660
869
                             flags,
661
 
                             void* userdata) {
662
 
  mandos_context *mc = userdata;
663
 
  assert(r);                    /* Spurious warning */
 
870
                             AVAHI_GCC_UNUSED void* userdata){
 
871
  assert(r);
664
872
  
665
873
  /* Called whenever a service has been resolved successfully or
666
874
     timed out */
667
875
  
668
 
  switch (event) {
 
876
  if(quit_now){
 
877
    return;
 
878
  }
 
879
  
 
880
  switch(event){
669
881
  default:
670
882
  case AVAHI_RESOLVER_FAILURE:
671
883
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
672
884
            " of type '%s' in domain '%s': %s\n", name, type, domain,
673
 
            avahi_strerror(avahi_server_errno(mc->server)));
 
885
            avahi_strerror(avahi_server_errno(mc.server)));
674
886
    break;
675
887
    
676
888
  case AVAHI_RESOLVER_FOUND:
679
891
      avahi_address_snprint(ip, sizeof(ip), address);
680
892
      if(debug){
681
893
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %"
682
 
                PRIu16 ") on port %d\n", name, host_name, ip,
683
 
                interface, port);
 
894
                PRIdMAX ") on port %" PRIu16 "\n", name, host_name,
 
895
                ip, (intmax_t)interface, port);
684
896
      }
685
 
      int ret = start_mandos_communication(ip, port, interface, mc);
686
 
      if (ret == 0){
687
 
        exit(EXIT_SUCCESS);
 
897
      int ret = start_mandos_communication(ip, port, interface,
 
898
                                           avahi_proto_to_af(proto));
 
899
      if(ret == 0){
 
900
        avahi_simple_poll_quit(mc.simple_poll);
688
901
      }
689
902
    }
690
903
  }
691
904
  avahi_s_service_resolver_free(r);
692
905
}
693
906
 
694
 
static void browse_callback( AvahiSServiceBrowser *b,
695
 
                             AvahiIfIndex interface,
696
 
                             AvahiProtocol protocol,
697
 
                             AvahiBrowserEvent event,
698
 
                             const char *name,
699
 
                             const char *type,
700
 
                             const char *domain,
701
 
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
702
 
                             flags,
703
 
                             void* userdata) {
704
 
  mandos_context *mc = userdata;
705
 
  assert(b);                    /* Spurious warning */
 
907
static void browse_callback(AvahiSServiceBrowser *b,
 
908
                            AvahiIfIndex interface,
 
909
                            AvahiProtocol protocol,
 
910
                            AvahiBrowserEvent event,
 
911
                            const char *name,
 
912
                            const char *type,
 
913
                            const char *domain,
 
914
                            AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
915
                            flags,
 
916
                            AVAHI_GCC_UNUSED void* userdata){
 
917
  assert(b);
706
918
  
707
919
  /* Called whenever a new services becomes available on the LAN or
708
920
     is removed from the LAN */
709
921
  
710
 
  switch (event) {
 
922
  if(quit_now){
 
923
    return;
 
924
  }
 
925
  
 
926
  switch(event){
711
927
  default:
712
928
  case AVAHI_BROWSER_FAILURE:
713
929
    
714
930
    fprintf(stderr, "(Avahi browser) %s\n",
715
 
            avahi_strerror(avahi_server_errno(mc->server)));
716
 
    avahi_simple_poll_quit(mc->simple_poll);
 
931
            avahi_strerror(avahi_server_errno(mc.server)));
 
932
    avahi_simple_poll_quit(mc.simple_poll);
717
933
    return;
718
934
    
719
935
  case AVAHI_BROWSER_NEW:
722
938
       the callback function is called the Avahi server will free the
723
939
       resolver for us. */
724
940
    
725
 
    if (!(avahi_s_service_resolver_new(mc->server, interface,
726
 
                                       protocol, name, type, domain,
727
 
                                       AVAHI_PROTO_INET6, 0,
728
 
                                       resolve_callback, mc)))
 
941
    if(avahi_s_service_resolver_new(mc.server, interface, protocol,
 
942
                                    name, type, domain, protocol, 0,
 
943
                                    resolve_callback, NULL) == NULL)
729
944
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
730
 
              name, avahi_strerror(avahi_server_errno(mc->server)));
 
945
              name, avahi_strerror(avahi_server_errno(mc.server)));
731
946
    break;
732
947
    
733
948
  case AVAHI_BROWSER_REMOVE:
742
957
  }
743
958
}
744
959
 
745
 
/* Combines file name and path and returns the malloced new
746
 
   string. some sane checks could/should be added */
747
 
static const char *combinepath(const char *first, const char *second){
748
 
  size_t f_len = strlen(first);
749
 
  size_t s_len = strlen(second);
750
 
  char *tmp = malloc(f_len + s_len + 2);
751
 
  if (tmp == NULL){
752
 
    return NULL;
753
 
  }
754
 
  if(f_len > 0){
755
 
    memcpy(tmp, first, f_len);  /* Spurious warning */
756
 
  }
757
 
  tmp[f_len] = '/';
758
 
  if(s_len > 0){
759
 
    memcpy(tmp + f_len + 1, second, s_len); /* Spurious warning */
760
 
  }
761
 
  tmp[f_len + 1 + s_len] = '\0';
762
 
  return tmp;
 
960
/* stop main loop after sigterm has been called */
 
961
static void handle_sigterm(int sig){
 
962
  if(quit_now){
 
963
    return;
 
964
  }
 
965
  quit_now = 1;
 
966
  signal_received = sig;
 
967
  int old_errno = errno;
 
968
  if(mc.simple_poll != NULL){
 
969
    avahi_simple_poll_quit(mc.simple_poll);
 
970
  }
 
971
  errno = old_errno;
763
972
}
764
973
 
765
 
 
766
974
int main(int argc, char *argv[]){
767
 
    AvahiSServiceBrowser *sb = NULL;
768
 
    int error;
769
 
    int ret;
770
 
    int exitcode = EXIT_SUCCESS;
771
 
    const char *interface = "eth0";
772
 
    struct ifreq network;
773
 
    int sd;
774
 
    uid_t uid;
775
 
    gid_t gid;
776
 
    char *connect_to = NULL;
777
 
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
778
 
    const char *pubkeyfile = "pubkey.txt";
779
 
    const char *seckeyfile = "seckey.txt";
780
 
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
781
 
                          .dh_bits = 1024, .priority = "SECURE256"};
782
 
    bool gnutls_initalized = false;
783
 
    
784
 
    {
785
 
      struct argp_option options[] = {
786
 
        { .name = "debug", .key = 128,
787
 
          .doc = "Debug mode", .group = 3 },
788
 
        { .name = "connect", .key = 'c',
789
 
          .arg = "IP",
790
 
          .doc = "Connect directly to a sepcified mandos server",
791
 
          .group = 1 },
792
 
        { .name = "interface", .key = 'i',
793
 
          .arg = "INTERFACE",
794
 
          .doc = "Interface that Avahi will conntect through",
795
 
          .group = 1 },
796
 
        { .name = "keydir", .key = 'd',
797
 
          .arg = "KEYDIR",
798
 
          .doc = "Directory where the openpgp keyring is",
799
 
          .group = 1 },
800
 
        { .name = "seckey", .key = 's',
801
 
          .arg = "SECKEY",
802
 
          .doc = "Secret openpgp key for gnutls authentication",
803
 
          .group = 1 },
804
 
        { .name = "pubkey", .key = 'p',
805
 
          .arg = "PUBKEY",
806
 
          .doc = "Public openpgp key for gnutls authentication",
807
 
          .group = 2 },
808
 
        { .name = "dh-bits", .key = 129,
809
 
          .arg = "BITS",
810
 
          .doc = "dh-bits to use in gnutls communication",
811
 
          .group = 2 },
812
 
        { .name = "priority", .key = 130,
813
 
          .arg = "PRIORITY",
814
 
          .doc = "GNUTLS priority", .group = 1 },
815
 
        { .name = NULL }
816
 
      };
817
 
 
818
 
      
819
 
      error_t parse_opt (int key, char *arg,
820
 
                         struct argp_state *state) {
821
 
        /* Get the INPUT argument from `argp_parse', which we know is
822
 
           a pointer to our plugin list pointer. */
823
 
        switch (key) {
824
 
        case 128:
825
 
          debug = true;
826
 
          break;
827
 
        case 'c':
828
 
          connect_to = arg;
829
 
          break;
830
 
        case 'i':
831
 
          interface = arg;
832
 
          break;
833
 
        case 'd':
834
 
          keydir = arg;
835
 
          break;
836
 
        case 's':
837
 
          seckeyfile = arg;
838
 
          break;
839
 
        case 'p':
840
 
          pubkeyfile = arg;
841
 
          break;
842
 
        case 129:
843
 
          errno = 0;
844
 
          mc.dh_bits = (unsigned int) strtol(arg, NULL, 10);
845
 
          if (errno){
846
 
            perror("strtol");
847
 
            exit(EXIT_FAILURE);
848
 
          }
849
 
          break;
850
 
        case 130:
851
 
          mc.priority = arg;
852
 
          break;
853
 
        case ARGP_KEY_ARG:
854
 
          argp_usage (state);
855
 
          break;
856
 
          case ARGP_KEY_END:
857
 
            break;
858
 
        default:
859
 
          return ARGP_ERR_UNKNOWN;
860
 
        }
861
 
        return 0;
862
 
      }
863
 
 
864
 
      struct argp argp = { .options = options, .parser = parse_opt,
865
 
                           .args_doc = "",
866
 
                           .doc = "Mandos client -- Get and decrypt"
867
 
                           " passwords from mandos server" };
868
 
      ret = argp_parse (&argp, argc, argv, 0, 0, NULL);
869
 
      if (ret == ARGP_ERR_UNKNOWN){
870
 
        fprintf(stderr, "Unkown error while parsing arguments\n");
871
 
        exitcode = EXIT_FAILURE;
872
 
        goto end;
873
 
      }
874
 
    }
875
 
      
876
 
    pubkeyfile = combinepath(keydir, pubkeyfile);
877
 
    if (pubkeyfile == NULL){
878
 
      perror("combinepath");
879
 
      exitcode = EXIT_FAILURE;
880
 
      goto end;
881
 
    }
882
 
    
883
 
    seckeyfile = combinepath(keydir, seckeyfile);
884
 
    if (seckeyfile == NULL){
885
 
      perror("combinepath");
886
 
      goto end;
887
 
    }
888
 
 
889
 
    ret = init_gnutls_global(&mc, pubkeyfile, seckeyfile);
890
 
    if (ret == -1){
891
 
      fprintf(stderr, "init_gnutls_global\n");
892
 
      goto end;
893
 
    } else {
894
 
      gnutls_initalized = true;
895
 
    }
896
 
 
897
 
    uid = getuid();
898
 
    gid = getgid();
899
 
 
900
 
    ret = setuid(uid);
901
 
    if (ret == -1){
902
 
      perror("setuid");
903
 
    }
904
 
    
905
 
    setgid(gid);
906
 
    if (ret == -1){
907
 
      perror("setgid");
908
 
    }
909
 
    
 
975
  AvahiSServiceBrowser *sb = NULL;
 
976
  int error;
 
977
  int ret;
 
978
  intmax_t tmpmax;
 
979
  char *tmp;
 
980
  int exitcode = EXIT_SUCCESS;
 
981
  const char *interface = "eth0";
 
982
  struct ifreq network;
 
983
  int sd = -1;
 
984
  bool take_down_interface = false;
 
985
  uid_t uid;
 
986
  gid_t gid;
 
987
  char *connect_to = NULL;
 
988
  char tempdir[] = "/tmp/mandosXXXXXX";
 
989
  bool tempdir_created = false;
 
990
  AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
 
991
  const char *seckey = PATHDIR "/" SECKEY;
 
992
  const char *pubkey = PATHDIR "/" PUBKEY;
 
993
  
 
994
  bool gnutls_initialized = false;
 
995
  bool gpgme_initialized = false;
 
996
  float delay = 2.5f;
 
997
  
 
998
  struct sigaction old_sigterm_action;
 
999
  struct sigaction sigterm_action = { .sa_handler = handle_sigterm };
 
1000
  
 
1001
  {
 
1002
    struct argp_option options[] = {
 
1003
      { .name = "debug", .key = 128,
 
1004
        .doc = "Debug mode", .group = 3 },
 
1005
      { .name = "connect", .key = 'c',
 
1006
        .arg = "ADDRESS:PORT",
 
1007
        .doc = "Connect directly to a specific Mandos server",
 
1008
        .group = 1 },
 
1009
      { .name = "interface", .key = 'i',
 
1010
        .arg = "NAME",
 
1011
        .doc = "Network interface that will be used to search for"
 
1012
        " Mandos servers",
 
1013
        .group = 1 },
 
1014
      { .name = "seckey", .key = 's',
 
1015
        .arg = "FILE",
 
1016
        .doc = "OpenPGP secret key file base name",
 
1017
        .group = 1 },
 
1018
      { .name = "pubkey", .key = 'p',
 
1019
        .arg = "FILE",
 
1020
        .doc = "OpenPGP public key file base name",
 
1021
        .group = 2 },
 
1022
      { .name = "dh-bits", .key = 129,
 
1023
        .arg = "BITS",
 
1024
        .doc = "Bit length of the prime number used in the"
 
1025
        " Diffie-Hellman key exchange",
 
1026
        .group = 2 },
 
1027
      { .name = "priority", .key = 130,
 
1028
        .arg = "STRING",
 
1029
        .doc = "GnuTLS priority string for the TLS handshake",
 
1030
        .group = 1 },
 
1031
      { .name = "delay", .key = 131,
 
1032
        .arg = "SECONDS",
 
1033
        .doc = "Maximum delay to wait for interface startup",
 
1034
        .group = 2 },
 
1035
      { .name = NULL }
 
1036
    };
 
1037
    
 
1038
    error_t parse_opt(int key, char *arg,
 
1039
                      struct argp_state *state){
 
1040
      switch(key){
 
1041
      case 128:                 /* --debug */
 
1042
        debug = true;
 
1043
        break;
 
1044
      case 'c':                 /* --connect */
 
1045
        connect_to = arg;
 
1046
        break;
 
1047
      case 'i':                 /* --interface */
 
1048
        interface = arg;
 
1049
        break;
 
1050
      case 's':                 /* --seckey */
 
1051
        seckey = arg;
 
1052
        break;
 
1053
      case 'p':                 /* --pubkey */
 
1054
        pubkey = arg;
 
1055
        break;
 
1056
      case 129:                 /* --dh-bits */
 
1057
        errno = 0;
 
1058
        tmpmax = strtoimax(arg, &tmp, 10);
 
1059
        if(errno != 0 or tmp == arg or *tmp != '\0'
 
1060
           or tmpmax != (typeof(mc.dh_bits))tmpmax){
 
1061
          fprintf(stderr, "Bad number of DH bits\n");
 
1062
          exit(EXIT_FAILURE);
 
1063
        }
 
1064
        mc.dh_bits = (typeof(mc.dh_bits))tmpmax;
 
1065
        break;
 
1066
      case 130:                 /* --priority */
 
1067
        mc.priority = arg;
 
1068
        break;
 
1069
      case 131:                 /* --delay */
 
1070
        errno = 0;
 
1071
        delay = strtof(arg, &tmp);
 
1072
        if(errno != 0 or tmp == arg or *tmp != '\0'){
 
1073
          fprintf(stderr, "Bad delay\n");
 
1074
          exit(EXIT_FAILURE);
 
1075
        }
 
1076
        break;
 
1077
      case ARGP_KEY_ARG:
 
1078
        argp_usage(state);
 
1079
      case ARGP_KEY_END:
 
1080
        break;
 
1081
      default:
 
1082
        return ARGP_ERR_UNKNOWN;
 
1083
      }
 
1084
      return 0;
 
1085
    }
 
1086
    
 
1087
    struct argp argp = { .options = options, .parser = parse_opt,
 
1088
                         .args_doc = "",
 
1089
                         .doc = "Mandos client -- Get and decrypt"
 
1090
                         " passwords from a Mandos server" };
 
1091
    ret = argp_parse(&argp, argc, argv, 0, 0, NULL);
 
1092
    if(ret == ARGP_ERR_UNKNOWN){
 
1093
      fprintf(stderr, "Unknown error while parsing arguments\n");
 
1094
      exitcode = EXIT_FAILURE;
 
1095
      goto end;
 
1096
    }
 
1097
  }
 
1098
  
 
1099
  if(not debug){
 
1100
    avahi_set_log_function(empty_log);
 
1101
  }
 
1102
  
 
1103
  /* Initialize Avahi early so avahi_simple_poll_quit() can be called
 
1104
     from the signal handler */
 
1105
  /* Initialize the pseudo-RNG for Avahi */
 
1106
  srand((unsigned int) time(NULL));
 
1107
  mc.simple_poll = avahi_simple_poll_new();
 
1108
  if(mc.simple_poll == NULL){
 
1109
    fprintf(stderr, "Avahi: Failed to create simple poll object.\n");
 
1110
    exitcode = EXIT_FAILURE;
 
1111
    goto end;
 
1112
  }
 
1113
  
 
1114
  sigemptyset(&sigterm_action.sa_mask);
 
1115
  ret = sigaddset(&sigterm_action.sa_mask, SIGINT);
 
1116
  if(ret == -1){
 
1117
    perror("sigaddset");
 
1118
    exitcode = EXIT_FAILURE;
 
1119
    goto end;
 
1120
  }
 
1121
  ret = sigaddset(&sigterm_action.sa_mask, SIGHUP);
 
1122
  if(ret == -1){
 
1123
    perror("sigaddset");
 
1124
    exitcode = EXIT_FAILURE;
 
1125
    goto end;
 
1126
  }
 
1127
  ret = sigaddset(&sigterm_action.sa_mask, SIGTERM);
 
1128
  if(ret == -1){
 
1129
    perror("sigaddset");
 
1130
    exitcode = EXIT_FAILURE;
 
1131
    goto end;
 
1132
  }
 
1133
  /* Need to check if the handler is SIG_IGN before handling:
 
1134
     | [[info:libc:Initial Signal Actions]] |
 
1135
     | [[info:libc:Basic Signal Handling]]  |
 
1136
  */
 
1137
  ret = sigaction(SIGINT, NULL, &old_sigterm_action);
 
1138
  if(ret == -1){
 
1139
    perror("sigaction");
 
1140
    return EXIT_FAILURE;
 
1141
  }
 
1142
  if(old_sigterm_action.sa_handler != SIG_IGN){
 
1143
    ret = sigaction(SIGINT, &sigterm_action, NULL);
 
1144
    if(ret == -1){
 
1145
      perror("sigaction");
 
1146
      exitcode = EXIT_FAILURE;
 
1147
      goto end;
 
1148
    }
 
1149
  }
 
1150
  ret = sigaction(SIGHUP, NULL, &old_sigterm_action);
 
1151
  if(ret == -1){
 
1152
    perror("sigaction");
 
1153
    return EXIT_FAILURE;
 
1154
  }
 
1155
  if(old_sigterm_action.sa_handler != SIG_IGN){
 
1156
    ret = sigaction(SIGHUP, &sigterm_action, NULL);
 
1157
    if(ret == -1){
 
1158
      perror("sigaction");
 
1159
      exitcode = EXIT_FAILURE;
 
1160
      goto end;
 
1161
    }
 
1162
  }
 
1163
  ret = sigaction(SIGTERM, NULL, &old_sigterm_action);
 
1164
  if(ret == -1){
 
1165
    perror("sigaction");
 
1166
    return EXIT_FAILURE;
 
1167
  }
 
1168
  if(old_sigterm_action.sa_handler != SIG_IGN){
 
1169
    ret = sigaction(SIGTERM, &sigterm_action, NULL);
 
1170
    if(ret == -1){
 
1171
      perror("sigaction");
 
1172
      exitcode = EXIT_FAILURE;
 
1173
      goto end;
 
1174
    }
 
1175
  }
 
1176
  
 
1177
  /* If the interface is down, bring it up */
 
1178
  if(interface[0] != '\0'){
910
1179
    if_index = (AvahiIfIndex) if_nametoindex(interface);
911
1180
    if(if_index == 0){
912
1181
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
913
 
      exit(EXIT_FAILURE);
914
 
    }
915
 
    
916
 
    if(connect_to != NULL){
917
 
      /* Connect directly, do not use Zeroconf */
918
 
      /* (Mainly meant for debugging) */
919
 
      char *address = strrchr(connect_to, ':');
920
 
      if(address == NULL){
921
 
        fprintf(stderr, "No colon in address\n");
922
 
        exitcode = EXIT_FAILURE;
923
 
        goto end;
924
 
      }
925
 
      errno = 0;
926
 
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
927
 
      if(errno){
928
 
        perror("Bad port number");
929
 
        exitcode = EXIT_FAILURE;
930
 
        goto end;
931
 
      }
932
 
      *address = '\0';
933
 
      address = connect_to;
934
 
      ret = start_mandos_communication(address, port, if_index, &mc);
935
 
      if(ret < 0){
936
 
        exitcode = EXIT_FAILURE;
937
 
      } else {
938
 
        exitcode = EXIT_SUCCESS;
939
 
      }
940
 
      goto end;
941
 
    }
942
 
    
943
 
    /* If the interface is down, bring it up */
944
 
    {
945
 
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
946
 
      if(sd < 0) {
947
 
        perror("socket");
948
 
        exitcode = EXIT_FAILURE;
949
 
        goto end;
950
 
      }
951
 
      strcpy(network.ifr_name, interface); /* Spurious warning */
 
1182
      exitcode = EXIT_FAILURE;
 
1183
      goto end;
 
1184
    }
 
1185
    
 
1186
    if(quit_now){
 
1187
      goto end;
 
1188
    }
 
1189
    
 
1190
#ifdef __linux__
 
1191
    /* Lower kernel loglevel to KERN_NOTICE to avoid KERN_INFO
 
1192
       messages to mess up the prompt */
 
1193
    ret = klogctl(8, NULL, 5);
 
1194
    bool restore_loglevel = true;
 
1195
    if(ret == -1){
 
1196
      restore_loglevel = false;
 
1197
      perror("klogctl");
 
1198
    }
 
1199
#endif  /* __linux__ */
 
1200
    
 
1201
    sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
1202
    if(sd < 0){
 
1203
      perror("socket");
 
1204
      exitcode = EXIT_FAILURE;
 
1205
#ifdef __linux__
 
1206
      if(restore_loglevel){
 
1207
        ret = klogctl(7, NULL, 0);
 
1208
        if(ret == -1){
 
1209
          perror("klogctl");
 
1210
        }
 
1211
      }
 
1212
#endif  /* __linux__ */
 
1213
      goto end;
 
1214
    }
 
1215
    strcpy(network.ifr_name, interface);
 
1216
    ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
1217
    if(ret == -1){
 
1218
      perror("ioctl SIOCGIFFLAGS");
 
1219
#ifdef __linux__
 
1220
      if(restore_loglevel){
 
1221
        ret = klogctl(7, NULL, 0);
 
1222
        if(ret == -1){
 
1223
          perror("klogctl");
 
1224
        }
 
1225
      }
 
1226
#endif  /* __linux__ */
 
1227
      exitcode = EXIT_FAILURE;
 
1228
      goto end;
 
1229
    }
 
1230
    if((network.ifr_flags & IFF_UP) == 0){
 
1231
      network.ifr_flags |= IFF_UP;
 
1232
      take_down_interface = true;
 
1233
      ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
1234
      if(ret == -1){
 
1235
        take_down_interface = false;
 
1236
        perror("ioctl SIOCSIFFLAGS");
 
1237
        exitcode = EXIT_FAILURE;
 
1238
#ifdef __linux__
 
1239
        if(restore_loglevel){
 
1240
          ret = klogctl(7, NULL, 0);
 
1241
          if(ret == -1){
 
1242
            perror("klogctl");
 
1243
          }
 
1244
        }
 
1245
#endif  /* __linux__ */
 
1246
        goto end;
 
1247
      }
 
1248
    }
 
1249
    /* sleep checking until interface is running */
 
1250
    for(int i=0; i < delay * 4; i++){
952
1251
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
953
1252
      if(ret == -1){
954
1253
        perror("ioctl SIOCGIFFLAGS");
955
 
        exitcode = EXIT_FAILURE;
956
 
        goto end;
957
 
      }
958
 
      if((network.ifr_flags & IFF_UP) == 0){
959
 
        network.ifr_flags |= IFF_UP;
960
 
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
961
 
        if(ret == -1){
962
 
          perror("ioctl SIOCSIFFLAGS");
963
 
          exitcode = EXIT_FAILURE;
964
 
          goto end;
965
 
        }
966
 
      }
967
 
      close(sd);
968
 
    }
969
 
    
970
 
    if (not debug){
971
 
      avahi_set_log_function(empty_log);
972
 
    }
973
 
    
974
 
    /* Initialize the pseudo-RNG for Avahi */
975
 
    srand((unsigned int) time(NULL));
976
 
    
977
 
    /* Allocate main Avahi loop object */
978
 
    mc.simple_poll = avahi_simple_poll_new();
979
 
    if (mc.simple_poll == NULL) {
980
 
        fprintf(stderr, "Avahi: Failed to create simple poll"
981
 
                " object.\n");
982
 
        exitcode = EXIT_FAILURE;
983
 
        goto end;
984
 
    }
985
 
 
986
 
    {
987
 
      AvahiServerConfig config;
988
 
      /* Do not publish any local Zeroconf records */
989
 
      avahi_server_config_init(&config);
990
 
      config.publish_hinfo = 0;
991
 
      config.publish_addresses = 0;
992
 
      config.publish_workstation = 0;
993
 
      config.publish_domain = 0;
994
 
 
995
 
      /* Allocate a new server */
996
 
      mc.server = avahi_server_new(avahi_simple_poll_get
997
 
                                   (mc.simple_poll), &config, NULL,
998
 
                                   NULL, &error);
999
 
    
1000
 
      /* Free the Avahi configuration data */
1001
 
      avahi_server_config_free(&config);
1002
 
    }
1003
 
    
1004
 
    /* Check if creating the Avahi server object succeeded */
1005
 
    if (mc.server == NULL) {
1006
 
        fprintf(stderr, "Failed to create Avahi server: %s\n",
1007
 
                avahi_strerror(error));
1008
 
        exitcode = EXIT_FAILURE;
1009
 
        goto end;
1010
 
    }
1011
 
    
1012
 
    /* Create the Avahi service browser */
1013
 
    sb = avahi_s_service_browser_new(mc.server, if_index,
1014
 
                                     AVAHI_PROTO_INET6,
1015
 
                                     "_mandos._tcp", NULL, 0,
1016
 
                                     browse_callback, &mc);
1017
 
    if (sb == NULL) {
1018
 
        fprintf(stderr, "Failed to create service browser: %s\n",
1019
 
                avahi_strerror(avahi_server_errno(mc.server)));
1020
 
        exitcode = EXIT_FAILURE;
1021
 
        goto end;
1022
 
    }
1023
 
    
1024
 
    /* Run the main loop */
1025
 
 
1026
 
    if (debug){
1027
 
      fprintf(stderr, "Starting Avahi loop search\n");
1028
 
    }
1029
 
    
1030
 
    avahi_simple_poll_loop(mc.simple_poll);
1031
 
    
 
1254
      } else if(network.ifr_flags & IFF_RUNNING){
 
1255
        break;
 
1256
      }
 
1257
      struct timespec sleeptime = { .tv_nsec = 250000000 };
 
1258
      ret = nanosleep(&sleeptime, NULL);
 
1259
      if(ret == -1 and errno != EINTR){
 
1260
        perror("nanosleep");
 
1261
      }
 
1262
    }
 
1263
    if(not take_down_interface){
 
1264
      /* We won't need the socket anymore */
 
1265
      ret = (int)TEMP_FAILURE_RETRY(close(sd));
 
1266
      if(ret == -1){
 
1267
        perror("close");
 
1268
      }
 
1269
    }
 
1270
#ifdef __linux__
 
1271
    if(restore_loglevel){
 
1272
      /* Restores kernel loglevel to default */
 
1273
      ret = klogctl(7, NULL, 0);
 
1274
      if(ret == -1){
 
1275
        perror("klogctl");
 
1276
      }
 
1277
    }
 
1278
#endif  /* __linux__ */
 
1279
  }
 
1280
  
 
1281
  if(quit_now){
 
1282
    goto end;
 
1283
  }
 
1284
  
 
1285
  uid = getuid();
 
1286
  gid = getgid();
 
1287
  
 
1288
  errno = 0;
 
1289
  setgid(gid);
 
1290
  if(ret == -1){
 
1291
    perror("setgid");
 
1292
  }
 
1293
  
 
1294
  ret = setuid(uid);
 
1295
  if(ret == -1){
 
1296
    perror("setuid");
 
1297
  }
 
1298
  
 
1299
  if(quit_now){
 
1300
    goto end;
 
1301
  }
 
1302
  
 
1303
  ret = init_gnutls_global(pubkey, seckey);
 
1304
  if(ret == -1){
 
1305
    fprintf(stderr, "init_gnutls_global failed\n");
 
1306
    exitcode = EXIT_FAILURE;
 
1307
    goto end;
 
1308
  } else {
 
1309
    gnutls_initialized = true;
 
1310
  }
 
1311
  
 
1312
  if(quit_now){
 
1313
    goto end;
 
1314
  }
 
1315
  
 
1316
  tempdir_created = true;
 
1317
  if(mkdtemp(tempdir) == NULL){
 
1318
    tempdir_created = false;
 
1319
    perror("mkdtemp");
 
1320
    goto end;
 
1321
  }
 
1322
  
 
1323
  if(quit_now){
 
1324
    goto end;
 
1325
  }
 
1326
  
 
1327
  if(not init_gpgme(pubkey, seckey, tempdir)){
 
1328
    fprintf(stderr, "init_gpgme failed\n");
 
1329
    exitcode = EXIT_FAILURE;
 
1330
    goto end;
 
1331
  } else {
 
1332
    gpgme_initialized = true;
 
1333
  }
 
1334
  
 
1335
  if(quit_now){
 
1336
    goto end;
 
1337
  }
 
1338
  
 
1339
  if(connect_to != NULL){
 
1340
    /* Connect directly, do not use Zeroconf */
 
1341
    /* (Mainly meant for debugging) */
 
1342
    char *address = strrchr(connect_to, ':');
 
1343
    if(address == NULL){
 
1344
      fprintf(stderr, "No colon in address\n");
 
1345
      exitcode = EXIT_FAILURE;
 
1346
      goto end;
 
1347
    }
 
1348
    
 
1349
    if(quit_now){
 
1350
      goto end;
 
1351
    }
 
1352
    
 
1353
    uint16_t port;
 
1354
    errno = 0;
 
1355
    tmpmax = strtoimax(address+1, &tmp, 10);
 
1356
    if(errno != 0 or tmp == address+1 or *tmp != '\0'
 
1357
       or tmpmax != (uint16_t)tmpmax){
 
1358
      fprintf(stderr, "Bad port number\n");
 
1359
      exitcode = EXIT_FAILURE;
 
1360
      goto end;
 
1361
    }
 
1362
  
 
1363
    if(quit_now){
 
1364
      goto end;
 
1365
    }
 
1366
    
 
1367
    port = (uint16_t)tmpmax;
 
1368
    *address = '\0';
 
1369
    address = connect_to;
 
1370
    /* Colon in address indicates IPv6 */
 
1371
    int af;
 
1372
    if(strchr(address, ':') != NULL){
 
1373
      af = AF_INET6;
 
1374
    } else {
 
1375
      af = AF_INET;
 
1376
    }
 
1377
    
 
1378
    if(quit_now){
 
1379
      goto end;
 
1380
    }
 
1381
    
 
1382
    ret = start_mandos_communication(address, port, if_index, af);
 
1383
    if(ret < 0){
 
1384
      exitcode = EXIT_FAILURE;
 
1385
    } else {
 
1386
      exitcode = EXIT_SUCCESS;
 
1387
    }
 
1388
    goto end;
 
1389
  }
 
1390
  
 
1391
  if(quit_now){
 
1392
    goto end;
 
1393
  }
 
1394
  
 
1395
  {
 
1396
    AvahiServerConfig config;
 
1397
    /* Do not publish any local Zeroconf records */
 
1398
    avahi_server_config_init(&config);
 
1399
    config.publish_hinfo = 0;
 
1400
    config.publish_addresses = 0;
 
1401
    config.publish_workstation = 0;
 
1402
    config.publish_domain = 0;
 
1403
    
 
1404
    /* Allocate a new server */
 
1405
    mc.server = avahi_server_new(avahi_simple_poll_get
 
1406
                                 (mc.simple_poll), &config, NULL,
 
1407
                                 NULL, &error);
 
1408
    
 
1409
    /* Free the Avahi configuration data */
 
1410
    avahi_server_config_free(&config);
 
1411
  }
 
1412
  
 
1413
  /* Check if creating the Avahi server object succeeded */
 
1414
  if(mc.server == NULL){
 
1415
    fprintf(stderr, "Failed to create Avahi server: %s\n",
 
1416
            avahi_strerror(error));
 
1417
    exitcode = EXIT_FAILURE;
 
1418
    goto end;
 
1419
  }
 
1420
  
 
1421
  if(quit_now){
 
1422
    goto end;
 
1423
  }
 
1424
  
 
1425
  /* Create the Avahi service browser */
 
1426
  sb = avahi_s_service_browser_new(mc.server, if_index,
 
1427
                                   AVAHI_PROTO_UNSPEC, "_mandos._tcp",
 
1428
                                   NULL, 0, browse_callback, NULL);
 
1429
  if(sb == NULL){
 
1430
    fprintf(stderr, "Failed to create service browser: %s\n",
 
1431
            avahi_strerror(avahi_server_errno(mc.server)));
 
1432
    exitcode = EXIT_FAILURE;
 
1433
    goto end;
 
1434
  }
 
1435
  
 
1436
  if(quit_now){
 
1437
    goto end;
 
1438
  }
 
1439
  
 
1440
  /* Run the main loop */
 
1441
  
 
1442
  if(debug){
 
1443
    fprintf(stderr, "Starting Avahi loop search\n");
 
1444
  }
 
1445
  
 
1446
  avahi_simple_poll_loop(mc.simple_poll);
 
1447
  
1032
1448
 end:
1033
 
 
1034
 
    if (debug){
1035
 
      fprintf(stderr, "%s exiting\n", argv[0]);
1036
 
    }
1037
 
    
1038
 
    /* Cleanup things */
1039
 
    if (sb != NULL)
1040
 
        avahi_s_service_browser_free(sb);
1041
 
    
1042
 
    if (mc.server != NULL)
1043
 
        avahi_server_free(mc.server);
1044
 
 
1045
 
    if (mc.simple_poll != NULL)
1046
 
        avahi_simple_poll_free(mc.simple_poll);
1047
 
    free(pubkeyfile);
1048
 
    free(seckeyfile);
1049
 
 
1050
 
    if (gnutls_initalized){
1051
 
      gnutls_certificate_free_credentials(mc.cred);
1052
 
      gnutls_global_deinit ();
1053
 
    }
1054
 
    
1055
 
    return exitcode;
 
1449
  
 
1450
  if(debug){
 
1451
    fprintf(stderr, "%s exiting\n", argv[0]);
 
1452
  }
 
1453
  
 
1454
  /* Cleanup things */
 
1455
  if(sb != NULL)
 
1456
    avahi_s_service_browser_free(sb);
 
1457
  
 
1458
  if(mc.server != NULL)
 
1459
    avahi_server_free(mc.server);
 
1460
  
 
1461
  if(mc.simple_poll != NULL)
 
1462
    avahi_simple_poll_free(mc.simple_poll);
 
1463
  
 
1464
  if(gnutls_initialized){
 
1465
    gnutls_certificate_free_credentials(mc.cred);
 
1466
    gnutls_global_deinit();
 
1467
    gnutls_dh_params_deinit(mc.dh_params);
 
1468
  }
 
1469
  
 
1470
  if(gpgme_initialized){
 
1471
    gpgme_release(mc.ctx);
 
1472
  }
 
1473
  
 
1474
  /* Take down the network interface */
 
1475
  if(take_down_interface){
 
1476
    ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
1477
    if(ret == -1){
 
1478
      perror("ioctl SIOCGIFFLAGS");
 
1479
    } else if(network.ifr_flags & IFF_UP) {
 
1480
      network.ifr_flags &= ~IFF_UP; /* clear flag */
 
1481
      ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
1482
      if(ret == -1){
 
1483
        perror("ioctl SIOCSIFFLAGS");
 
1484
      }
 
1485
    }
 
1486
    ret = (int)TEMP_FAILURE_RETRY(close(sd));
 
1487
    if(ret == -1){
 
1488
      perror("close");
 
1489
    }
 
1490
  }
 
1491
  
 
1492
  /* Removes the temp directory used by GPGME */
 
1493
  if(tempdir_created){
 
1494
    DIR *d;
 
1495
    struct dirent *direntry;
 
1496
    d = opendir(tempdir);
 
1497
    if(d == NULL){
 
1498
      if(errno != ENOENT){
 
1499
        perror("opendir");
 
1500
      }
 
1501
    } else {
 
1502
      while(true){
 
1503
        direntry = readdir(d);
 
1504
        if(direntry == NULL){
 
1505
          break;
 
1506
        }
 
1507
        /* Skip "." and ".." */
 
1508
        if(direntry->d_name[0] == '.'
 
1509
           and (direntry->d_name[1] == '\0'
 
1510
                or (direntry->d_name[1] == '.'
 
1511
                    and direntry->d_name[2] == '\0'))){
 
1512
          continue;
 
1513
        }
 
1514
        char *fullname = NULL;
 
1515
        ret = asprintf(&fullname, "%s/%s", tempdir,
 
1516
                       direntry->d_name);
 
1517
        if(ret < 0){
 
1518
          perror("asprintf");
 
1519
          continue;
 
1520
        }
 
1521
        ret = remove(fullname);
 
1522
        if(ret == -1){
 
1523
          fprintf(stderr, "remove(\"%s\"): %s\n", fullname,
 
1524
                  strerror(errno));
 
1525
        }
 
1526
        free(fullname);
 
1527
      }
 
1528
      closedir(d);
 
1529
    }
 
1530
    ret = rmdir(tempdir);
 
1531
    if(ret == -1 and errno != ENOENT){
 
1532
      perror("rmdir");
 
1533
    }
 
1534
  }
 
1535
  
 
1536
  if(quit_now){
 
1537
    sigemptyset(&old_sigterm_action.sa_mask);
 
1538
    old_sigterm_action.sa_handler = SIG_DFL;
 
1539
    ret = sigaction(signal_received, &old_sigterm_action, NULL);
 
1540
    if(ret == -1){
 
1541
      perror("sigaction");
 
1542
    }
 
1543
    raise(signal_received);
 
1544
  }
 
1545
  
 
1546
  return exitcode;
1056
1547
}