/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: 2016-12-12 18:25:02 UTC
  • Revision ID: teddy@recompile.se-20161212182502-72seb9hxiu65cgwa
Add spaces around all '=' signs in all C code.

* plugin-runner.c: Add white space around all '=' signs.
* plugins.d/mandos-client.c: - '' -
* plugins.d/plymouth.c: - '' -

Show diffs side-by-side

added added

removed removed

Lines of Context:
9
9
 * "browse_callback", and parts of "main".
10
10
 * 
11
11
 * Everything else is
12
 
 * Copyright © 2008-2011 Teddy Hogeborn
13
 
 * Copyright © 2008-2011 Björn Påhlsson
 
12
 * Copyright © 2008-2016 Teddy Hogeborn
 
13
 * Copyright © 2008-2016 Björn Påhlsson
14
14
 * 
15
15
 * This program is free software: you can redistribute it and/or
16
16
 * modify it under the terms of the GNU General Public License as
26
26
 * along with this program.  If not, see
27
27
 * <http://www.gnu.org/licenses/>.
28
28
 * 
29
 
 * Contact the authors at <mandos@fukt.bsnet.se>.
 
29
 * Contact the authors at <mandos@recompile.se>.
30
30
 */
31
31
 
32
32
/* Needed by GPGME, specifically gpgme_data_seek() */
33
33
#ifndef _LARGEFILE_SOURCE
34
34
#define _LARGEFILE_SOURCE
35
 
#endif
 
35
#endif  /* not _LARGEFILE_SOURCE */
36
36
#ifndef _FILE_OFFSET_BITS
37
37
#define _FILE_OFFSET_BITS 64
38
 
#endif
 
38
#endif  /* not _FILE_OFFSET_BITS */
39
39
 
40
40
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY(), asprintf() */
41
41
 
42
42
#include <stdio.h>              /* fprintf(), stderr, fwrite(),
43
 
                                   stdout, ferror(), remove() */
44
 
#include <stdint.h>             /* uint16_t, uint32_t */
 
43
                                   stdout, ferror() */
 
44
#include <stdint.h>             /* uint16_t, uint32_t, intptr_t */
45
45
#include <stddef.h>             /* NULL, size_t, ssize_t */
46
46
#include <stdlib.h>             /* free(), EXIT_SUCCESS, srand(),
47
47
                                   strtof(), abort() */
48
48
#include <stdbool.h>            /* bool, false, true */
49
 
#include <string.h>             /* memset(), strcmp(), strlen(),
50
 
                                   strerror(), asprintf(), strcpy() */
 
49
#include <string.h>             /* strcmp(), strlen(), strerror(),
 
50
                                   asprintf(), strncpy(), strsignal()
 
51
                                */
51
52
#include <sys/ioctl.h>          /* ioctl */
52
53
#include <sys/types.h>          /* socket(), inet_pton(), sockaddr,
53
54
                                   sockaddr_in6, PF_INET6,
54
55
                                   SOCK_STREAM, uid_t, gid_t, open(),
55
56
                                   opendir(), DIR */
56
 
#include <sys/stat.h>           /* open() */
 
57
#include <sys/stat.h>           /* open(), S_ISREG */
57
58
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
58
 
                                   inet_pton(), connect() */
59
 
#include <fcntl.h>              /* open() */
 
59
                                   inet_pton(), connect(),
 
60
                                   getnameinfo() */
 
61
#include <fcntl.h>              /* open(), unlinkat(), AT_REMOVEDIR */
60
62
#include <dirent.h>             /* opendir(), struct dirent, readdir()
61
63
                                 */
62
64
#include <inttypes.h>           /* PRIu16, PRIdMAX, intmax_t,
63
65
                                   strtoimax() */
64
 
#include <assert.h>             /* assert() */
65
 
#include <errno.h>              /* perror(), errno,
 
66
#include <errno.h>              /* perror(), errno, EINTR, EINVAL,
 
67
                                   EAI_SYSTEM, ENETUNREACH,
 
68
                                   EHOSTUNREACH, ECONNREFUSED, EPROTO,
 
69
                                   EIO, ENOENT, ENXIO, ENOMEM, EISDIR,
 
70
                                   ENOTEMPTY,
66
71
                                   program_invocation_short_name */
67
72
#include <time.h>               /* nanosleep(), time(), sleep() */
68
73
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
73
78
                                */
74
79
#include <unistd.h>             /* close(), SEEK_SET, off_t, write(),
75
80
                                   getuid(), getgid(), seteuid(),
76
 
                                   setgid(), pause() */
77
 
#include <arpa/inet.h>          /* inet_pton(), htons, inet_ntop() */
 
81
                                   setgid(), pause(), _exit(),
 
82
                                   unlinkat() */
 
83
#include <arpa/inet.h>          /* inet_pton(), htons() */
78
84
#include <iso646.h>             /* not, or, and */
79
85
#include <argp.h>               /* struct argp_option, error_t, struct
80
86
                                   argp_state, struct argp,
85
91
                                   raise() */
86
92
#include <sysexits.h>           /* EX_OSERR, EX_USAGE, EX_UNAVAILABLE,
87
93
                                   EX_NOHOST, EX_IOERR, EX_PROTOCOL */
 
94
#include <sys/wait.h>           /* waitpid(), WIFEXITED(),
 
95
                                   WEXITSTATUS(), WTERMSIG() */
 
96
#include <grp.h>                /* setgroups() */
 
97
#include <argz.h>               /* argz_add_sep(), argz_next(),
 
98
                                   argz_delete(), argz_append(),
 
99
                                   argz_stringify(), argz_add(),
 
100
                                   argz_count() */
 
101
#include <netdb.h>              /* getnameinfo(), NI_NUMERICHOST,
 
102
                                   EAI_SYSTEM, gai_strerror() */
88
103
 
89
104
#ifdef __linux__
90
105
#include <sys/klog.h>           /* klogctl() */
108
123
                                   init_gnutls_session(),
109
124
                                   GNUTLS_* */
110
125
#include <gnutls/openpgp.h>
111
 
                          /* gnutls_certificate_set_openpgp_key_file(),
112
 
                                   GNUTLS_OPENPGP_FMT_BASE64 */
 
126
                         /* gnutls_certificate_set_openpgp_key_file(),
 
127
                            GNUTLS_OPENPGP_FMT_BASE64 */
113
128
 
114
129
/* GPGME */
115
130
#include <gpgme.h>              /* All GPGME types, constants and
123
138
#define PATHDIR "/conf/conf.d/mandos"
124
139
#define SECKEY "seckey.txt"
125
140
#define PUBKEY "pubkey.txt"
 
141
#define HOOKDIR "/lib/mandos/network-hooks.d"
126
142
 
127
143
bool debug = false;
128
144
static const char mandos_protocol_version[] = "1";
129
145
const char *argp_program_version = "mandos-client " VERSION;
130
 
const char *argp_program_bug_address = "<mandos@fukt.bsnet.se>";
 
146
const char *argp_program_bug_address = "<mandos@recompile.se>";
131
147
static const char sys_class_net[] = "/sys/class/net";
132
148
char *connect_to = NULL;
 
149
const char *hookdir = HOOKDIR;
 
150
int hookdir_fd = -1;
 
151
uid_t uid = 65534;
 
152
gid_t gid = 65534;
133
153
 
134
154
/* Doubly linked list that need to be circularly linked when used */
135
155
typedef struct server{
136
156
  const char *ip;
137
 
  uint16_t port;
 
157
  in_port_t port;
138
158
  AvahiIfIndex if_index;
139
159
  int af;
140
160
  struct timespec last_seen;
144
164
 
145
165
/* Used for passing in values through the Avahi callback functions */
146
166
typedef struct {
147
 
  AvahiSimplePoll *simple_poll;
148
167
  AvahiServer *server;
149
168
  gnutls_certificate_credentials_t cred;
150
169
  unsigned int dh_bits;
152
171
  const char *priority;
153
172
  gpgme_ctx_t ctx;
154
173
  server *current_server;
 
174
  char *interfaces;
 
175
  size_t interfaces_size;
155
176
} mandos_context;
156
177
 
157
 
/* global context so signal handler can reach it*/
158
 
mandos_context mc = { .simple_poll = NULL, .server = NULL,
159
 
                      .dh_bits = 1024, .priority = "SECURE256"
160
 
                      ":!CTYPE-X.509:+CTYPE-OPENPGP",
161
 
                      .current_server = NULL };
 
178
/* global so signal handler can reach it*/
 
179
AvahiSimplePoll *simple_poll;
162
180
 
163
181
sig_atomic_t quit_now = 0;
164
182
int signal_received = 0;
165
183
 
166
184
/* Function to use when printing errors */
167
185
void perror_plus(const char *print_text){
 
186
  int e = errno;
168
187
  fprintf(stderr, "Mandos plugin %s: ",
169
188
          program_invocation_short_name);
 
189
  errno = e;
170
190
  perror(print_text);
171
191
}
172
192
 
 
193
__attribute__((format (gnu_printf, 2, 3), nonnull))
 
194
int fprintf_plus(FILE *stream, const char *format, ...){
 
195
  va_list ap;
 
196
  va_start (ap, format);
 
197
  
 
198
  TEMP_FAILURE_RETRY(fprintf(stream, "Mandos plugin %s: ",
 
199
                             program_invocation_short_name));
 
200
  return (int)TEMP_FAILURE_RETRY(vfprintf(stream, format, ap));
 
201
}
 
202
 
173
203
/*
174
204
 * Make additional room in "buffer" for at least BUFFER_SIZE more
175
205
 * bytes. "buffer_capacity" is how much is currently allocated,
176
206
 * "buffer_length" is how much is already used.
177
207
 */
 
208
__attribute__((nonnull, warn_unused_result))
178
209
size_t incbuffer(char **buffer, size_t buffer_length,
179
 
                  size_t buffer_capacity){
 
210
                 size_t buffer_capacity){
180
211
  if(buffer_length + BUFFER_SIZE > buffer_capacity){
181
 
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
182
 
    if(buffer == NULL){
 
212
    char *new_buf = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
 
213
    if(new_buf == NULL){
 
214
      int old_errno = errno;
 
215
      free(*buffer);
 
216
      errno = old_errno;
 
217
      *buffer = NULL;
183
218
      return 0;
184
219
    }
 
220
    *buffer = new_buf;
185
221
    buffer_capacity += BUFFER_SIZE;
186
222
  }
187
223
  return buffer_capacity;
188
224
}
189
225
 
190
226
/* Add server to set of servers to retry periodically */
191
 
int add_server(const char *ip, uint16_t port,
192
 
                 AvahiIfIndex if_index,
193
 
                 int af){
 
227
__attribute__((nonnull, warn_unused_result))
 
228
bool add_server(const char *ip, in_port_t port, AvahiIfIndex if_index,
 
229
                int af, server **current_server){
194
230
  int ret;
195
231
  server *new_server = malloc(sizeof(server));
196
232
  if(new_server == NULL){
197
233
    perror_plus("malloc");
198
 
    return -1;
 
234
    return false;
199
235
  }
200
236
  *new_server = (server){ .ip = strdup(ip),
201
 
                         .port = port,
202
 
                         .if_index = if_index,
203
 
                         .af = af };
 
237
                          .port = port,
 
238
                          .if_index = if_index,
 
239
                          .af = af };
204
240
  if(new_server->ip == NULL){
205
241
    perror_plus("strdup");
206
 
    return -1;
 
242
    free(new_server);
 
243
    return false;
 
244
  }
 
245
  ret = clock_gettime(CLOCK_MONOTONIC, &(new_server->last_seen));
 
246
  if(ret == -1){
 
247
    perror_plus("clock_gettime");
 
248
#ifdef __GNUC__
 
249
#pragma GCC diagnostic push
 
250
#pragma GCC diagnostic ignored "-Wcast-qual"
 
251
#endif
 
252
    free((char *)(new_server->ip));
 
253
#ifdef __GNUC__
 
254
#pragma GCC diagnostic pop
 
255
#endif
 
256
    free(new_server);
 
257
    return false;
207
258
  }
208
259
  /* Special case of first server */
209
 
  if (mc.current_server == NULL){
 
260
  if(*current_server == NULL){
210
261
    new_server->next = new_server;
211
262
    new_server->prev = new_server;
212
 
    mc.current_server = new_server;
213
 
  /* Place the new server last in the list */
 
263
    *current_server = new_server;
214
264
  } else {
215
 
    new_server->next = mc.current_server;
216
 
    new_server->prev = mc.current_server->prev;
 
265
    /* Place the new server last in the list */
 
266
    new_server->next = *current_server;
 
267
    new_server->prev = (*current_server)->prev;
217
268
    new_server->prev->next = new_server;
218
 
    mc.current_server->prev = new_server;
219
 
  }
220
 
  ret = clock_gettime(CLOCK_MONOTONIC, &mc.current_server->last_seen);
221
 
  if(ret == -1){
222
 
    perror_plus("clock_gettime");
223
 
    return -1;
224
 
  }
225
 
  return 0;
 
269
    (*current_server)->prev = new_server;
 
270
  }
 
271
  return true;
226
272
}
227
273
 
228
274
/* 
229
275
 * Initialize GPGME.
230
276
 */
231
 
static bool init_gpgme(const char *seckey,
232
 
                       const char *pubkey, const char *tempdir){
 
277
__attribute__((nonnull, warn_unused_result))
 
278
static bool init_gpgme(const char * const seckey,
 
279
                       const char * const pubkey,
 
280
                       const char * const tempdir,
 
281
                       mandos_context *mc){
233
282
  gpgme_error_t rc;
234
283
  gpgme_engine_info_t engine_info;
235
284
  
236
 
  
237
285
  /*
238
286
   * Helper function to insert pub and seckey to the engine keyring.
239
287
   */
240
 
  bool import_key(const char *filename){
 
288
  bool import_key(const char * const filename){
241
289
    int ret;
242
290
    int fd;
243
291
    gpgme_data_t pgp_data;
250
298
    
251
299
    rc = gpgme_data_new_from_fd(&pgp_data, fd);
252
300
    if(rc != GPG_ERR_NO_ERROR){
253
 
      fprintf(stderr, "bad gpgme_data_new_from_fd: %s: %s\n",
254
 
              gpgme_strsource(rc), gpgme_strerror(rc));
 
301
      fprintf_plus(stderr, "bad gpgme_data_new_from_fd: %s: %s\n",
 
302
                   gpgme_strsource(rc), gpgme_strerror(rc));
255
303
      return false;
256
304
    }
257
305
    
258
 
    rc = gpgme_op_import(mc.ctx, pgp_data);
 
306
    rc = gpgme_op_import(mc->ctx, pgp_data);
259
307
    if(rc != GPG_ERR_NO_ERROR){
260
 
      fprintf(stderr, "bad gpgme_op_import: %s: %s\n",
261
 
              gpgme_strsource(rc), gpgme_strerror(rc));
 
308
      fprintf_plus(stderr, "bad gpgme_op_import: %s: %s\n",
 
309
                   gpgme_strsource(rc), gpgme_strerror(rc));
262
310
      return false;
263
311
    }
264
312
    
265
 
    ret = (int)TEMP_FAILURE_RETRY(close(fd));
 
313
    ret = close(fd);
266
314
    if(ret == -1){
267
315
      perror_plus("close");
268
316
    }
271
319
  }
272
320
  
273
321
  if(debug){
274
 
    fprintf(stderr, "Initializing GPGME\n");
 
322
    fprintf_plus(stderr, "Initializing GPGME\n");
275
323
  }
276
324
  
277
325
  /* Init GPGME */
278
326
  gpgme_check_version(NULL);
279
327
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
280
328
  if(rc != GPG_ERR_NO_ERROR){
281
 
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
282
 
            gpgme_strsource(rc), gpgme_strerror(rc));
 
329
    fprintf_plus(stderr, "bad gpgme_engine_check_version: %s: %s\n",
 
330
                 gpgme_strsource(rc), gpgme_strerror(rc));
283
331
    return false;
284
332
  }
285
333
  
286
334
  /* Set GPGME home directory for the OpenPGP engine only */
287
335
  rc = gpgme_get_engine_info(&engine_info);
288
336
  if(rc != GPG_ERR_NO_ERROR){
289
 
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
290
 
            gpgme_strsource(rc), gpgme_strerror(rc));
 
337
    fprintf_plus(stderr, "bad gpgme_get_engine_info: %s: %s\n",
 
338
                 gpgme_strsource(rc), gpgme_strerror(rc));
291
339
    return false;
292
340
  }
293
341
  while(engine_info != NULL){
299
347
    engine_info = engine_info->next;
300
348
  }
301
349
  if(engine_info == NULL){
302
 
    fprintf(stderr, "Could not set GPGME home dir to %s\n", tempdir);
 
350
    fprintf_plus(stderr, "Could not set GPGME home dir to %s\n",
 
351
                 tempdir);
303
352
    return false;
304
353
  }
305
354
  
306
355
  /* Create new GPGME "context" */
307
 
  rc = gpgme_new(&(mc.ctx));
 
356
  rc = gpgme_new(&(mc->ctx));
308
357
  if(rc != GPG_ERR_NO_ERROR){
309
 
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
310
 
            gpgme_strsource(rc), gpgme_strerror(rc));
 
358
    fprintf_plus(stderr, "Mandos plugin mandos-client: "
 
359
                 "bad gpgme_new: %s: %s\n", gpgme_strsource(rc),
 
360
                 gpgme_strerror(rc));
311
361
    return false;
312
362
  }
313
363
  
322
372
 * Decrypt OpenPGP data.
323
373
 * Returns -1 on error
324
374
 */
 
375
__attribute__((nonnull, warn_unused_result))
325
376
static ssize_t pgp_packet_decrypt(const char *cryptotext,
326
377
                                  size_t crypto_size,
327
 
                                  char **plaintext){
 
378
                                  char **plaintext,
 
379
                                  mandos_context *mc){
328
380
  gpgme_data_t dh_crypto, dh_plain;
329
381
  gpgme_error_t rc;
330
382
  ssize_t ret;
332
384
  ssize_t plaintext_length = 0;
333
385
  
334
386
  if(debug){
335
 
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
 
387
    fprintf_plus(stderr, "Trying to decrypt OpenPGP data\n");
336
388
  }
337
389
  
338
390
  /* Create new GPGME data buffer from memory cryptotext */
339
391
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
340
392
                               0);
341
393
  if(rc != GPG_ERR_NO_ERROR){
342
 
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
343
 
            gpgme_strsource(rc), gpgme_strerror(rc));
 
394
    fprintf_plus(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
 
395
                 gpgme_strsource(rc), gpgme_strerror(rc));
344
396
    return -1;
345
397
  }
346
398
  
347
399
  /* Create new empty GPGME data buffer for the plaintext */
348
400
  rc = gpgme_data_new(&dh_plain);
349
401
  if(rc != GPG_ERR_NO_ERROR){
350
 
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
351
 
            gpgme_strsource(rc), gpgme_strerror(rc));
 
402
    fprintf_plus(stderr, "Mandos plugin mandos-client: "
 
403
                 "bad gpgme_data_new: %s: %s\n",
 
404
                 gpgme_strsource(rc), gpgme_strerror(rc));
352
405
    gpgme_data_release(dh_crypto);
353
406
    return -1;
354
407
  }
355
408
  
356
409
  /* Decrypt data from the cryptotext data buffer to the plaintext
357
410
     data buffer */
358
 
  rc = gpgme_op_decrypt(mc.ctx, dh_crypto, dh_plain);
 
411
  rc = gpgme_op_decrypt(mc->ctx, dh_crypto, dh_plain);
359
412
  if(rc != GPG_ERR_NO_ERROR){
360
 
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
361
 
            gpgme_strsource(rc), gpgme_strerror(rc));
 
413
    fprintf_plus(stderr, "bad gpgme_op_decrypt: %s: %s\n",
 
414
                 gpgme_strsource(rc), gpgme_strerror(rc));
362
415
    plaintext_length = -1;
363
416
    if(debug){
364
417
      gpgme_decrypt_result_t result;
365
 
      result = gpgme_op_decrypt_result(mc.ctx);
 
418
      result = gpgme_op_decrypt_result(mc->ctx);
366
419
      if(result == NULL){
367
 
        fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
420
        fprintf_plus(stderr, "gpgme_op_decrypt_result failed\n");
368
421
      } else {
369
 
        fprintf(stderr, "Unsupported algorithm: %s\n",
370
 
                result->unsupported_algorithm);
371
 
        fprintf(stderr, "Wrong key usage: %u\n",
372
 
                result->wrong_key_usage);
 
422
        fprintf_plus(stderr, "Unsupported algorithm: %s\n",
 
423
                     result->unsupported_algorithm);
 
424
        fprintf_plus(stderr, "Wrong key usage: %u\n",
 
425
                     result->wrong_key_usage);
373
426
        if(result->file_name != NULL){
374
 
          fprintf(stderr, "File name: %s\n", result->file_name);
 
427
          fprintf_plus(stderr, "File name: %s\n", result->file_name);
375
428
        }
376
429
        gpgme_recipient_t recipient;
377
430
        recipient = result->recipients;
378
431
        while(recipient != NULL){
379
 
          fprintf(stderr, "Public key algorithm: %s\n",
380
 
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
381
 
          fprintf(stderr, "Key ID: %s\n", recipient->keyid);
382
 
          fprintf(stderr, "Secret key available: %s\n",
383
 
                  recipient->status == GPG_ERR_NO_SECKEY
384
 
                  ? "No" : "Yes");
 
432
          fprintf_plus(stderr, "Public key algorithm: %s\n",
 
433
                       gpgme_pubkey_algo_name
 
434
                       (recipient->pubkey_algo));
 
435
          fprintf_plus(stderr, "Key ID: %s\n", recipient->keyid);
 
436
          fprintf_plus(stderr, "Secret key available: %s\n",
 
437
                       recipient->status == GPG_ERR_NO_SECKEY
 
438
                       ? "No" : "Yes");
385
439
          recipient = recipient->next;
386
440
        }
387
441
      }
390
444
  }
391
445
  
392
446
  if(debug){
393
 
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
 
447
    fprintf_plus(stderr, "Decryption of OpenPGP data succeeded\n");
394
448
  }
395
449
  
396
450
  /* Seek back to the beginning of the GPGME plaintext data buffer */
403
457
  *plaintext = NULL;
404
458
  while(true){
405
459
    plaintext_capacity = incbuffer(plaintext,
406
 
                                      (size_t)plaintext_length,
407
 
                                      plaintext_capacity);
 
460
                                   (size_t)plaintext_length,
 
461
                                   plaintext_capacity);
408
462
    if(plaintext_capacity == 0){
409
 
        perror_plus("incbuffer");
410
 
        plaintext_length = -1;
411
 
        goto decrypt_end;
 
463
      perror_plus("incbuffer");
 
464
      plaintext_length = -1;
 
465
      goto decrypt_end;
412
466
    }
413
467
    
414
468
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
427
481
  }
428
482
  
429
483
  if(debug){
430
 
    fprintf(stderr, "Decrypted password is: ");
 
484
    fprintf_plus(stderr, "Decrypted password is: ");
431
485
    for(ssize_t i = 0; i < plaintext_length; i++){
432
486
      fprintf(stderr, "%02hhX ", (*plaintext)[i]);
433
487
    }
444
498
  return plaintext_length;
445
499
}
446
500
 
447
 
static const char * safer_gnutls_strerror(int value){
448
 
  const char *ret = gnutls_strerror(value); /* Spurious warning from
449
 
                                               -Wunreachable-code */
450
 
  if(ret == NULL)
451
 
    ret = "(unknown)";
452
 
  return ret;
 
501
__attribute__((warn_unused_result, const))
 
502
static const char *safe_string(const char *str){
 
503
  if(str == NULL)
 
504
    return "(unknown)";
 
505
  return str;
 
506
}
 
507
 
 
508
__attribute__((warn_unused_result))
 
509
static const char *safer_gnutls_strerror(int value){
 
510
  const char *ret = gnutls_strerror(value);
 
511
  return safe_string(ret);
453
512
}
454
513
 
455
514
/* GnuTLS log function callback */
 
515
__attribute__((nonnull))
456
516
static void debuggnutls(__attribute__((unused)) int level,
457
517
                        const char* string){
458
 
  fprintf(stderr, "GnuTLS: %s", string);
 
518
  fprintf_plus(stderr, "GnuTLS: %s", string);
459
519
}
460
520
 
 
521
__attribute__((nonnull(1, 2, 4), warn_unused_result))
461
522
static int init_gnutls_global(const char *pubkeyfilename,
462
 
                              const char *seckeyfilename){
 
523
                              const char *seckeyfilename,
 
524
                              const char *dhparamsfilename,
 
525
                              mandos_context *mc){
463
526
  int ret;
 
527
  unsigned int uret;
464
528
  
465
529
  if(debug){
466
 
    fprintf(stderr, "Initializing GnuTLS\n");
467
 
  }
468
 
  
469
 
  ret = gnutls_global_init();
470
 
  if(ret != GNUTLS_E_SUCCESS){
471
 
    fprintf(stderr, "GnuTLS global_init: %s\n",
472
 
            safer_gnutls_strerror(ret));
473
 
    return -1;
 
530
    fprintf_plus(stderr, "Initializing GnuTLS\n");
474
531
  }
475
532
  
476
533
  if(debug){
482
539
  }
483
540
  
484
541
  /* OpenPGP credentials */
485
 
  ret = gnutls_certificate_allocate_credentials(&mc.cred);
 
542
  ret = gnutls_certificate_allocate_credentials(&mc->cred);
486
543
  if(ret != GNUTLS_E_SUCCESS){
487
 
    fprintf(stderr, "GnuTLS memory error: %s\n",
488
 
            safer_gnutls_strerror(ret));
489
 
    gnutls_global_deinit();
 
544
    fprintf_plus(stderr, "GnuTLS memory error: %s\n",
 
545
                 safer_gnutls_strerror(ret));
490
546
    return -1;
491
547
  }
492
548
  
493
549
  if(debug){
494
 
    fprintf(stderr, "Attempting to use OpenPGP public key %s and"
495
 
            " secret key %s as GnuTLS credentials\n", pubkeyfilename,
496
 
            seckeyfilename);
 
550
    fprintf_plus(stderr, "Attempting to use OpenPGP public key %s and"
 
551
                 " secret key %s as GnuTLS credentials\n",
 
552
                 pubkeyfilename,
 
553
                 seckeyfilename);
497
554
  }
498
555
  
499
556
  ret = gnutls_certificate_set_openpgp_key_file
500
 
    (mc.cred, pubkeyfilename, seckeyfilename,
 
557
    (mc->cred, pubkeyfilename, seckeyfilename,
501
558
     GNUTLS_OPENPGP_FMT_BASE64);
502
559
  if(ret != GNUTLS_E_SUCCESS){
503
 
    fprintf(stderr,
504
 
            "Error[%d] while reading the OpenPGP key pair ('%s',"
505
 
            " '%s')\n", ret, pubkeyfilename, seckeyfilename);
506
 
    fprintf(stderr, "The GnuTLS error is: %s\n",
507
 
            safer_gnutls_strerror(ret));
 
560
    fprintf_plus(stderr,
 
561
                 "Error[%d] while reading the OpenPGP key pair ('%s',"
 
562
                 " '%s')\n", ret, pubkeyfilename, seckeyfilename);
 
563
    fprintf_plus(stderr, "The GnuTLS error is: %s\n",
 
564
                 safer_gnutls_strerror(ret));
508
565
    goto globalfail;
509
566
  }
510
567
  
511
568
  /* GnuTLS server initialization */
512
 
  ret = gnutls_dh_params_init(&mc.dh_params);
513
 
  if(ret != GNUTLS_E_SUCCESS){
514
 
    fprintf(stderr, "Error in GnuTLS DH parameter initialization:"
515
 
            " %s\n", safer_gnutls_strerror(ret));
516
 
    goto globalfail;
517
 
  }
518
 
  ret = gnutls_dh_params_generate2(mc.dh_params, mc.dh_bits);
519
 
  if(ret != GNUTLS_E_SUCCESS){
520
 
    fprintf(stderr, "Error in GnuTLS prime generation: %s\n",
521
 
            safer_gnutls_strerror(ret));
522
 
    goto globalfail;
523
 
  }
524
 
  
525
 
  gnutls_certificate_set_dh_params(mc.cred, mc.dh_params);
 
569
  ret = gnutls_dh_params_init(&mc->dh_params);
 
570
  if(ret != GNUTLS_E_SUCCESS){
 
571
    fprintf_plus(stderr, "Error in GnuTLS DH parameter"
 
572
                 " initialization: %s\n",
 
573
                 safer_gnutls_strerror(ret));
 
574
    goto globalfail;
 
575
  }
 
576
  /* If a Diffie-Hellman parameters file was given, try to use it */
 
577
  if(dhparamsfilename != NULL){
 
578
    gnutls_datum_t params = { .data = NULL, .size = 0 };
 
579
    do {
 
580
      int dhpfile = open(dhparamsfilename, O_RDONLY);
 
581
      if(dhpfile == -1){
 
582
        perror_plus("open");
 
583
        dhparamsfilename = NULL;
 
584
        break;
 
585
      }
 
586
      size_t params_capacity = 0;
 
587
      while(true){
 
588
        params_capacity = incbuffer((char **)&params.data,
 
589
                                    (size_t)params.size,
 
590
                                    (size_t)params_capacity);
 
591
        if(params_capacity == 0){
 
592
          perror_plus("incbuffer");
 
593
          free(params.data);
 
594
          params.data = NULL;
 
595
          dhparamsfilename = NULL;
 
596
          break;
 
597
        }
 
598
        ssize_t bytes_read = read(dhpfile,
 
599
                                  params.data + params.size,
 
600
                                  BUFFER_SIZE);
 
601
        /* EOF */
 
602
        if(bytes_read == 0){
 
603
          break;
 
604
        }
 
605
        /* check bytes_read for failure */
 
606
        if(bytes_read < 0){
 
607
          perror_plus("read");
 
608
          free(params.data);
 
609
          params.data = NULL;
 
610
          dhparamsfilename = NULL;
 
611
          break;
 
612
        }
 
613
        params.size += (unsigned int)bytes_read;
 
614
      }
 
615
      if(params.data == NULL){
 
616
        dhparamsfilename = NULL;
 
617
      }
 
618
      if(dhparamsfilename == NULL){
 
619
        break;
 
620
      }
 
621
      ret = gnutls_dh_params_import_pkcs3(mc->dh_params, &params,
 
622
                                          GNUTLS_X509_FMT_PEM);
 
623
      if(ret != GNUTLS_E_SUCCESS){
 
624
        fprintf_plus(stderr, "Failed to parse DH parameters in file"
 
625
                     " \"%s\": %s\n", dhparamsfilename,
 
626
                     safer_gnutls_strerror(ret));
 
627
        dhparamsfilename = NULL;
 
628
      }
 
629
      free(params.data);
 
630
    } while(false);
 
631
  }
 
632
  if(dhparamsfilename == NULL){
 
633
    if(mc->dh_bits == 0){
 
634
      /* Find out the optimal number of DH bits */
 
635
      /* Try to read the private key file */
 
636
      gnutls_datum_t buffer = { .data = NULL, .size = 0 };
 
637
      do {
 
638
        int secfile = open(seckeyfilename, O_RDONLY);
 
639
        if(secfile == -1){
 
640
          perror_plus("open");
 
641
          break;
 
642
        }
 
643
        size_t buffer_capacity = 0;
 
644
        while(true){
 
645
          buffer_capacity = incbuffer((char **)&buffer.data,
 
646
                                      (size_t)buffer.size,
 
647
                                      (size_t)buffer_capacity);
 
648
          if(buffer_capacity == 0){
 
649
            perror_plus("incbuffer");
 
650
            free(buffer.data);
 
651
            buffer.data = NULL;
 
652
            break;
 
653
          }
 
654
          ssize_t bytes_read = read(secfile,
 
655
                                    buffer.data + buffer.size,
 
656
                                    BUFFER_SIZE);
 
657
          /* EOF */
 
658
          if(bytes_read == 0){
 
659
            break;
 
660
          }
 
661
          /* check bytes_read for failure */
 
662
          if(bytes_read < 0){
 
663
            perror_plus("read");
 
664
            free(buffer.data);
 
665
            buffer.data = NULL;
 
666
            break;
 
667
          }
 
668
          buffer.size += (unsigned int)bytes_read;
 
669
        }
 
670
        close(secfile);
 
671
      } while(false);
 
672
      /* If successful, use buffer to parse private key */
 
673
      gnutls_sec_param_t sec_param = GNUTLS_SEC_PARAM_ULTRA;
 
674
      if(buffer.data != NULL){
 
675
        {
 
676
          gnutls_openpgp_privkey_t privkey = NULL;
 
677
          ret = gnutls_openpgp_privkey_init(&privkey);
 
678
          if(ret != GNUTLS_E_SUCCESS){
 
679
            fprintf_plus(stderr, "Error initializing OpenPGP key"
 
680
                         " structure: %s",
 
681
                         safer_gnutls_strerror(ret));
 
682
            free(buffer.data);
 
683
            buffer.data = NULL;
 
684
          } else {
 
685
            ret = gnutls_openpgp_privkey_import
 
686
              (privkey, &buffer, GNUTLS_OPENPGP_FMT_BASE64, "", 0);
 
687
            if(ret != GNUTLS_E_SUCCESS){
 
688
              fprintf_plus(stderr, "Error importing OpenPGP key : %s",
 
689
                           safer_gnutls_strerror(ret));
 
690
              privkey = NULL;
 
691
            }
 
692
            free(buffer.data);
 
693
            buffer.data = NULL;
 
694
            if(privkey != NULL){
 
695
              /* Use private key to suggest an appropriate
 
696
                 sec_param */
 
697
              sec_param = gnutls_openpgp_privkey_sec_param(privkey);
 
698
              gnutls_openpgp_privkey_deinit(privkey);
 
699
              if(debug){
 
700
                fprintf_plus(stderr, "This OpenPGP key implies using"
 
701
                             " a GnuTLS security parameter \"%s\".\n",
 
702
                             safe_string(gnutls_sec_param_get_name
 
703
                                         (sec_param)));
 
704
              }
 
705
            }
 
706
          }
 
707
        }
 
708
        if(sec_param == GNUTLS_SEC_PARAM_UNKNOWN){
 
709
          /* Err on the side of caution */
 
710
          sec_param = GNUTLS_SEC_PARAM_ULTRA;
 
711
          if(debug){
 
712
            fprintf_plus(stderr, "Falling back to security parameter"
 
713
                         " \"%s\"\n",
 
714
                         safe_string(gnutls_sec_param_get_name
 
715
                                     (sec_param)));
 
716
          }
 
717
        }
 
718
      }
 
719
      uret = gnutls_sec_param_to_pk_bits(GNUTLS_PK_DH, sec_param);
 
720
      if(uret != 0){
 
721
        mc->dh_bits = uret;
 
722
        if(debug){
 
723
          fprintf_plus(stderr, "A \"%s\" GnuTLS security parameter"
 
724
                       " implies %u DH bits; using that.\n",
 
725
                       safe_string(gnutls_sec_param_get_name
 
726
                                   (sec_param)),
 
727
                       mc->dh_bits);
 
728
        }
 
729
      } else {
 
730
        fprintf_plus(stderr, "Failed to get implied number of DH"
 
731
                     " bits for security parameter \"%s\"): %s\n",
 
732
                     safe_string(gnutls_sec_param_get_name
 
733
                                 (sec_param)),
 
734
                     safer_gnutls_strerror(ret));
 
735
        goto globalfail;
 
736
      }
 
737
    } else if(debug){
 
738
      fprintf_plus(stderr, "DH bits explicitly set to %u\n",
 
739
                   mc->dh_bits);
 
740
    }
 
741
    ret = gnutls_dh_params_generate2(mc->dh_params, mc->dh_bits);
 
742
    if(ret != GNUTLS_E_SUCCESS){
 
743
      fprintf_plus(stderr, "Error in GnuTLS prime generation (%u"
 
744
                   " bits): %s\n", mc->dh_bits,
 
745
                   safer_gnutls_strerror(ret));
 
746
      goto globalfail;
 
747
    }
 
748
  }
 
749
  gnutls_certificate_set_dh_params(mc->cred, mc->dh_params);
526
750
  
527
751
  return 0;
528
752
  
529
753
 globalfail:
530
754
  
531
 
  gnutls_certificate_free_credentials(mc.cred);
532
 
  gnutls_global_deinit();
533
 
  gnutls_dh_params_deinit(mc.dh_params);
 
755
  gnutls_certificate_free_credentials(mc->cred);
 
756
  gnutls_dh_params_deinit(mc->dh_params);
534
757
  return -1;
535
758
}
536
759
 
537
 
static int init_gnutls_session(gnutls_session_t *session){
 
760
__attribute__((nonnull, warn_unused_result))
 
761
static int init_gnutls_session(gnutls_session_t *session,
 
762
                               mandos_context *mc){
538
763
  int ret;
539
764
  /* GnuTLS session creation */
540
765
  do {
544
769
    }
545
770
  } while(ret == GNUTLS_E_INTERRUPTED or ret == GNUTLS_E_AGAIN);
546
771
  if(ret != GNUTLS_E_SUCCESS){
547
 
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
548
 
            safer_gnutls_strerror(ret));
 
772
    fprintf_plus(stderr,
 
773
                 "Error in GnuTLS session initialization: %s\n",
 
774
                 safer_gnutls_strerror(ret));
549
775
  }
550
776
  
551
777
  {
552
778
    const char *err;
553
779
    do {
554
 
      ret = gnutls_priority_set_direct(*session, mc.priority, &err);
 
780
      ret = gnutls_priority_set_direct(*session, mc->priority, &err);
555
781
      if(quit_now){
556
782
        gnutls_deinit(*session);
557
783
        return -1;
558
784
      }
559
785
    } while(ret == GNUTLS_E_INTERRUPTED or ret == GNUTLS_E_AGAIN);
560
786
    if(ret != GNUTLS_E_SUCCESS){
561
 
      fprintf(stderr, "Syntax error at: %s\n", err);
562
 
      fprintf(stderr, "GnuTLS error: %s\n",
563
 
              safer_gnutls_strerror(ret));
 
787
      fprintf_plus(stderr, "Syntax error at: %s\n", err);
 
788
      fprintf_plus(stderr, "GnuTLS error: %s\n",
 
789
                   safer_gnutls_strerror(ret));
564
790
      gnutls_deinit(*session);
565
791
      return -1;
566
792
    }
568
794
  
569
795
  do {
570
796
    ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
571
 
                                 mc.cred);
 
797
                                 mc->cred);
572
798
    if(quit_now){
573
799
      gnutls_deinit(*session);
574
800
      return -1;
575
801
    }
576
802
  } while(ret == GNUTLS_E_INTERRUPTED or ret == GNUTLS_E_AGAIN);
577
803
  if(ret != GNUTLS_E_SUCCESS){
578
 
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
579
 
            safer_gnutls_strerror(ret));
 
804
    fprintf_plus(stderr, "Error setting GnuTLS credentials: %s\n",
 
805
                 safer_gnutls_strerror(ret));
580
806
    gnutls_deinit(*session);
581
807
    return -1;
582
808
  }
584
810
  /* ignore client certificate if any. */
585
811
  gnutls_certificate_server_set_request(*session, GNUTLS_CERT_IGNORE);
586
812
  
587
 
  gnutls_dh_set_prime_bits(*session, mc.dh_bits);
588
 
  
589
813
  return 0;
590
814
}
591
815
 
593
817
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
594
818
                      __attribute__((unused)) const char *txt){}
595
819
 
 
820
/* Set effective uid to 0, return errno */
 
821
__attribute__((warn_unused_result))
 
822
int raise_privileges(void){
 
823
  int old_errno = errno;
 
824
  int ret = 0;
 
825
  if(seteuid(0) == -1){
 
826
    ret = errno;
 
827
  }
 
828
  errno = old_errno;
 
829
  return ret;
 
830
}
 
831
 
 
832
/* Set effective and real user ID to 0.  Return errno. */
 
833
__attribute__((warn_unused_result))
 
834
int raise_privileges_permanently(void){
 
835
  int old_errno = errno;
 
836
  int ret = raise_privileges();
 
837
  if(ret != 0){
 
838
    errno = old_errno;
 
839
    return ret;
 
840
  }
 
841
  if(setuid(0) == -1){
 
842
    ret = errno;
 
843
  }
 
844
  errno = old_errno;
 
845
  return ret;
 
846
}
 
847
 
 
848
/* Set effective user ID to unprivileged saved user ID */
 
849
__attribute__((warn_unused_result))
 
850
int lower_privileges(void){
 
851
  int old_errno = errno;
 
852
  int ret = 0;
 
853
  if(seteuid(uid) == -1){
 
854
    ret = errno;
 
855
  }
 
856
  errno = old_errno;
 
857
  return ret;
 
858
}
 
859
 
 
860
/* Lower privileges permanently */
 
861
__attribute__((warn_unused_result))
 
862
int lower_privileges_permanently(void){
 
863
  int old_errno = errno;
 
864
  int ret = 0;
 
865
  if(setuid(uid) == -1){
 
866
    ret = errno;
 
867
  }
 
868
  errno = old_errno;
 
869
  return ret;
 
870
}
 
871
 
 
872
/* Helper function to add_local_route() and delete_local_route() */
 
873
__attribute__((nonnull, warn_unused_result))
 
874
static bool add_delete_local_route(const bool add,
 
875
                                   const char *address,
 
876
                                   AvahiIfIndex if_index){
 
877
  int ret;
 
878
  char helper[] = "mandos-client-iprouteadddel";
 
879
  char add_arg[] = "add";
 
880
  char delete_arg[] = "delete";
 
881
  char debug_flag[] = "--debug";
 
882
  char *pluginhelperdir = getenv("MANDOSPLUGINHELPERDIR");
 
883
  if(pluginhelperdir == NULL){
 
884
    if(debug){
 
885
      fprintf_plus(stderr, "MANDOSPLUGINHELPERDIR environment"
 
886
                   " variable not set; cannot run helper\n");
 
887
    }
 
888
    return false;
 
889
  }
 
890
  
 
891
  char interface[IF_NAMESIZE];
 
892
  if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
893
    perror_plus("if_indextoname");
 
894
    return false;
 
895
  }
 
896
  
 
897
  int devnull = (int)TEMP_FAILURE_RETRY(open("/dev/null", O_RDONLY));
 
898
  if(devnull == -1){
 
899
    perror_plus("open(\"/dev/null\", O_RDONLY)");
 
900
    return false;
 
901
  }
 
902
  pid_t pid = fork();
 
903
  if(pid == 0){
 
904
    /* Child */
 
905
    /* Raise privileges */
 
906
    errno = raise_privileges_permanently();
 
907
    if(errno != 0){
 
908
      perror_plus("Failed to raise privileges");
 
909
      /* _exit(EX_NOPERM); */
 
910
    } else {
 
911
      /* Set group */
 
912
      errno = 0;
 
913
      ret = setgid(0);
 
914
      if(ret == -1){
 
915
        perror_plus("setgid");
 
916
        _exit(EX_NOPERM);
 
917
      }
 
918
      /* Reset supplementary groups */
 
919
      errno = 0;
 
920
      ret = setgroups(0, NULL);
 
921
      if(ret == -1){
 
922
        perror_plus("setgroups");
 
923
        _exit(EX_NOPERM);
 
924
      }
 
925
    }
 
926
    ret = dup2(devnull, STDIN_FILENO);
 
927
    if(ret == -1){
 
928
      perror_plus("dup2(devnull, STDIN_FILENO)");
 
929
      _exit(EX_OSERR);
 
930
    }
 
931
    ret = close(devnull);
 
932
    if(ret == -1){
 
933
      perror_plus("close");
 
934
      _exit(EX_OSERR);
 
935
    }
 
936
    ret = dup2(STDERR_FILENO, STDOUT_FILENO);
 
937
    if(ret == -1){
 
938
      perror_plus("dup2(STDERR_FILENO, STDOUT_FILENO)");
 
939
      _exit(EX_OSERR);
 
940
    }
 
941
    int helperdir_fd = (int)TEMP_FAILURE_RETRY(open(pluginhelperdir,
 
942
                                                    O_RDONLY
 
943
                                                    | O_DIRECTORY
 
944
                                                    | O_PATH
 
945
                                                    | O_CLOEXEC));
 
946
    if(helperdir_fd == -1){
 
947
      perror_plus("open");
 
948
      _exit(EX_UNAVAILABLE);
 
949
    }
 
950
    int helper_fd = (int)TEMP_FAILURE_RETRY(openat(helperdir_fd,
 
951
                                                   helper, O_RDONLY));
 
952
    if(helper_fd == -1){
 
953
      perror_plus("openat");
 
954
      close(helperdir_fd);
 
955
      _exit(EX_UNAVAILABLE);
 
956
    }
 
957
    close(helperdir_fd);
 
958
#ifdef __GNUC__
 
959
#pragma GCC diagnostic push
 
960
#pragma GCC diagnostic ignored "-Wcast-qual"
 
961
#endif
 
962
    if(fexecve(helper_fd, (char *const [])
 
963
               { helper, add ? add_arg : delete_arg, (char *)address,
 
964
                   interface, debug ? debug_flag : NULL, NULL },
 
965
               environ) == -1){
 
966
#ifdef __GNUC__
 
967
#pragma GCC diagnostic pop
 
968
#endif
 
969
      perror_plus("fexecve");
 
970
      _exit(EXIT_FAILURE);
 
971
    }
 
972
  }
 
973
  if(pid == -1){
 
974
    perror_plus("fork");
 
975
    return false;
 
976
  }
 
977
  int status;
 
978
  pid_t pret = -1;
 
979
  errno = 0;
 
980
  do {
 
981
    pret = waitpid(pid, &status, 0);
 
982
    if(pret == -1 and errno == EINTR and quit_now){
 
983
      int errno_raising = 0;
 
984
      if((errno = raise_privileges()) != 0){
 
985
        errno_raising = errno;
 
986
        perror_plus("Failed to raise privileges in order to"
 
987
                    " kill helper program");
 
988
      }
 
989
      if(kill(pid, SIGTERM) == -1){
 
990
        perror_plus("kill");
 
991
      }
 
992
      if((errno_raising == 0) and (errno = lower_privileges()) != 0){
 
993
        perror_plus("Failed to lower privileges after killing"
 
994
                    " helper program");
 
995
      }
 
996
      return false;
 
997
    }
 
998
  } while(pret == -1 and errno == EINTR);
 
999
  if(pret == -1){
 
1000
    perror_plus("waitpid");
 
1001
    return false;
 
1002
  }
 
1003
  if(WIFEXITED(status)){
 
1004
    if(WEXITSTATUS(status) != 0){
 
1005
      fprintf_plus(stderr, "Error: iprouteadddel exited"
 
1006
                   " with status %d\n", WEXITSTATUS(status));
 
1007
      return false;
 
1008
    }
 
1009
    return true;
 
1010
  }
 
1011
  if(WIFSIGNALED(status)){
 
1012
    fprintf_plus(stderr, "Error: iprouteadddel died by"
 
1013
                 " signal %d\n", WTERMSIG(status));
 
1014
    return false;
 
1015
  }
 
1016
  fprintf_plus(stderr, "Error: iprouteadddel crashed\n");
 
1017
  return false;
 
1018
}
 
1019
 
 
1020
__attribute__((nonnull, warn_unused_result))
 
1021
static bool add_local_route(const char *address,
 
1022
                            AvahiIfIndex if_index){
 
1023
  if(debug){
 
1024
    fprintf_plus(stderr, "Adding route to %s\n", address);
 
1025
  }
 
1026
  return add_delete_local_route(true, address, if_index);
 
1027
}
 
1028
 
 
1029
__attribute__((nonnull, warn_unused_result))
 
1030
static bool delete_local_route(const char *address,
 
1031
                               AvahiIfIndex if_index){
 
1032
  if(debug){
 
1033
    fprintf_plus(stderr, "Removing route to %s\n", address);
 
1034
  }
 
1035
  return add_delete_local_route(false, address, if_index);
 
1036
}
 
1037
 
596
1038
/* Called when a Mandos server is found */
597
 
static int start_mandos_communication(const char *ip, uint16_t port,
 
1039
__attribute__((nonnull, warn_unused_result))
 
1040
static int start_mandos_communication(const char *ip, in_port_t port,
598
1041
                                      AvahiIfIndex if_index,
599
 
                                      int af){
 
1042
                                      int af, mandos_context *mc){
600
1043
  int ret, tcp_sd = -1;
601
1044
  ssize_t sret;
602
 
  union {
603
 
    struct sockaddr_in in;
604
 
    struct sockaddr_in6 in6;
605
 
  } to;
 
1045
  struct sockaddr_storage to;
606
1046
  char *buffer = NULL;
607
1047
  char *decrypted_buffer = NULL;
608
1048
  size_t buffer_length = 0;
611
1051
  int retval = -1;
612
1052
  gnutls_session_t session;
613
1053
  int pf;                       /* Protocol family */
 
1054
  bool route_added = false;
614
1055
  
615
1056
  errno = 0;
616
1057
  
627
1068
    pf = PF_INET;
628
1069
    break;
629
1070
  default:
630
 
    fprintf(stderr, "Bad address family: %d\n", af);
 
1071
    fprintf_plus(stderr, "Bad address family: %d\n", af);
631
1072
    errno = EINVAL;
632
1073
    return -1;
633
1074
  }
634
1075
  
635
 
  ret = init_gnutls_session(&session);
 
1076
  /* If the interface is specified and we have a list of interfaces */
 
1077
  if(if_index != AVAHI_IF_UNSPEC and mc->interfaces != NULL){
 
1078
    /* Check if the interface is one of the interfaces we are using */
 
1079
    bool match = false;
 
1080
    {
 
1081
      char *interface = NULL;
 
1082
      while((interface = argz_next(mc->interfaces,
 
1083
                                   mc->interfaces_size,
 
1084
                                   interface))){
 
1085
        if(if_nametoindex(interface) == (unsigned int)if_index){
 
1086
          match = true;
 
1087
          break;
 
1088
        }
 
1089
      }
 
1090
    }
 
1091
    if(not match){
 
1092
      /* This interface does not match any in the list, so we don't
 
1093
         connect to the server */
 
1094
      if(debug){
 
1095
        char interface[IF_NAMESIZE];
 
1096
        if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
1097
          perror_plus("if_indextoname");
 
1098
        } else {
 
1099
          fprintf_plus(stderr, "Skipping server on non-used interface"
 
1100
                       " \"%s\"\n",
 
1101
                       if_indextoname((unsigned int)if_index,
 
1102
                                      interface));
 
1103
        }
 
1104
      }
 
1105
      return -1;
 
1106
    }
 
1107
  }
 
1108
  
 
1109
  ret = init_gnutls_session(&session, mc);
636
1110
  if(ret != 0){
637
1111
    return -1;
638
1112
  }
639
1113
  
640
1114
  if(debug){
641
 
    fprintf(stderr, "Setting up a TCP connection to %s, port %" PRIu16
642
 
            "\n", ip, port);
 
1115
    fprintf_plus(stderr, "Setting up a TCP connection to %s, port %"
 
1116
                 PRIuMAX "\n", ip, (uintmax_t)port);
643
1117
  }
644
1118
  
645
 
  tcp_sd = socket(pf, SOCK_STREAM, 0);
 
1119
  tcp_sd = socket(pf, SOCK_STREAM | SOCK_CLOEXEC, 0);
646
1120
  if(tcp_sd < 0){
647
1121
    int e = errno;
648
1122
    perror_plus("socket");
655
1129
    goto mandos_end;
656
1130
  }
657
1131
  
658
 
  memset(&to, 0, sizeof(to));
659
1132
  if(af == AF_INET6){
660
 
    to.in6.sin6_family = (sa_family_t)af;
661
 
    ret = inet_pton(af, ip, &to.in6.sin6_addr);
 
1133
    struct sockaddr_in6 *to6 = (struct sockaddr_in6 *)&to;
 
1134
    *to6 = (struct sockaddr_in6){ .sin6_family = (sa_family_t)af };
 
1135
    ret = inet_pton(af, ip, &to6->sin6_addr);
662
1136
  } else {                      /* IPv4 */
663
 
    to.in.sin_family = (sa_family_t)af;
664
 
    ret = inet_pton(af, ip, &to.in.sin_addr);
 
1137
    struct sockaddr_in *to4 = (struct sockaddr_in *)&to;
 
1138
    *to4 = (struct sockaddr_in){ .sin_family = (sa_family_t)af };
 
1139
    ret = inet_pton(af, ip, &to4->sin_addr);
665
1140
  }
666
1141
  if(ret < 0 ){
667
1142
    int e = errno;
671
1146
  }
672
1147
  if(ret == 0){
673
1148
    int e = errno;
674
 
    fprintf(stderr, "Bad address: %s\n", ip);
 
1149
    fprintf_plus(stderr, "Bad address: %s\n", ip);
675
1150
    errno = e;
676
1151
    goto mandos_end;
677
1152
  }
678
1153
  if(af == AF_INET6){
679
 
    to.in6.sin6_port = htons(port); /* Spurious warnings from
680
 
                                       -Wconversion and
681
 
                                       -Wunreachable-code */
682
 
    
683
 
    if(IN6_IS_ADDR_LINKLOCAL /* Spurious warnings from */
684
 
       (&to.in6.sin6_addr)){ /* -Wstrict-aliasing=2 or lower and
685
 
                              -Wunreachable-code*/
 
1154
    ((struct sockaddr_in6 *)&to)->sin6_port = htons(port);
 
1155
    if(IN6_IS_ADDR_LINKLOCAL
 
1156
       (&((struct sockaddr_in6 *)&to)->sin6_addr)){
686
1157
      if(if_index == AVAHI_IF_UNSPEC){
687
 
        fprintf(stderr, "An IPv6 link-local address is incomplete"
688
 
                " without a network interface\n");
 
1158
        fprintf_plus(stderr, "An IPv6 link-local address is"
 
1159
                     " incomplete without a network interface\n");
689
1160
        errno = EINVAL;
690
1161
        goto mandos_end;
691
1162
      }
692
1163
      /* Set the network interface number as scope */
693
 
      to.in6.sin6_scope_id = (uint32_t)if_index;
 
1164
      ((struct sockaddr_in6 *)&to)->sin6_scope_id = (uint32_t)if_index;
694
1165
    }
695
1166
  } else {
696
 
    to.in.sin_port = htons(port); /* Spurious warnings from
697
 
                                     -Wconversion and
698
 
                                     -Wunreachable-code */
 
1167
    ((struct sockaddr_in *)&to)->sin_port = htons(port);
699
1168
  }
700
1169
  
701
1170
  if(quit_now){
709
1178
      if(if_indextoname((unsigned int)if_index, interface) == NULL){
710
1179
        perror_plus("if_indextoname");
711
1180
      } else {
712
 
        fprintf(stderr, "Connection to: %s%%%s, port %" PRIu16 "\n",
713
 
                ip, interface, port);
 
1181
        fprintf_plus(stderr, "Connection to: %s%%%s, port %" PRIuMAX
 
1182
                     "\n", ip, interface, (uintmax_t)port);
714
1183
      }
715
1184
    } else {
716
 
      fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
717
 
              port);
 
1185
      fprintf_plus(stderr, "Connection to: %s, port %" PRIuMAX "\n",
 
1186
                   ip, (uintmax_t)port);
718
1187
    }
719
1188
    char addrstr[(INET_ADDRSTRLEN > INET6_ADDRSTRLEN) ?
720
1189
                 INET_ADDRSTRLEN : INET6_ADDRSTRLEN] = "";
721
 
    const char *pcret;
722
 
    if(af == AF_INET6){
723
 
      pcret = inet_ntop(af, &(to.in6.sin6_addr), addrstr,
724
 
                        sizeof(addrstr));
725
 
    } else {
726
 
      pcret = inet_ntop(af, &(to.in.sin_addr), addrstr,
727
 
                        sizeof(addrstr));
728
 
    }
729
 
    if(pcret == NULL){
730
 
      perror_plus("inet_ntop");
731
 
    } else {
732
 
      if(strcmp(addrstr, ip) != 0){
733
 
        fprintf(stderr, "Canonical address form: %s\n", addrstr);
734
 
      }
735
 
    }
736
 
  }
737
 
  
738
 
  if(quit_now){
739
 
    errno = EINTR;
740
 
    goto mandos_end;
741
 
  }
742
 
  
743
 
  if(af == AF_INET6){
744
 
    ret = connect(tcp_sd, &to.in6, sizeof(to));
745
 
  } else {
746
 
    ret = connect(tcp_sd, &to.in, sizeof(to)); /* IPv4 */
747
 
  }
748
 
  if(ret < 0){
749
 
    if ((errno != ECONNREFUSED and errno != ENETUNREACH) or debug){
750
 
      int e = errno;
751
 
      perror_plus("connect");
752
 
      errno = e;
753
 
    }
754
 
    goto mandos_end;
755
 
  }
756
 
  
757
 
  if(quit_now){
758
 
    errno = EINTR;
759
 
    goto mandos_end;
 
1190
    if(af == AF_INET6){
 
1191
      ret = getnameinfo((struct sockaddr *)&to,
 
1192
                        sizeof(struct sockaddr_in6),
 
1193
                        addrstr, sizeof(addrstr), NULL, 0,
 
1194
                        NI_NUMERICHOST);
 
1195
    } else {
 
1196
      ret = getnameinfo((struct sockaddr *)&to,
 
1197
                        sizeof(struct sockaddr_in),
 
1198
                        addrstr, sizeof(addrstr), NULL, 0,
 
1199
                        NI_NUMERICHOST);
 
1200
    }
 
1201
    if(ret == EAI_SYSTEM){
 
1202
      perror_plus("getnameinfo");
 
1203
    } else if(ret != 0) {
 
1204
      fprintf_plus(stderr, "getnameinfo: %s", gai_strerror(ret));
 
1205
    } else if(strcmp(addrstr, ip) != 0){
 
1206
      fprintf_plus(stderr, "Canonical address form: %s\n", addrstr);
 
1207
    }
 
1208
  }
 
1209
  
 
1210
  if(quit_now){
 
1211
    errno = EINTR;
 
1212
    goto mandos_end;
 
1213
  }
 
1214
  
 
1215
  while(true){
 
1216
    if(af == AF_INET6){
 
1217
      ret = connect(tcp_sd, (struct sockaddr *)&to,
 
1218
                    sizeof(struct sockaddr_in6));
 
1219
    } else {
 
1220
      ret = connect(tcp_sd, (struct sockaddr *)&to, /* IPv4 */
 
1221
                    sizeof(struct sockaddr_in));
 
1222
    }
 
1223
    if(ret < 0){
 
1224
      if(((errno == ENETUNREACH) or (errno == EHOSTUNREACH))
 
1225
         and if_index != AVAHI_IF_UNSPEC
 
1226
         and connect_to == NULL
 
1227
         and not route_added and
 
1228
         ((af == AF_INET6 and not
 
1229
           IN6_IS_ADDR_LINKLOCAL(&(((struct sockaddr_in6 *)
 
1230
                                    &to)->sin6_addr)))
 
1231
          or (af == AF_INET and
 
1232
              /* Not a a IPv4LL address */
 
1233
              (ntohl(((struct sockaddr_in *)&to)->sin_addr.s_addr)
 
1234
               & 0xFFFF0000L) != 0xA9FE0000L))){
 
1235
        /* Work around Avahi bug - Avahi does not announce link-local
 
1236
           addresses if it has a global address, so local hosts with
 
1237
           *only* a link-local address (e.g. Mandos clients) cannot
 
1238
           connect to a Mandos server announced by Avahi on a server
 
1239
           host with a global address.  Work around this by retrying
 
1240
           with an explicit route added with the server's address.
 
1241
           
 
1242
           Avahi bug reference:
 
1243
           https://lists.freedesktop.org/archives/avahi/2010-February/001833.html
 
1244
           https://bugs.debian.org/587961
 
1245
        */
 
1246
        if(debug){
 
1247
          fprintf_plus(stderr, "Mandos server unreachable, trying"
 
1248
                       " direct route\n");
 
1249
        }
 
1250
        int e = errno;
 
1251
        route_added = add_local_route(ip, if_index);
 
1252
        if(route_added){
 
1253
          continue;
 
1254
        }
 
1255
        errno = e;
 
1256
      }
 
1257
      if(errno != ECONNREFUSED or debug){
 
1258
        int e = errno;
 
1259
        perror_plus("connect");
 
1260
        errno = e;
 
1261
      }
 
1262
      goto mandos_end;
 
1263
    }
 
1264
    
 
1265
    if(quit_now){
 
1266
      errno = EINTR;
 
1267
      goto mandos_end;
 
1268
    }
 
1269
    break;
760
1270
  }
761
1271
  
762
1272
  const char *out = mandos_protocol_version;
764
1274
  while(true){
765
1275
    size_t out_size = strlen(out);
766
1276
    ret = (int)TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
767
 
                                   out_size - written));
 
1277
                                        out_size - written));
768
1278
    if(ret == -1){
769
1279
      int e = errno;
770
1280
      perror_plus("write");
790
1300
  }
791
1301
  
792
1302
  if(debug){
793
 
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
 
1303
    fprintf_plus(stderr, "Establishing TLS session with %s\n", ip);
794
1304
  }
795
1305
  
796
1306
  if(quit_now){
798
1308
    goto mandos_end;
799
1309
  }
800
1310
  
801
 
  /* Spurious warning from -Wint-to-pointer-cast */
802
 
  gnutls_transport_set_ptr(session, (gnutls_transport_ptr_t) tcp_sd);
 
1311
  /* This casting via intptr_t is to eliminate warning about casting
 
1312
     an int to a pointer type.  This is exactly how the GnuTLS Guile
 
1313
     function "set-session-transport-fd!" does it. */
 
1314
  gnutls_transport_set_ptr(session,
 
1315
                           (gnutls_transport_ptr_t)(intptr_t)tcp_sd);
803
1316
  
804
1317
  if(quit_now){
805
1318
    errno = EINTR;
816
1329
  
817
1330
  if(ret != GNUTLS_E_SUCCESS){
818
1331
    if(debug){
819
 
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
 
1332
      fprintf_plus(stderr, "*** GnuTLS Handshake failed ***\n");
820
1333
      gnutls_perror(ret);
821
1334
    }
822
1335
    errno = EPROTO;
826
1339
  /* Read OpenPGP packet that contains the wanted password */
827
1340
  
828
1341
  if(debug){
829
 
    fprintf(stderr, "Retrieving OpenPGP encrypted password from %s\n",
830
 
            ip);
 
1342
    fprintf_plus(stderr, "Retrieving OpenPGP encrypted password from"
 
1343
                 " %s\n", ip);
831
1344
  }
832
1345
  
833
1346
  while(true){
838
1351
    }
839
1352
    
840
1353
    buffer_capacity = incbuffer(&buffer, buffer_length,
841
 
                                   buffer_capacity);
 
1354
                                buffer_capacity);
842
1355
    if(buffer_capacity == 0){
843
1356
      int e = errno;
844
1357
      perror_plus("incbuffer");
871
1384
          }
872
1385
        } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
873
1386
        if(ret < 0){
874
 
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
 
1387
          fprintf_plus(stderr, "*** GnuTLS Re-handshake failed "
 
1388
                       "***\n");
875
1389
          gnutls_perror(ret);
876
1390
          errno = EPROTO;
877
1391
          goto mandos_end;
878
1392
        }
879
1393
        break;
880
1394
      default:
881
 
        fprintf(stderr, "Unknown error while reading data from"
882
 
                " encrypted session with Mandos server\n");
 
1395
        fprintf_plus(stderr, "Unknown error while reading data from"
 
1396
                     " encrypted session with Mandos server\n");
883
1397
        gnutls_bye(session, GNUTLS_SHUT_RDWR);
884
1398
        errno = EIO;
885
1399
        goto mandos_end;
890
1404
  }
891
1405
  
892
1406
  if(debug){
893
 
    fprintf(stderr, "Closing TLS session\n");
 
1407
    fprintf_plus(stderr, "Closing TLS session\n");
894
1408
  }
895
1409
  
896
1410
  if(quit_now){
908
1422
  
909
1423
  if(buffer_length > 0){
910
1424
    ssize_t decrypted_buffer_size;
911
 
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
912
 
                                               buffer_length,
913
 
                                               &decrypted_buffer);
 
1425
    decrypted_buffer_size = pgp_packet_decrypt(buffer, buffer_length,
 
1426
                                               &decrypted_buffer, mc);
914
1427
    if(decrypted_buffer_size >= 0){
915
1428
      
 
1429
      clearerr(stdout);
916
1430
      written = 0;
917
1431
      while(written < (size_t) decrypted_buffer_size){
918
1432
        if(quit_now){
926
1440
        if(ret == 0 and ferror(stdout)){
927
1441
          int e = errno;
928
1442
          if(debug){
929
 
            fprintf(stderr, "Error writing encrypted data: %s\n",
930
 
                    strerror(errno));
 
1443
            fprintf_plus(stderr, "Error writing encrypted data: %s\n",
 
1444
                         strerror(errno));
931
1445
          }
932
1446
          errno = e;
933
1447
          goto mandos_end;
934
1448
        }
935
1449
        written += (size_t)ret;
936
1450
      }
 
1451
      ret = fflush(stdout);
 
1452
      if(ret != 0){
 
1453
        int e = errno;
 
1454
        if(debug){
 
1455
          fprintf_plus(stderr, "Error writing encrypted data: %s\n",
 
1456
                       strerror(errno));
 
1457
        }
 
1458
        errno = e;
 
1459
        goto mandos_end;
 
1460
      }
937
1461
      retval = 0;
938
1462
    }
939
1463
  }
942
1466
  
943
1467
 mandos_end:
944
1468
  {
 
1469
    if(route_added){
 
1470
      if(not delete_local_route(ip, if_index)){
 
1471
        fprintf_plus(stderr, "Failed to delete local route to %s on"
 
1472
                     " interface %d", ip, if_index);
 
1473
      }
 
1474
    }
945
1475
    int e = errno;
946
1476
    free(decrypted_buffer);
947
1477
    free(buffer);
948
1478
    if(tcp_sd >= 0){
949
 
      ret = (int)TEMP_FAILURE_RETRY(close(tcp_sd));
 
1479
      ret = close(tcp_sd);
950
1480
    }
951
1481
    if(ret == -1){
952
1482
      if(e == 0){
964
1494
  return retval;
965
1495
}
966
1496
 
 
1497
__attribute__((nonnull))
967
1498
static void resolve_callback(AvahiSServiceResolver *r,
968
1499
                             AvahiIfIndex interface,
969
1500
                             AvahiProtocol proto,
977
1508
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
978
1509
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
979
1510
                             flags,
980
 
                             AVAHI_GCC_UNUSED void* userdata){
981
 
  assert(r);
 
1511
                             void *mc){
 
1512
  if(r == NULL){
 
1513
    return;
 
1514
  }
982
1515
  
983
1516
  /* Called whenever a service has been resolved successfully or
984
1517
     timed out */
985
1518
  
986
1519
  if(quit_now){
 
1520
    avahi_s_service_resolver_free(r);
987
1521
    return;
988
1522
  }
989
1523
  
990
1524
  switch(event){
991
1525
  default:
992
1526
  case AVAHI_RESOLVER_FAILURE:
993
 
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
994
 
            " of type '%s' in domain '%s': %s\n", name, type, domain,
995
 
            avahi_strerror(avahi_server_errno(mc.server)));
 
1527
    fprintf_plus(stderr, "(Avahi Resolver) Failed to resolve service "
 
1528
                 "'%s' of type '%s' in domain '%s': %s\n", name, type,
 
1529
                 domain,
 
1530
                 avahi_strerror(avahi_server_errno
 
1531
                                (((mandos_context*)mc)->server)));
996
1532
    break;
997
1533
    
998
1534
  case AVAHI_RESOLVER_FOUND:
1000
1536
      char ip[AVAHI_ADDRESS_STR_MAX];
1001
1537
      avahi_address_snprint(ip, sizeof(ip), address);
1002
1538
      if(debug){
1003
 
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %"
1004
 
                PRIdMAX ") on port %" PRIu16 "\n", name, host_name,
1005
 
                ip, (intmax_t)interface, port);
 
1539
        fprintf_plus(stderr, "Mandos server \"%s\" found on %s (%s, %"
 
1540
                     PRIdMAX ") on port %" PRIu16 "\n", name,
 
1541
                     host_name, ip, (intmax_t)interface, port);
1006
1542
      }
1007
 
      int ret = start_mandos_communication(ip, port, interface,
1008
 
                                           avahi_proto_to_af(proto));
 
1543
      int ret = start_mandos_communication(ip, (in_port_t)port,
 
1544
                                           interface,
 
1545
                                           avahi_proto_to_af(proto),
 
1546
                                           mc);
1009
1547
      if(ret == 0){
1010
 
        avahi_simple_poll_quit(mc.simple_poll);
 
1548
        avahi_simple_poll_quit(simple_poll);
1011
1549
      } else {
1012
 
        ret = add_server(ip, port, interface,
1013
 
                         avahi_proto_to_af(proto));
 
1550
        if(not add_server(ip, (in_port_t)port, interface,
 
1551
                          avahi_proto_to_af(proto),
 
1552
                          &((mandos_context*)mc)->current_server)){
 
1553
          fprintf_plus(stderr, "Failed to add server \"%s\" to server"
 
1554
                       " list\n", name);
 
1555
        }
1014
1556
      }
1015
1557
    }
1016
1558
  }
1026
1568
                            const char *domain,
1027
1569
                            AVAHI_GCC_UNUSED AvahiLookupResultFlags
1028
1570
                            flags,
1029
 
                            AVAHI_GCC_UNUSED void* userdata){
1030
 
  assert(b);
 
1571
                            void *mc){
 
1572
  if(b == NULL){
 
1573
    return;
 
1574
  }
1031
1575
  
1032
1576
  /* Called whenever a new services becomes available on the LAN or
1033
1577
     is removed from the LAN */
1040
1584
  default:
1041
1585
  case AVAHI_BROWSER_FAILURE:
1042
1586
    
1043
 
    fprintf(stderr, "(Avahi browser) %s\n",
1044
 
            avahi_strerror(avahi_server_errno(mc.server)));
1045
 
    avahi_simple_poll_quit(mc.simple_poll);
 
1587
    fprintf_plus(stderr, "(Avahi browser) %s\n",
 
1588
                 avahi_strerror(avahi_server_errno
 
1589
                                (((mandos_context*)mc)->server)));
 
1590
    avahi_simple_poll_quit(simple_poll);
1046
1591
    return;
1047
1592
    
1048
1593
  case AVAHI_BROWSER_NEW:
1051
1596
       the callback function is called the Avahi server will free the
1052
1597
       resolver for us. */
1053
1598
    
1054
 
    if(avahi_s_service_resolver_new(mc.server, interface, protocol,
1055
 
                                    name, type, domain, protocol, 0,
1056
 
                                    resolve_callback, NULL) == NULL)
1057
 
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
1058
 
              name, avahi_strerror(avahi_server_errno(mc.server)));
 
1599
    if(avahi_s_service_resolver_new(((mandos_context*)mc)->server,
 
1600
                                    interface, protocol, name, type,
 
1601
                                    domain, protocol, 0,
 
1602
                                    resolve_callback, mc) == NULL)
 
1603
      fprintf_plus(stderr, "Avahi: Failed to resolve service '%s':"
 
1604
                   " %s\n", name,
 
1605
                   avahi_strerror(avahi_server_errno
 
1606
                                  (((mandos_context*)mc)->server)));
1059
1607
    break;
1060
1608
    
1061
1609
  case AVAHI_BROWSER_REMOVE:
1064
1612
  case AVAHI_BROWSER_ALL_FOR_NOW:
1065
1613
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
1066
1614
    if(debug){
1067
 
      fprintf(stderr, "No Mandos server found, still searching...\n");
 
1615
      fprintf_plus(stderr, "No Mandos server found, still"
 
1616
                   " searching...\n");
1068
1617
    }
1069
1618
    break;
1070
1619
  }
1079
1628
  signal_received = sig;
1080
1629
  int old_errno = errno;
1081
1630
  /* set main loop to exit */
1082
 
  if(mc.simple_poll != NULL){
1083
 
    avahi_simple_poll_quit(mc.simple_poll);
 
1631
  if(simple_poll != NULL){
 
1632
    avahi_simple_poll_quit(simple_poll);
1084
1633
  }
1085
1634
  errno = old_errno;
1086
1635
}
1087
1636
 
 
1637
__attribute__((nonnull, warn_unused_result))
 
1638
bool get_flags(const char *ifname, struct ifreq *ifr){
 
1639
  int ret;
 
1640
  int old_errno;
 
1641
  
 
1642
  int s = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
1643
  if(s < 0){
 
1644
    old_errno = errno;
 
1645
    perror_plus("socket");
 
1646
    errno = old_errno;
 
1647
    return false;
 
1648
  }
 
1649
  strncpy(ifr->ifr_name, ifname, IF_NAMESIZE);
 
1650
  ifr->ifr_name[IF_NAMESIZE-1] = '\0'; /* NUL terminate */
 
1651
  ret = ioctl(s, SIOCGIFFLAGS, ifr);
 
1652
  if(ret == -1){
 
1653
    if(debug){
 
1654
      old_errno = errno;
 
1655
      perror_plus("ioctl SIOCGIFFLAGS");
 
1656
      errno = old_errno;
 
1657
    }
 
1658
    return false;
 
1659
  }
 
1660
  return true;
 
1661
}
 
1662
 
 
1663
__attribute__((nonnull, warn_unused_result))
 
1664
bool good_flags(const char *ifname, const struct ifreq *ifr){
 
1665
  
 
1666
  /* Reject the loopback device */
 
1667
  if(ifr->ifr_flags & IFF_LOOPBACK){
 
1668
    if(debug){
 
1669
      fprintf_plus(stderr, "Rejecting loopback interface \"%s\"\n",
 
1670
                   ifname);
 
1671
    }
 
1672
    return false;
 
1673
  }
 
1674
  /* Accept point-to-point devices only if connect_to is specified */
 
1675
  if(connect_to != NULL and (ifr->ifr_flags & IFF_POINTOPOINT)){
 
1676
    if(debug){
 
1677
      fprintf_plus(stderr, "Accepting point-to-point interface"
 
1678
                   " \"%s\"\n", ifname);
 
1679
    }
 
1680
    return true;
 
1681
  }
 
1682
  /* Otherwise, reject non-broadcast-capable devices */
 
1683
  if(not (ifr->ifr_flags & IFF_BROADCAST)){
 
1684
    if(debug){
 
1685
      fprintf_plus(stderr, "Rejecting non-broadcast interface"
 
1686
                   " \"%s\"\n", ifname);
 
1687
    }
 
1688
    return false;
 
1689
  }
 
1690
  /* Reject non-ARP interfaces (including dummy interfaces) */
 
1691
  if(ifr->ifr_flags & IFF_NOARP){
 
1692
    if(debug){
 
1693
      fprintf_plus(stderr, "Rejecting non-ARP interface \"%s\"\n",
 
1694
                   ifname);
 
1695
    }
 
1696
    return false;
 
1697
  }
 
1698
  
 
1699
  /* Accept this device */
 
1700
  if(debug){
 
1701
    fprintf_plus(stderr, "Interface \"%s\" is good\n", ifname);
 
1702
  }
 
1703
  return true;
 
1704
}
 
1705
 
1088
1706
/* 
1089
1707
 * This function determines if a directory entry in /sys/class/net
1090
1708
 * corresponds to an acceptable network device.
1091
1709
 * (This function is passed to scandir(3) as a filter function.)
1092
1710
 */
 
1711
__attribute__((nonnull, warn_unused_result))
1093
1712
int good_interface(const struct dirent *if_entry){
1094
 
  ssize_t ssret;
1095
 
  char *flagname = NULL;
1096
1713
  if(if_entry->d_name[0] == '.'){
1097
1714
    return 0;
1098
1715
  }
1099
 
  int ret = asprintf(&flagname, "%s/%s/flags", sys_class_net,
1100
 
                     if_entry->d_name);
1101
 
  if(ret < 0){
1102
 
    perror_plus("asprintf");
1103
 
    return 0;
1104
 
  }
1105
 
  int flags_fd = (int)TEMP_FAILURE_RETRY(open(flagname, O_RDONLY));
1106
 
  if(flags_fd == -1){
1107
 
    perror_plus("open");
1108
 
    free(flagname);
1109
 
    return 0;
1110
 
  }
1111
 
  free(flagname);
1112
 
  typedef short ifreq_flags;    /* ifreq.ifr_flags in netdevice(7) */
1113
 
  /* read line from flags_fd */
1114
 
  ssize_t to_read = 2+(sizeof(ifreq_flags)*2)+1; /* "0x1003\n" */
1115
 
  char *flagstring = malloc((size_t)to_read+1); /* +1 for final \0 */
1116
 
  flagstring[(size_t)to_read] = '\0';
1117
 
  if(flagstring == NULL){
1118
 
    perror_plus("malloc");
1119
 
    close(flags_fd);
1120
 
    return 0;
1121
 
  }
1122
 
  while(to_read > 0){
1123
 
    ssret = (ssize_t)TEMP_FAILURE_RETRY(read(flags_fd, flagstring,
1124
 
                                             (size_t)to_read));
1125
 
    if(ssret == -1){
1126
 
      perror_plus("read");
1127
 
      free(flagstring);
1128
 
      close(flags_fd);
1129
 
      return 0;
1130
 
    }
1131
 
    to_read -= ssret;
1132
 
    if(ssret == 0){
1133
 
      break;
1134
 
    }
1135
 
  }
1136
 
  close(flags_fd);
1137
 
  intmax_t tmpmax;
1138
 
  char *tmp;
1139
 
  errno = 0;
1140
 
  tmpmax = strtoimax(flagstring, &tmp, 0);
1141
 
  if(errno != 0 or tmp == flagstring or (*tmp != '\0'
1142
 
                                         and not (isspace(*tmp)))
1143
 
     or tmpmax != (ifreq_flags)tmpmax){
1144
 
    if(debug){
1145
 
      fprintf(stderr, "Invalid flags \"%s\" for interface \"%s\"\n",
1146
 
              flagstring, if_entry->d_name);
1147
 
    }
1148
 
    free(flagstring);
1149
 
    return 0;
1150
 
  }
1151
 
  free(flagstring);
1152
 
  ifreq_flags flags = (ifreq_flags)tmpmax;
1153
 
  /* Reject the loopback device */
1154
 
  if(flags & IFF_LOOPBACK){
1155
 
    if(debug){
1156
 
      fprintf(stderr, "Rejecting loopback interface \"%s\"\n",
1157
 
              if_entry->d_name);
1158
 
    }
1159
 
    return 0;
1160
 
  }
1161
 
  /* Accept point-to-point devices only if connect_to is specified */
1162
 
  if(connect_to != NULL and (flags & IFF_POINTOPOINT)){
1163
 
    if(debug){
1164
 
      fprintf(stderr, "Accepting point-to-point interface \"%s\"\n",
1165
 
              if_entry->d_name);
1166
 
    }
1167
 
    return 1;
1168
 
  }
1169
 
  /* Otherwise, reject non-broadcast-capable devices */
1170
 
  if(not (flags & IFF_BROADCAST)){
1171
 
    if(debug){
1172
 
      fprintf(stderr, "Rejecting non-broadcast interface \"%s\"\n",
1173
 
              if_entry->d_name);
1174
 
    }
1175
 
    return 0;
1176
 
  }
1177
 
  /* Reject non-ARP interfaces (including dummy interfaces) */
1178
 
  if(flags & IFF_NOARP){
1179
 
    if(debug){
1180
 
      fprintf(stderr, "Rejecting non-ARP interface \"%s\"\n",
1181
 
              if_entry->d_name);
1182
 
    }
1183
 
    return 0;
1184
 
  }
1185
 
  /* Accept this device */
1186
 
  if(debug){
1187
 
    fprintf(stderr, "Interface \"%s\" is acceptable\n",
1188
 
            if_entry->d_name);
 
1716
  
 
1717
  struct ifreq ifr;
 
1718
  if(not get_flags(if_entry->d_name, &ifr)){
 
1719
    if(debug){
 
1720
      fprintf_plus(stderr, "Failed to get flags for interface "
 
1721
                   "\"%s\"\n", if_entry->d_name);
 
1722
    }
 
1723
    return 0;
 
1724
  }
 
1725
  
 
1726
  if(not good_flags(if_entry->d_name, &ifr)){
 
1727
    return 0;
1189
1728
  }
1190
1729
  return 1;
1191
1730
}
1192
1731
 
 
1732
/* 
 
1733
 * This function determines if a network interface is up.
 
1734
 */
 
1735
__attribute__((nonnull, warn_unused_result))
 
1736
bool interface_is_up(const char *interface){
 
1737
  struct ifreq ifr;
 
1738
  if(not get_flags(interface, &ifr)){
 
1739
    if(debug){
 
1740
      fprintf_plus(stderr, "Failed to get flags for interface "
 
1741
                   "\"%s\"\n", interface);
 
1742
    }
 
1743
    return false;
 
1744
  }
 
1745
  
 
1746
  return (bool)(ifr.ifr_flags & IFF_UP);
 
1747
}
 
1748
 
 
1749
/* 
 
1750
 * This function determines if a network interface is running
 
1751
 */
 
1752
__attribute__((nonnull, warn_unused_result))
 
1753
bool interface_is_running(const char *interface){
 
1754
  struct ifreq ifr;
 
1755
  if(not get_flags(interface, &ifr)){
 
1756
    if(debug){
 
1757
      fprintf_plus(stderr, "Failed to get flags for interface "
 
1758
                   "\"%s\"\n", interface);
 
1759
    }
 
1760
    return false;
 
1761
  }
 
1762
  
 
1763
  return (bool)(ifr.ifr_flags & IFF_RUNNING);
 
1764
}
 
1765
 
 
1766
__attribute__((nonnull, pure, warn_unused_result))
1193
1767
int notdotentries(const struct dirent *direntry){
1194
1768
  /* Skip "." and ".." */
1195
1769
  if(direntry->d_name[0] == '.'
1201
1775
  return 1;
1202
1776
}
1203
1777
 
1204
 
int avahi_loop_with_timeout(AvahiSimplePoll *s, int retry_interval){
 
1778
/* Is this directory entry a runnable program? */
 
1779
__attribute__((nonnull, warn_unused_result))
 
1780
int runnable_hook(const struct dirent *direntry){
 
1781
  int ret;
 
1782
  size_t sret;
 
1783
  struct stat st;
 
1784
  
 
1785
  if((direntry->d_name)[0] == '\0'){
 
1786
    /* Empty name? */
 
1787
    return 0;
 
1788
  }
 
1789
  
 
1790
  sret = strspn(direntry->d_name, "ABCDEFGHIJKLMNOPQRSTUVWXYZ"
 
1791
                "abcdefghijklmnopqrstuvwxyz"
 
1792
                "0123456789"
 
1793
                "_.-");
 
1794
  if((direntry->d_name)[sret] != '\0'){
 
1795
    /* Contains non-allowed characters */
 
1796
    if(debug){
 
1797
      fprintf_plus(stderr, "Ignoring hook \"%s\" with bad name\n",
 
1798
                   direntry->d_name);
 
1799
    }
 
1800
    return 0;
 
1801
  }
 
1802
  
 
1803
  ret = fstatat(hookdir_fd, direntry->d_name, &st, 0);
 
1804
  if(ret == -1){
 
1805
    if(debug){
 
1806
      perror_plus("Could not stat hook");
 
1807
    }
 
1808
    return 0;
 
1809
  }
 
1810
  if(not (S_ISREG(st.st_mode))){
 
1811
    /* Not a regular file */
 
1812
    if(debug){
 
1813
      fprintf_plus(stderr, "Ignoring hook \"%s\" - not a file\n",
 
1814
                   direntry->d_name);
 
1815
    }
 
1816
    return 0;
 
1817
  }
 
1818
  if(not (st.st_mode & (S_IXUSR | S_IXGRP | S_IXOTH))){
 
1819
    /* Not executable */
 
1820
    if(debug){
 
1821
      fprintf_plus(stderr, "Ignoring hook \"%s\" - not executable\n",
 
1822
                   direntry->d_name);
 
1823
    }
 
1824
    return 0;
 
1825
  }
 
1826
  if(debug){
 
1827
    fprintf_plus(stderr, "Hook \"%s\" is acceptable\n",
 
1828
                 direntry->d_name);
 
1829
  }
 
1830
  return 1;
 
1831
}
 
1832
 
 
1833
__attribute__((nonnull, warn_unused_result))
 
1834
int avahi_loop_with_timeout(AvahiSimplePoll *s, int retry_interval,
 
1835
                            mandos_context *mc){
1205
1836
  int ret;
1206
1837
  struct timespec now;
1207
1838
  struct timespec waited_time;
1208
1839
  intmax_t block_time;
1209
1840
  
1210
1841
  while(true){
1211
 
    if(mc.current_server == NULL){
1212
 
      if (debug){
1213
 
        fprintf(stderr,
1214
 
                "Wait until first server is found. No timeout!\n");
 
1842
    if(mc->current_server == NULL){
 
1843
      if(debug){
 
1844
        fprintf_plus(stderr, "Wait until first server is found."
 
1845
                     " No timeout!\n");
1215
1846
      }
1216
1847
      ret = avahi_simple_poll_iterate(s, -1);
1217
1848
    } else {
1218
 
      if (debug){
1219
 
        fprintf(stderr, "Check current_server if we should run it,"
1220
 
                " or wait\n");
 
1849
      if(debug){
 
1850
        fprintf_plus(stderr, "Check current_server if we should run"
 
1851
                     " it, or wait\n");
1221
1852
      }
1222
1853
      /* the current time */
1223
1854
      ret = clock_gettime(CLOCK_MONOTONIC, &now);
1228
1859
      /* Calculating in ms how long time between now and server
1229
1860
         who we visted longest time ago. Now - last seen.  */
1230
1861
      waited_time.tv_sec = (now.tv_sec
1231
 
                            - mc.current_server->last_seen.tv_sec);
 
1862
                            - mc->current_server->last_seen.tv_sec);
1232
1863
      waited_time.tv_nsec = (now.tv_nsec
1233
 
                             - mc.current_server->last_seen.tv_nsec);
 
1864
                             - mc->current_server->last_seen.tv_nsec);
1234
1865
      /* total time is 10s/10,000ms.
1235
1866
         Converting to s from ms by dividing by 1,000,
1236
1867
         and ns to ms by dividing by 1,000,000. */
1238
1869
                     - ((intmax_t)waited_time.tv_sec * 1000))
1239
1870
                    - ((intmax_t)waited_time.tv_nsec / 1000000));
1240
1871
      
1241
 
      if (debug){
1242
 
        fprintf(stderr, "Blocking for %" PRIdMAX " ms\n", block_time);
 
1872
      if(debug){
 
1873
        fprintf_plus(stderr, "Blocking for %" PRIdMAX " ms\n",
 
1874
                     block_time);
1243
1875
      }
1244
1876
      
1245
1877
      if(block_time <= 0){
1246
 
        ret = start_mandos_communication(mc.current_server->ip,
1247
 
                                         mc.current_server->port,
1248
 
                                         mc.current_server->if_index,
1249
 
                                         mc.current_server->af);
 
1878
        ret = start_mandos_communication(mc->current_server->ip,
 
1879
                                         mc->current_server->port,
 
1880
                                         mc->current_server->if_index,
 
1881
                                         mc->current_server->af, mc);
1250
1882
        if(ret == 0){
1251
 
          avahi_simple_poll_quit(mc.simple_poll);
 
1883
          avahi_simple_poll_quit(s);
1252
1884
          return 0;
1253
1885
        }
1254
1886
        ret = clock_gettime(CLOCK_MONOTONIC,
1255
 
                            &mc.current_server->last_seen);
 
1887
                            &mc->current_server->last_seen);
1256
1888
        if(ret == -1){
1257
1889
          perror_plus("clock_gettime");
1258
1890
          return -1;
1259
1891
        }
1260
 
        mc.current_server = mc.current_server->next;
 
1892
        mc->current_server = mc->current_server->next;
1261
1893
        block_time = 0;         /* Call avahi to find new Mandos
1262
1894
                                   servers, but don't block */
1263
1895
      }
1265
1897
      ret = avahi_simple_poll_iterate(s, (int)block_time);
1266
1898
    }
1267
1899
    if(ret != 0){
1268
 
      if (ret > 0 or errno != EINTR) {
 
1900
      if(ret > 0 or errno != EINTR){
1269
1901
        return (ret != 1) ? ret : 0;
1270
1902
      }
1271
1903
    }
1272
1904
  }
1273
1905
}
1274
1906
 
 
1907
__attribute__((nonnull))
 
1908
void run_network_hooks(const char *mode, const char *interface,
 
1909
                       const float delay){
 
1910
  struct dirent **direntries = NULL;
 
1911
  if(hookdir_fd == -1){
 
1912
    hookdir_fd = open(hookdir, O_RDONLY | O_DIRECTORY | O_PATH
 
1913
                      | O_CLOEXEC);
 
1914
    if(hookdir_fd == -1){
 
1915
      if(errno == ENOENT){
 
1916
        if(debug){
 
1917
          fprintf_plus(stderr, "Network hook directory \"%s\" not"
 
1918
                       " found\n", hookdir);
 
1919
        }
 
1920
      } else {
 
1921
        perror_plus("open");
 
1922
      }
 
1923
      return;
 
1924
    }
 
1925
  }
 
1926
  int numhooks = scandirat(hookdir_fd, ".", &direntries,
 
1927
                           runnable_hook, alphasort);
 
1928
  if(numhooks == -1){
 
1929
    perror_plus("scandir");
 
1930
    return;
 
1931
  }
 
1932
  struct dirent *direntry;
 
1933
  int ret;
 
1934
  int devnull = (int)TEMP_FAILURE_RETRY(open("/dev/null", O_RDONLY));
 
1935
  if(devnull == -1){
 
1936
    perror_plus("open(\"/dev/null\", O_RDONLY)");
 
1937
    return;
 
1938
  }
 
1939
  for(int i = 0; i < numhooks; i++){
 
1940
    direntry = direntries[i];
 
1941
    if(debug){
 
1942
      fprintf_plus(stderr, "Running network hook \"%s\"\n",
 
1943
                   direntry->d_name);
 
1944
    }
 
1945
    pid_t hook_pid = fork();
 
1946
    if(hook_pid == 0){
 
1947
      /* Child */
 
1948
      /* Raise privileges */
 
1949
      errno = raise_privileges_permanently();
 
1950
      if(errno != 0){
 
1951
        perror_plus("Failed to raise privileges");
 
1952
        _exit(EX_NOPERM);
 
1953
      }
 
1954
      /* Set group */
 
1955
      errno = 0;
 
1956
      ret = setgid(0);
 
1957
      if(ret == -1){
 
1958
        perror_plus("setgid");
 
1959
        _exit(EX_NOPERM);
 
1960
      }
 
1961
      /* Reset supplementary groups */
 
1962
      errno = 0;
 
1963
      ret = setgroups(0, NULL);
 
1964
      if(ret == -1){
 
1965
        perror_plus("setgroups");
 
1966
        _exit(EX_NOPERM);
 
1967
      }
 
1968
      ret = setenv("MANDOSNETHOOKDIR", hookdir, 1);
 
1969
      if(ret == -1){
 
1970
        perror_plus("setenv");
 
1971
        _exit(EX_OSERR);
 
1972
      }
 
1973
      ret = setenv("DEVICE", interface, 1);
 
1974
      if(ret == -1){
 
1975
        perror_plus("setenv");
 
1976
        _exit(EX_OSERR);
 
1977
      }
 
1978
      ret = setenv("VERBOSITY", debug ? "1" : "0", 1);
 
1979
      if(ret == -1){
 
1980
        perror_plus("setenv");
 
1981
        _exit(EX_OSERR);
 
1982
      }
 
1983
      ret = setenv("MODE", mode, 1);
 
1984
      if(ret == -1){
 
1985
        perror_plus("setenv");
 
1986
        _exit(EX_OSERR);
 
1987
      }
 
1988
      char *delaystring;
 
1989
      ret = asprintf(&delaystring, "%f", (double)delay);
 
1990
      if(ret == -1){
 
1991
        perror_plus("asprintf");
 
1992
        _exit(EX_OSERR);
 
1993
      }
 
1994
      ret = setenv("DELAY", delaystring, 1);
 
1995
      if(ret == -1){
 
1996
        free(delaystring);
 
1997
        perror_plus("setenv");
 
1998
        _exit(EX_OSERR);
 
1999
      }
 
2000
      free(delaystring);
 
2001
      if(connect_to != NULL){
 
2002
        ret = setenv("CONNECT", connect_to, 1);
 
2003
        if(ret == -1){
 
2004
          perror_plus("setenv");
 
2005
          _exit(EX_OSERR);
 
2006
        }
 
2007
      }
 
2008
      int hook_fd = (int)TEMP_FAILURE_RETRY(openat(hookdir_fd,
 
2009
                                                   direntry->d_name,
 
2010
                                                   O_RDONLY));
 
2011
      if(hook_fd == -1){
 
2012
        perror_plus("openat");
 
2013
        _exit(EXIT_FAILURE);
 
2014
      }
 
2015
      if(close(hookdir_fd) == -1){
 
2016
        perror_plus("close");
 
2017
        _exit(EXIT_FAILURE);
 
2018
      }
 
2019
      ret = dup2(devnull, STDIN_FILENO);
 
2020
      if(ret == -1){
 
2021
        perror_plus("dup2(devnull, STDIN_FILENO)");
 
2022
        _exit(EX_OSERR);
 
2023
      }
 
2024
      ret = close(devnull);
 
2025
      if(ret == -1){
 
2026
        perror_plus("close");
 
2027
        _exit(EX_OSERR);
 
2028
      }
 
2029
      ret = dup2(STDERR_FILENO, STDOUT_FILENO);
 
2030
      if(ret == -1){
 
2031
        perror_plus("dup2(STDERR_FILENO, STDOUT_FILENO)");
 
2032
        _exit(EX_OSERR);
 
2033
      }
 
2034
      if(fexecve(hook_fd, (char *const []){ direntry->d_name, NULL },
 
2035
                 environ) == -1){
 
2036
        perror_plus("fexecve");
 
2037
        _exit(EXIT_FAILURE);
 
2038
      }
 
2039
    } else {
 
2040
      if(hook_pid == -1){
 
2041
        perror_plus("fork");
 
2042
        free(direntry);
 
2043
        continue;
 
2044
      }
 
2045
      int status;
 
2046
      if(TEMP_FAILURE_RETRY(waitpid(hook_pid, &status, 0)) == -1){
 
2047
        perror_plus("waitpid");
 
2048
        free(direntry);
 
2049
        continue;
 
2050
      }
 
2051
      if(WIFEXITED(status)){
 
2052
        if(WEXITSTATUS(status) != 0){
 
2053
          fprintf_plus(stderr, "Warning: network hook \"%s\" exited"
 
2054
                       " with status %d\n", direntry->d_name,
 
2055
                       WEXITSTATUS(status));
 
2056
          free(direntry);
 
2057
          continue;
 
2058
        }
 
2059
      } else if(WIFSIGNALED(status)){
 
2060
        fprintf_plus(stderr, "Warning: network hook \"%s\" died by"
 
2061
                     " signal %d\n", direntry->d_name,
 
2062
                     WTERMSIG(status));
 
2063
        free(direntry);
 
2064
        continue;
 
2065
      } else {
 
2066
        fprintf_plus(stderr, "Warning: network hook \"%s\""
 
2067
                     " crashed\n", direntry->d_name);
 
2068
        free(direntry);
 
2069
        continue;
 
2070
      }
 
2071
    }
 
2072
    if(debug){
 
2073
      fprintf_plus(stderr, "Network hook \"%s\" ran successfully\n",
 
2074
                   direntry->d_name);
 
2075
    }
 
2076
    free(direntry);
 
2077
  }
 
2078
  free(direntries);
 
2079
  if(close(hookdir_fd) == -1){
 
2080
    perror_plus("close");
 
2081
  } else {
 
2082
    hookdir_fd = -1;
 
2083
  }
 
2084
  close(devnull);
 
2085
}
 
2086
 
 
2087
__attribute__((nonnull, warn_unused_result))
 
2088
int bring_up_interface(const char *const interface,
 
2089
                       const float delay){
 
2090
  int old_errno = errno;
 
2091
  int ret;
 
2092
  struct ifreq network;
 
2093
  unsigned int if_index = if_nametoindex(interface);
 
2094
  if(if_index == 0){
 
2095
    fprintf_plus(stderr, "No such interface: \"%s\"\n", interface);
 
2096
    errno = old_errno;
 
2097
    return ENXIO;
 
2098
  }
 
2099
  
 
2100
  if(quit_now){
 
2101
    errno = old_errno;
 
2102
    return EINTR;
 
2103
  }
 
2104
  
 
2105
  if(not interface_is_up(interface)){
 
2106
    int ret_errno = 0;
 
2107
    int ioctl_errno = 0;
 
2108
    if(not get_flags(interface, &network)){
 
2109
      ret_errno = errno;
 
2110
      fprintf_plus(stderr, "Failed to get flags for interface "
 
2111
                   "\"%s\"\n", interface);
 
2112
      errno = old_errno;
 
2113
      return ret_errno;
 
2114
    }
 
2115
    network.ifr_flags |= IFF_UP; /* set flag */
 
2116
    
 
2117
    int sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
2118
    if(sd == -1){
 
2119
      ret_errno = errno;
 
2120
      perror_plus("socket");
 
2121
      errno = old_errno;
 
2122
      return ret_errno;
 
2123
    }
 
2124
    
 
2125
    if(quit_now){
 
2126
      ret = close(sd);
 
2127
      if(ret == -1){
 
2128
        perror_plus("close");
 
2129
      }
 
2130
      errno = old_errno;
 
2131
      return EINTR;
 
2132
    }
 
2133
    
 
2134
    if(debug){
 
2135
      fprintf_plus(stderr, "Bringing up interface \"%s\"\n",
 
2136
                   interface);
 
2137
    }
 
2138
    
 
2139
    /* Raise privileges */
 
2140
    ret_errno = raise_privileges();
 
2141
    if(ret_errno != 0){
 
2142
      errno = ret_errno;
 
2143
      perror_plus("Failed to raise privileges");
 
2144
    }
 
2145
    
 
2146
#ifdef __linux__
 
2147
    int ret_linux;
 
2148
    bool restore_loglevel = false;
 
2149
    if(ret_errno == 0){
 
2150
      /* Lower kernel loglevel to KERN_NOTICE to avoid KERN_INFO
 
2151
         messages about the network interface to mess up the prompt */
 
2152
      ret_linux = klogctl(8, NULL, 5);
 
2153
      if(ret_linux == -1){
 
2154
        perror_plus("klogctl");
 
2155
      } else {
 
2156
        restore_loglevel = true;
 
2157
      }
 
2158
    }
 
2159
#endif  /* __linux__ */
 
2160
    int ret_setflags = ioctl(sd, SIOCSIFFLAGS, &network);
 
2161
    ioctl_errno = errno;
 
2162
#ifdef __linux__
 
2163
    if(restore_loglevel){
 
2164
      ret_linux = klogctl(7, NULL, 0);
 
2165
      if(ret_linux == -1){
 
2166
        perror_plus("klogctl");
 
2167
      }
 
2168
    }
 
2169
#endif  /* __linux__ */
 
2170
    
 
2171
    /* If raise_privileges() succeeded above */
 
2172
    if(ret_errno == 0){
 
2173
      /* Lower privileges */
 
2174
      ret_errno = lower_privileges();
 
2175
      if(ret_errno != 0){
 
2176
        errno = ret_errno;
 
2177
        perror_plus("Failed to lower privileges");
 
2178
      }
 
2179
    }
 
2180
    
 
2181
    /* Close the socket */
 
2182
    ret = close(sd);
 
2183
    if(ret == -1){
 
2184
      perror_plus("close");
 
2185
    }
 
2186
    
 
2187
    if(ret_setflags == -1){
 
2188
      errno = ioctl_errno;
 
2189
      perror_plus("ioctl SIOCSIFFLAGS +IFF_UP");
 
2190
      errno = old_errno;
 
2191
      return ioctl_errno;
 
2192
    }
 
2193
  } else if(debug){
 
2194
    fprintf_plus(stderr, "Interface \"%s\" is already up; good\n",
 
2195
                 interface);
 
2196
  }
 
2197
  
 
2198
  /* Sleep checking until interface is running.
 
2199
     Check every 0.25s, up to total time of delay */
 
2200
  for(int i = 0; i < delay * 4; i++){
 
2201
    if(interface_is_running(interface)){
 
2202
      break;
 
2203
    }
 
2204
    struct timespec sleeptime = { .tv_nsec = 250000000 };
 
2205
    ret = nanosleep(&sleeptime, NULL);
 
2206
    if(ret == -1 and errno != EINTR){
 
2207
      perror_plus("nanosleep");
 
2208
    }
 
2209
  }
 
2210
  
 
2211
  errno = old_errno;
 
2212
  return 0;
 
2213
}
 
2214
 
 
2215
__attribute__((nonnull, warn_unused_result))
 
2216
int take_down_interface(const char *const interface){
 
2217
  int old_errno = errno;
 
2218
  struct ifreq network;
 
2219
  unsigned int if_index = if_nametoindex(interface);
 
2220
  if(if_index == 0){
 
2221
    fprintf_plus(stderr, "No such interface: \"%s\"\n", interface);
 
2222
    errno = old_errno;
 
2223
    return ENXIO;
 
2224
  }
 
2225
  if(interface_is_up(interface)){
 
2226
    int ret_errno = 0;
 
2227
    int ioctl_errno = 0;
 
2228
    if(not get_flags(interface, &network) and debug){
 
2229
      ret_errno = errno;
 
2230
      fprintf_plus(stderr, "Failed to get flags for interface "
 
2231
                   "\"%s\"\n", interface);
 
2232
      errno = old_errno;
 
2233
      return ret_errno;
 
2234
    }
 
2235
    network.ifr_flags &= ~(short)IFF_UP; /* clear flag */
 
2236
    
 
2237
    int sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
2238
    if(sd == -1){
 
2239
      ret_errno = errno;
 
2240
      perror_plus("socket");
 
2241
      errno = old_errno;
 
2242
      return ret_errno;
 
2243
    }
 
2244
    
 
2245
    if(debug){
 
2246
      fprintf_plus(stderr, "Taking down interface \"%s\"\n",
 
2247
                   interface);
 
2248
    }
 
2249
    
 
2250
    /* Raise privileges */
 
2251
    ret_errno = raise_privileges();
 
2252
    if(ret_errno != 0){
 
2253
      errno = ret_errno;
 
2254
      perror_plus("Failed to raise privileges");
 
2255
    }
 
2256
    
 
2257
    int ret_setflags = ioctl(sd, SIOCSIFFLAGS, &network);
 
2258
    ioctl_errno = errno;
 
2259
    
 
2260
    /* If raise_privileges() succeeded above */
 
2261
    if(ret_errno == 0){
 
2262
      /* Lower privileges */
 
2263
      ret_errno = lower_privileges();
 
2264
      if(ret_errno != 0){
 
2265
        errno = ret_errno;
 
2266
        perror_plus("Failed to lower privileges");
 
2267
      }
 
2268
    }
 
2269
    
 
2270
    /* Close the socket */
 
2271
    int ret = close(sd);
 
2272
    if(ret == -1){
 
2273
      perror_plus("close");
 
2274
    }
 
2275
    
 
2276
    if(ret_setflags == -1){
 
2277
      errno = ioctl_errno;
 
2278
      perror_plus("ioctl SIOCSIFFLAGS -IFF_UP");
 
2279
      errno = old_errno;
 
2280
      return ioctl_errno;
 
2281
    }
 
2282
  } else if(debug){
 
2283
    fprintf_plus(stderr, "Interface \"%s\" is already down; odd\n",
 
2284
                 interface);
 
2285
  }
 
2286
  
 
2287
  errno = old_errno;
 
2288
  return 0;
 
2289
}
 
2290
 
1275
2291
int main(int argc, char *argv[]){
 
2292
  mandos_context mc = { .server = NULL, .dh_bits = 0,
 
2293
                        .priority = "SECURE256:!CTYPE-X.509"
 
2294
                        ":+CTYPE-OPENPGP:!RSA:+SIGN-DSA-SHA256",
 
2295
                        .current_server = NULL, .interfaces = NULL,
 
2296
                        .interfaces_size = 0 };
1276
2297
  AvahiSServiceBrowser *sb = NULL;
1277
 
  int error;
 
2298
  error_t ret_errno;
1278
2299
  int ret;
1279
2300
  intmax_t tmpmax;
1280
2301
  char *tmp;
1281
2302
  int exitcode = EXIT_SUCCESS;
1282
 
  const char *interface = "";
1283
 
  struct ifreq network;
1284
 
  int sd = -1;
1285
 
  bool take_down_interface = false;
1286
 
  uid_t uid;
1287
 
  gid_t gid;
1288
 
  char tempdir[] = "/tmp/mandosXXXXXX";
1289
 
  bool tempdir_created = false;
 
2303
  char *interfaces_to_take_down = NULL;
 
2304
  size_t interfaces_to_take_down_size = 0;
 
2305
  char run_tempdir[] = "/run/tmp/mandosXXXXXX";
 
2306
  char old_tempdir[] = "/tmp/mandosXXXXXX";
 
2307
  char *tempdir = NULL;
1290
2308
  AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
1291
2309
  const char *seckey = PATHDIR "/" SECKEY;
1292
2310
  const char *pubkey = PATHDIR "/" PUBKEY;
 
2311
  const char *dh_params_file = NULL;
 
2312
  char *interfaces_hooks = NULL;
1293
2313
  
1294
2314
  bool gnutls_initialized = false;
1295
2315
  bool gpgme_initialized = false;
1347
2367
        .doc = "Bit length of the prime number used in the"
1348
2368
        " Diffie-Hellman key exchange",
1349
2369
        .group = 2 },
 
2370
      { .name = "dh-params", .key = 134,
 
2371
        .arg = "FILE",
 
2372
        .doc = "PEM-encoded PKCS#3 file with pre-generated parameters"
 
2373
        " for the Diffie-Hellman key exchange",
 
2374
        .group = 2 },
1350
2375
      { .name = "priority", .key = 130,
1351
2376
        .arg = "STRING",
1352
2377
        .doc = "GnuTLS priority string for the TLS handshake",
1357
2382
        .group = 2 },
1358
2383
      { .name = "retry", .key = 132,
1359
2384
        .arg = "SECONDS",
1360
 
        .doc = "Retry interval used when denied by the mandos server",
 
2385
        .doc = "Retry interval used when denied by the Mandos server",
 
2386
        .group = 2 },
 
2387
      { .name = "network-hook-dir", .key = 133,
 
2388
        .arg = "DIR",
 
2389
        .doc = "Directory where network hooks are located",
1361
2390
        .group = 2 },
1362
2391
      /*
1363
2392
       * These reproduce what we would get without ARGP_NO_HELP
1382
2411
        connect_to = arg;
1383
2412
        break;
1384
2413
      case 'i':                 /* --interface */
1385
 
        interface = arg;
 
2414
        ret_errno = argz_add_sep(&mc.interfaces, &mc.interfaces_size,
 
2415
                                 arg, (int)',');
 
2416
        if(ret_errno != 0){
 
2417
          argp_error(state, "%s", strerror(ret_errno));
 
2418
        }
1386
2419
        break;
1387
2420
      case 's':                 /* --seckey */
1388
2421
        seckey = arg;
1399
2432
        }
1400
2433
        mc.dh_bits = (typeof(mc.dh_bits))tmpmax;
1401
2434
        break;
 
2435
      case 134:                 /* --dh-params */
 
2436
        dh_params_file = arg;
 
2437
        break;
1402
2438
      case 130:                 /* --priority */
1403
2439
        mc.priority = arg;
1404
2440
        break;
1417
2453
          argp_error(state, "Bad retry interval");
1418
2454
        }
1419
2455
        break;
 
2456
      case 133:                 /* --network-hook-dir */
 
2457
        hookdir = arg;
 
2458
        break;
1420
2459
        /*
1421
2460
         * These reproduce what we would get without ARGP_NO_HELP
1422
2461
         */
1428
2467
        argp_state_help(state, state->out_stream,
1429
2468
                        ARGP_HELP_USAGE | ARGP_HELP_EXIT_ERR);
1430
2469
      case 'V':                 /* --version */
1431
 
        fprintf(state->out_stream, "%s\n", argp_program_version);
 
2470
        fprintf_plus(state->out_stream, "%s\n", argp_program_version);
1432
2471
        exit(argp_err_exit_status);
1433
2472
        break;
1434
2473
      default:
1441
2480
                         .args_doc = "",
1442
2481
                         .doc = "Mandos client -- Get and decrypt"
1443
2482
                         " passwords from a Mandos server" };
1444
 
    ret = argp_parse(&argp, argc, argv,
1445
 
                     ARGP_IN_ORDER | ARGP_NO_HELP, 0, NULL);
1446
 
    switch(ret){
 
2483
    ret_errno = argp_parse(&argp, argc, argv,
 
2484
                           ARGP_IN_ORDER | ARGP_NO_HELP, 0, NULL);
 
2485
    switch(ret_errno){
1447
2486
    case 0:
1448
2487
      break;
1449
2488
    case ENOMEM:
1450
2489
    default:
1451
 
      errno = ret;
 
2490
      errno = ret_errno;
1452
2491
      perror_plus("argp_parse");
1453
2492
      exitcode = EX_OSERR;
1454
2493
      goto end;
1457
2496
      goto end;
1458
2497
    }
1459
2498
  }
1460
 
    
 
2499
  
1461
2500
  {
1462
2501
    /* Work around Debian bug #633582:
1463
 
       <http://bugs.debian.org/633582> */
1464
 
    struct stat st;
1465
 
    
1466
 
    /* Re-raise priviliges */
1467
 
    errno = 0;
1468
 
    ret = seteuid(0);
1469
 
    if(ret == -1){
1470
 
      perror_plus("seteuid");
1471
 
    }
1472
 
    
1473
 
    if(strcmp(seckey, PATHDIR "/" SECKEY) == 0){
1474
 
      int seckey_fd = open(seckey, O_RDONLY);
1475
 
      if(seckey_fd == -1){
1476
 
        perror_plus("open");
1477
 
      } else {
1478
 
        ret = (int)TEMP_FAILURE_RETRY(fstat(seckey_fd, &st));
1479
 
        if(ret == -1){
1480
 
          perror_plus("fstat");
1481
 
        } else {
1482
 
          if(S_ISREG(st.st_mode) and st.st_uid == 0 and st.st_gid == 0){
1483
 
            ret = fchown(seckey_fd, uid, gid);
1484
 
            if(ret == -1){
1485
 
              perror_plus("fchown");
1486
 
            }
1487
 
          }
1488
 
        }
1489
 
        TEMP_FAILURE_RETRY(close(seckey_fd));
1490
 
      }
1491
 
    }
1492
 
    
1493
 
    if(strcmp(pubkey, PATHDIR "/" PUBKEY) == 0){
1494
 
      int pubkey_fd = open(pubkey, O_RDONLY);
1495
 
      if(pubkey_fd == -1){
1496
 
        perror_plus("open");
1497
 
      } else {
1498
 
        ret = (int)TEMP_FAILURE_RETRY(fstat(pubkey_fd, &st));
1499
 
        if(ret == -1){
1500
 
          perror_plus("fstat");
1501
 
        } else {
1502
 
          if(S_ISREG(st.st_mode) and st.st_uid == 0 and st.st_gid == 0){
1503
 
            ret = fchown(pubkey_fd, uid, gid);
1504
 
            if(ret == -1){
1505
 
              perror_plus("fchown");
1506
 
            }
1507
 
          }
1508
 
        }
1509
 
        TEMP_FAILURE_RETRY(close(pubkey_fd));
1510
 
      }
1511
 
    }
1512
 
    
1513
 
    /* Lower privileges */
1514
 
    errno = 0;
1515
 
    ret = seteuid(uid);
1516
 
    if(ret == -1){
1517
 
      perror_plus("seteuid");
1518
 
    }
 
2502
       <https://bugs.debian.org/633582> */
 
2503
    
 
2504
    /* Re-raise privileges */
 
2505
    ret = raise_privileges();
 
2506
    if(ret != 0){
 
2507
      errno = ret;
 
2508
      perror_plus("Failed to raise privileges");
 
2509
    } else {
 
2510
      struct stat st;
 
2511
      
 
2512
      if(strcmp(seckey, PATHDIR "/" SECKEY) == 0){
 
2513
        int seckey_fd = open(seckey, O_RDONLY);
 
2514
        if(seckey_fd == -1){
 
2515
          perror_plus("open");
 
2516
        } else {
 
2517
          ret = (int)TEMP_FAILURE_RETRY(fstat(seckey_fd, &st));
 
2518
          if(ret == -1){
 
2519
            perror_plus("fstat");
 
2520
          } else {
 
2521
            if(S_ISREG(st.st_mode)
 
2522
               and st.st_uid == 0 and st.st_gid == 0){
 
2523
              ret = fchown(seckey_fd, uid, gid);
 
2524
              if(ret == -1){
 
2525
                perror_plus("fchown");
 
2526
              }
 
2527
            }
 
2528
          }
 
2529
          close(seckey_fd);
 
2530
        }
 
2531
      }
 
2532
      
 
2533
      if(strcmp(pubkey, PATHDIR "/" PUBKEY) == 0){
 
2534
        int pubkey_fd = open(pubkey, O_RDONLY);
 
2535
        if(pubkey_fd == -1){
 
2536
          perror_plus("open");
 
2537
        } else {
 
2538
          ret = (int)TEMP_FAILURE_RETRY(fstat(pubkey_fd, &st));
 
2539
          if(ret == -1){
 
2540
            perror_plus("fstat");
 
2541
          } else {
 
2542
            if(S_ISREG(st.st_mode)
 
2543
               and st.st_uid == 0 and st.st_gid == 0){
 
2544
              ret = fchown(pubkey_fd, uid, gid);
 
2545
              if(ret == -1){
 
2546
                perror_plus("fchown");
 
2547
              }
 
2548
            }
 
2549
          }
 
2550
          close(pubkey_fd);
 
2551
        }
 
2552
      }
 
2553
      
 
2554
      if(dh_params_file != NULL
 
2555
         and strcmp(dh_params_file, PATHDIR "/dhparams.pem" ) == 0){
 
2556
        int dhparams_fd = open(dh_params_file, O_RDONLY);
 
2557
        if(dhparams_fd == -1){
 
2558
          perror_plus("open");
 
2559
        } else {
 
2560
          ret = (int)TEMP_FAILURE_RETRY(fstat(dhparams_fd, &st));
 
2561
          if(ret == -1){
 
2562
            perror_plus("fstat");
 
2563
          } else {
 
2564
            if(S_ISREG(st.st_mode)
 
2565
               and st.st_uid == 0 and st.st_gid == 0){
 
2566
              ret = fchown(dhparams_fd, uid, gid);
 
2567
              if(ret == -1){
 
2568
                perror_plus("fchown");
 
2569
              }
 
2570
            }
 
2571
          }
 
2572
          close(dhparams_fd);
 
2573
        }
 
2574
      }
 
2575
      
 
2576
      /* Lower privileges */
 
2577
      ret = lower_privileges();
 
2578
      if(ret != 0){
 
2579
        errno = ret;
 
2580
        perror_plus("Failed to lower privileges");
 
2581
      }
 
2582
    }
 
2583
  }
 
2584
  
 
2585
  /* Remove invalid interface names (except "none") */
 
2586
  {
 
2587
    char *interface = NULL;
 
2588
    while((interface = argz_next(mc.interfaces, mc.interfaces_size,
 
2589
                                 interface))){
 
2590
      if(strcmp(interface, "none") != 0
 
2591
         and if_nametoindex(interface) == 0){
 
2592
        if(interface[0] != '\0'){
 
2593
          fprintf_plus(stderr, "Not using nonexisting interface"
 
2594
                       " \"%s\"\n", interface);
 
2595
        }
 
2596
        argz_delete(&mc.interfaces, &mc.interfaces_size, interface);
 
2597
        interface = NULL;
 
2598
      }
 
2599
    }
 
2600
  }
 
2601
  
 
2602
  /* Run network hooks */
 
2603
  {
 
2604
    if(mc.interfaces != NULL){
 
2605
      interfaces_hooks = malloc(mc.interfaces_size);
 
2606
      if(interfaces_hooks == NULL){
 
2607
        perror_plus("malloc");
 
2608
        goto end;
 
2609
      }
 
2610
      memcpy(interfaces_hooks, mc.interfaces, mc.interfaces_size);
 
2611
      argz_stringify(interfaces_hooks, mc.interfaces_size, (int)',');
 
2612
    }
 
2613
    run_network_hooks("start", interfaces_hooks != NULL ?
 
2614
                      interfaces_hooks : "", delay);
1519
2615
  }
1520
2616
  
1521
2617
  if(not debug){
1522
2618
    avahi_set_log_function(empty_log);
1523
2619
  }
1524
 
 
1525
 
  if(interface[0] == '\0'){
1526
 
    struct dirent **direntries;
1527
 
    ret = scandir(sys_class_net, &direntries, good_interface,
1528
 
                  alphasort);
1529
 
    if(ret >= 1){
1530
 
      /* Pick the first good interface */
1531
 
      interface = strdup(direntries[0]->d_name);
1532
 
      if(debug){
1533
 
        fprintf(stderr, "Using interface \"%s\"\n", interface);
1534
 
      }
1535
 
      if(interface == NULL){
1536
 
        perror_plus("malloc");
1537
 
        free(direntries);
1538
 
        exitcode = EXIT_FAILURE;
1539
 
        goto end;
1540
 
      }
1541
 
      free(direntries);
1542
 
    } else {
1543
 
      free(direntries);
1544
 
      fprintf(stderr, "Could not find a network interface\n");
1545
 
      exitcode = EXIT_FAILURE;
1546
 
      goto end;
1547
 
    }
1548
 
  }
1549
2620
  
1550
2621
  /* Initialize Avahi early so avahi_simple_poll_quit() can be called
1551
2622
     from the signal handler */
1552
2623
  /* Initialize the pseudo-RNG for Avahi */
1553
2624
  srand((unsigned int) time(NULL));
1554
 
  mc.simple_poll = avahi_simple_poll_new();
1555
 
  if(mc.simple_poll == NULL){
1556
 
    fprintf(stderr, "Avahi: Failed to create simple poll object.\n");
 
2625
  simple_poll = avahi_simple_poll_new();
 
2626
  if(simple_poll == NULL){
 
2627
    fprintf_plus(stderr,
 
2628
                 "Avahi: Failed to create simple poll object.\n");
1557
2629
    exitcode = EX_UNAVAILABLE;
1558
2630
    goto end;
1559
2631
  }
1621
2693
    }
1622
2694
  }
1623
2695
  
1624
 
  /* If the interface is down, bring it up */
1625
 
  if(strcmp(interface, "none") != 0){
1626
 
    if_index = (AvahiIfIndex) if_nametoindex(interface);
1627
 
    if(if_index == 0){
1628
 
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
1629
 
      exitcode = EX_UNAVAILABLE;
1630
 
      goto end;
1631
 
    }
1632
 
    
1633
 
    if(quit_now){
1634
 
      goto end;
1635
 
    }
1636
 
    
1637
 
    /* Re-raise priviliges */
1638
 
    errno = 0;
1639
 
    ret = seteuid(0);
1640
 
    if(ret == -1){
1641
 
      perror_plus("seteuid");
1642
 
    }
1643
 
    
1644
 
#ifdef __linux__
1645
 
    /* Lower kernel loglevel to KERN_NOTICE to avoid KERN_INFO
1646
 
       messages about the network interface to mess up the prompt */
1647
 
    ret = klogctl(8, NULL, 5);
1648
 
    bool restore_loglevel = true;
1649
 
    if(ret == -1){
1650
 
      restore_loglevel = false;
1651
 
      perror_plus("klogctl");
1652
 
    }
1653
 
#endif  /* __linux__ */
1654
 
    
1655
 
    sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
1656
 
    if(sd < 0){
1657
 
      perror_plus("socket");
1658
 
      exitcode = EX_OSERR;
1659
 
#ifdef __linux__
1660
 
      if(restore_loglevel){
1661
 
        ret = klogctl(7, NULL, 0);
1662
 
        if(ret == -1){
1663
 
          perror_plus("klogctl");
1664
 
        }
1665
 
      }
1666
 
#endif  /* __linux__ */
1667
 
      /* Lower privileges */
1668
 
      errno = 0;
1669
 
      ret = seteuid(uid);
1670
 
      if(ret == -1){
1671
 
        perror_plus("seteuid");
1672
 
      }
1673
 
      goto end;
1674
 
    }
1675
 
    strcpy(network.ifr_name, interface);
1676
 
    ret = ioctl(sd, SIOCGIFFLAGS, &network);
1677
 
    if(ret == -1){
1678
 
      perror_plus("ioctl SIOCGIFFLAGS");
1679
 
#ifdef __linux__
1680
 
      if(restore_loglevel){
1681
 
        ret = klogctl(7, NULL, 0);
1682
 
        if(ret == -1){
1683
 
          perror_plus("klogctl");
1684
 
        }
1685
 
      }
1686
 
#endif  /* __linux__ */
1687
 
      exitcode = EX_OSERR;
1688
 
      /* Lower privileges */
1689
 
      errno = 0;
1690
 
      ret = seteuid(uid);
1691
 
      if(ret == -1){
1692
 
        perror_plus("seteuid");
1693
 
      }
1694
 
      goto end;
1695
 
    }
1696
 
    if((network.ifr_flags & IFF_UP) == 0){
1697
 
      network.ifr_flags |= IFF_UP;
1698
 
      take_down_interface = true;
1699
 
      ret = ioctl(sd, SIOCSIFFLAGS, &network);
1700
 
      if(ret == -1){
1701
 
        take_down_interface = false;
1702
 
        perror_plus("ioctl SIOCSIFFLAGS +IFF_UP");
1703
 
        exitcode = EX_OSERR;
1704
 
#ifdef __linux__
1705
 
        if(restore_loglevel){
1706
 
          ret = klogctl(7, NULL, 0);
1707
 
          if(ret == -1){
1708
 
            perror_plus("klogctl");
 
2696
  /* If no interfaces were specified, make a list */
 
2697
  if(mc.interfaces == NULL){
 
2698
    struct dirent **direntries = NULL;
 
2699
    /* Look for any good interfaces */
 
2700
    ret = scandir(sys_class_net, &direntries, good_interface,
 
2701
                  alphasort);
 
2702
    if(ret >= 1){
 
2703
      /* Add all found interfaces to interfaces list */
 
2704
      for(int i = 0; i < ret; ++i){
 
2705
        ret_errno = argz_add(&mc.interfaces, &mc.interfaces_size,
 
2706
                             direntries[i]->d_name);
 
2707
        if(ret_errno != 0){
 
2708
          errno = ret_errno;
 
2709
          perror_plus("argz_add");
 
2710
          free(direntries[i]);
 
2711
          continue;
 
2712
        }
 
2713
        if(debug){
 
2714
          fprintf_plus(stderr, "Will use interface \"%s\"\n",
 
2715
                       direntries[i]->d_name);
 
2716
        }
 
2717
        free(direntries[i]);
 
2718
      }
 
2719
      free(direntries);
 
2720
    } else {
 
2721
      if(ret == 0){
 
2722
        free(direntries);
 
2723
      }
 
2724
      fprintf_plus(stderr, "Could not find a network interface\n");
 
2725
      exitcode = EXIT_FAILURE;
 
2726
      goto end;
 
2727
    }
 
2728
  }
 
2729
  
 
2730
  /* Bring up interfaces which are down, and remove any "none"s */
 
2731
  {
 
2732
    char *interface = NULL;
 
2733
    while((interface = argz_next(mc.interfaces, mc.interfaces_size,
 
2734
                                 interface))){
 
2735
      /* If interface name is "none", stop bringing up interfaces.
 
2736
         Also remove all instances of "none" from the list */
 
2737
      if(strcmp(interface, "none") == 0){
 
2738
        argz_delete(&mc.interfaces, &mc.interfaces_size,
 
2739
                    interface);
 
2740
        interface = NULL;
 
2741
        while((interface = argz_next(mc.interfaces,
 
2742
                                     mc.interfaces_size, interface))){
 
2743
          if(strcmp(interface, "none") == 0){
 
2744
            argz_delete(&mc.interfaces, &mc.interfaces_size,
 
2745
                        interface);
 
2746
            interface = NULL;
1709
2747
          }
1710
2748
        }
1711
 
#endif  /* __linux__ */
1712
 
        /* Lower privileges */
1713
 
        errno = 0;
1714
 
        ret = seteuid(uid);
1715
 
        if(ret == -1){
1716
 
          perror_plus("seteuid");
1717
 
        }
1718
 
        goto end;
1719
 
      }
1720
 
    }
1721
 
    /* Sleep checking until interface is running.
1722
 
       Check every 0.25s, up to total time of delay */
1723
 
    for(int i=0; i < delay * 4; i++){
1724
 
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
1725
 
      if(ret == -1){
1726
 
        perror_plus("ioctl SIOCGIFFLAGS");
1727
 
      } else if(network.ifr_flags & IFF_RUNNING){
1728
2749
        break;
1729
2750
      }
1730
 
      struct timespec sleeptime = { .tv_nsec = 250000000 };
1731
 
      ret = nanosleep(&sleeptime, NULL);
1732
 
      if(ret == -1 and errno != EINTR){
1733
 
        perror_plus("nanosleep");
1734
 
      }
1735
 
    }
1736
 
    if(not take_down_interface){
1737
 
      /* We won't need the socket anymore */
1738
 
      ret = (int)TEMP_FAILURE_RETRY(close(sd));
1739
 
      if(ret == -1){
1740
 
        perror_plus("close");
1741
 
      }
1742
 
    }
1743
 
#ifdef __linux__
1744
 
    if(restore_loglevel){
1745
 
      /* Restores kernel loglevel to default */
1746
 
      ret = klogctl(7, NULL, 0);
1747
 
      if(ret == -1){
1748
 
        perror_plus("klogctl");
1749
 
      }
1750
 
    }
1751
 
#endif  /* __linux__ */
1752
 
    /* Lower privileges */
1753
 
    errno = 0;
1754
 
    if(take_down_interface){
1755
 
      /* Lower privileges */
1756
 
      ret = seteuid(uid);
1757
 
      if(ret == -1){
1758
 
        perror_plus("seteuid");
1759
 
      }
1760
 
    } else {
1761
 
      /* Lower privileges permanently */
1762
 
      ret = setuid(uid);
1763
 
      if(ret == -1){
1764
 
        perror_plus("setuid");
1765
 
      }
1766
 
    }
 
2751
      bool interface_was_up = interface_is_up(interface);
 
2752
      errno = bring_up_interface(interface, delay);
 
2753
      if(not interface_was_up){
 
2754
        if(errno != 0){
 
2755
          fprintf_plus(stderr, "Failed to bring up interface \"%s\":"
 
2756
                       " %s\n", interface, strerror(errno));
 
2757
        } else {
 
2758
          errno = argz_add(&interfaces_to_take_down,
 
2759
                           &interfaces_to_take_down_size,
 
2760
                           interface);
 
2761
          if(errno != 0){
 
2762
            perror_plus("argz_add");
 
2763
          }
 
2764
        }
 
2765
      }
 
2766
    }
 
2767
    if(debug and (interfaces_to_take_down == NULL)){
 
2768
      fprintf_plus(stderr, "No interfaces were brought up\n");
 
2769
    }
 
2770
  }
 
2771
  
 
2772
  /* If we only got one interface, explicitly use only that one */
 
2773
  if(argz_count(mc.interfaces, mc.interfaces_size) == 1){
 
2774
    if(debug){
 
2775
      fprintf_plus(stderr, "Using only interface \"%s\"\n",
 
2776
                   mc.interfaces);
 
2777
    }
 
2778
    if_index = (AvahiIfIndex)if_nametoindex(mc.interfaces);
1767
2779
  }
1768
2780
  
1769
2781
  if(quit_now){
1770
2782
    goto end;
1771
2783
  }
1772
2784
  
1773
 
  ret = init_gnutls_global(pubkey, seckey);
 
2785
  ret = init_gnutls_global(pubkey, seckey, dh_params_file, &mc);
1774
2786
  if(ret == -1){
1775
 
    fprintf(stderr, "init_gnutls_global failed\n");
 
2787
    fprintf_plus(stderr, "init_gnutls_global failed\n");
1776
2788
    exitcode = EX_UNAVAILABLE;
1777
2789
    goto end;
1778
2790
  } else {
1783
2795
    goto end;
1784
2796
  }
1785
2797
  
1786
 
  if(mkdtemp(tempdir) == NULL){
 
2798
  /* Try /run/tmp before /tmp */
 
2799
  tempdir = mkdtemp(run_tempdir);
 
2800
  if(tempdir == NULL and errno == ENOENT){
 
2801
      if(debug){
 
2802
        fprintf_plus(stderr, "Tempdir %s did not work, trying %s\n",
 
2803
                     run_tempdir, old_tempdir);
 
2804
      }
 
2805
      tempdir = mkdtemp(old_tempdir);
 
2806
  }
 
2807
  if(tempdir == NULL){
1787
2808
    perror_plus("mkdtemp");
1788
2809
    goto end;
1789
2810
  }
1790
 
  tempdir_created = true;
1791
2811
  
1792
2812
  if(quit_now){
1793
2813
    goto end;
1794
2814
  }
1795
2815
  
1796
 
  if(not init_gpgme(pubkey, seckey, tempdir)){
1797
 
    fprintf(stderr, "init_gpgme failed\n");
 
2816
  if(not init_gpgme(pubkey, seckey, tempdir, &mc)){
 
2817
    fprintf_plus(stderr, "init_gpgme failed\n");
1798
2818
    exitcode = EX_UNAVAILABLE;
1799
2819
    goto end;
1800
2820
  } else {
1809
2829
    /* Connect directly, do not use Zeroconf */
1810
2830
    /* (Mainly meant for debugging) */
1811
2831
    char *address = strrchr(connect_to, ':');
 
2832
    
1812
2833
    if(address == NULL){
1813
 
      fprintf(stderr, "No colon in address\n");
 
2834
      fprintf_plus(stderr, "No colon in address\n");
1814
2835
      exitcode = EX_USAGE;
1815
2836
      goto end;
1816
2837
    }
1819
2840
      goto end;
1820
2841
    }
1821
2842
    
1822
 
    uint16_t port;
 
2843
    in_port_t port;
1823
2844
    errno = 0;
1824
2845
    tmpmax = strtoimax(address+1, &tmp, 10);
1825
2846
    if(errno != 0 or tmp == address+1 or *tmp != '\0'
1826
 
       or tmpmax != (uint16_t)tmpmax){
1827
 
      fprintf(stderr, "Bad port number\n");
 
2847
       or tmpmax != (in_port_t)tmpmax){
 
2848
      fprintf_plus(stderr, "Bad port number\n");
1828
2849
      exitcode = EX_USAGE;
1829
2850
      goto end;
1830
2851
    }
1831
 
  
 
2852
    
1832
2853
    if(quit_now){
1833
2854
      goto end;
1834
2855
    }
1835
2856
    
1836
 
    port = (uint16_t)tmpmax;
 
2857
    port = (in_port_t)tmpmax;
1837
2858
    *address = '\0';
1838
2859
    /* Colon in address indicates IPv6 */
1839
2860
    int af;
1855
2876
    }
1856
2877
    
1857
2878
    while(not quit_now){
1858
 
      ret = start_mandos_communication(address, port, if_index, af);
 
2879
      ret = start_mandos_communication(address, port, if_index, af,
 
2880
                                       &mc);
1859
2881
      if(quit_now or ret == 0){
1860
2882
        break;
1861
2883
      }
1862
2884
      if(debug){
1863
 
        fprintf(stderr, "Retrying in %d seconds\n",
1864
 
                (int)retry_interval);
 
2885
        fprintf_plus(stderr, "Retrying in %d seconds\n",
 
2886
                     (int)retry_interval);
1865
2887
      }
1866
 
      sleep((int)retry_interval);
 
2888
      sleep((unsigned int)retry_interval);
1867
2889
    }
1868
2890
    
1869
 
    if (not quit_now){
 
2891
    if(not quit_now){
1870
2892
      exitcode = EXIT_SUCCESS;
1871
2893
    }
1872
 
 
 
2894
    
1873
2895
    goto end;
1874
2896
  }
1875
2897
  
1887
2909
    config.publish_domain = 0;
1888
2910
    
1889
2911
    /* Allocate a new server */
1890
 
    mc.server = avahi_server_new(avahi_simple_poll_get
1891
 
                                 (mc.simple_poll), &config, NULL,
1892
 
                                 NULL, &error);
 
2912
    mc.server = avahi_server_new(avahi_simple_poll_get(simple_poll),
 
2913
                                 &config, NULL, NULL, &ret);
1893
2914
    
1894
2915
    /* Free the Avahi configuration data */
1895
2916
    avahi_server_config_free(&config);
1897
2918
  
1898
2919
  /* Check if creating the Avahi server object succeeded */
1899
2920
  if(mc.server == NULL){
1900
 
    fprintf(stderr, "Failed to create Avahi server: %s\n",
1901
 
            avahi_strerror(error));
 
2921
    fprintf_plus(stderr, "Failed to create Avahi server: %s\n",
 
2922
                 avahi_strerror(ret));
1902
2923
    exitcode = EX_UNAVAILABLE;
1903
2924
    goto end;
1904
2925
  }
1910
2931
  /* Create the Avahi service browser */
1911
2932
  sb = avahi_s_service_browser_new(mc.server, if_index,
1912
2933
                                   AVAHI_PROTO_UNSPEC, "_mandos._tcp",
1913
 
                                   NULL, 0, browse_callback, NULL);
 
2934
                                   NULL, 0, browse_callback,
 
2935
                                   (void *)&mc);
1914
2936
  if(sb == NULL){
1915
 
    fprintf(stderr, "Failed to create service browser: %s\n",
1916
 
            avahi_strerror(avahi_server_errno(mc.server)));
 
2937
    fprintf_plus(stderr, "Failed to create service browser: %s\n",
 
2938
                 avahi_strerror(avahi_server_errno(mc.server)));
1917
2939
    exitcode = EX_UNAVAILABLE;
1918
2940
    goto end;
1919
2941
  }
1925
2947
  /* Run the main loop */
1926
2948
  
1927
2949
  if(debug){
1928
 
    fprintf(stderr, "Starting Avahi loop search\n");
 
2950
    fprintf_plus(stderr, "Starting Avahi loop search\n");
1929
2951
  }
1930
 
 
1931
 
  ret = avahi_loop_with_timeout(mc.simple_poll,
1932
 
                                (int)(retry_interval * 1000));
 
2952
  
 
2953
  ret = avahi_loop_with_timeout(simple_poll,
 
2954
                                (int)(retry_interval * 1000), &mc);
1933
2955
  if(debug){
1934
 
    fprintf(stderr, "avahi_loop_with_timeout exited %s\n",
1935
 
            (ret == 0) ? "successfully" : "with error");
 
2956
    fprintf_plus(stderr, "avahi_loop_with_timeout exited %s\n",
 
2957
                 (ret == 0) ? "successfully" : "with error");
1936
2958
  }
1937
2959
  
1938
2960
 end:
1939
2961
  
1940
2962
  if(debug){
1941
 
    fprintf(stderr, "%s exiting\n", argv[0]);
 
2963
    if(signal_received){
 
2964
      fprintf_plus(stderr, "%s exiting due to signal %d: %s\n",
 
2965
                   argv[0], signal_received,
 
2966
                   strsignal(signal_received));
 
2967
    } else {
 
2968
      fprintf_plus(stderr, "%s exiting\n", argv[0]);
 
2969
    }
1942
2970
  }
1943
2971
  
1944
2972
  /* Cleanup things */
 
2973
  free(mc.interfaces);
 
2974
  
1945
2975
  if(sb != NULL)
1946
2976
    avahi_s_service_browser_free(sb);
1947
2977
  
1948
2978
  if(mc.server != NULL)
1949
2979
    avahi_server_free(mc.server);
1950
2980
  
1951
 
  if(mc.simple_poll != NULL)
1952
 
    avahi_simple_poll_free(mc.simple_poll);
 
2981
  if(simple_poll != NULL)
 
2982
    avahi_simple_poll_free(simple_poll);
1953
2983
  
1954
2984
  if(gnutls_initialized){
1955
2985
    gnutls_certificate_free_credentials(mc.cred);
1956
 
    gnutls_global_deinit();
1957
2986
    gnutls_dh_params_deinit(mc.dh_params);
1958
2987
  }
1959
2988
  
1960
2989
  if(gpgme_initialized){
1961
2990
    gpgme_release(mc.ctx);
1962
2991
  }
1963
 
 
 
2992
  
1964
2993
  /* Cleans up the circular linked list of Mandos servers the client
1965
2994
     has seen */
1966
2995
  if(mc.current_server != NULL){
1967
2996
    mc.current_server->prev->next = NULL;
1968
2997
    while(mc.current_server != NULL){
1969
2998
      server *next = mc.current_server->next;
 
2999
#ifdef __GNUC__
 
3000
#pragma GCC diagnostic push
 
3001
#pragma GCC diagnostic ignored "-Wcast-qual"
 
3002
#endif
 
3003
      free((char *)(mc.current_server->ip));
 
3004
#ifdef __GNUC__
 
3005
#pragma GCC diagnostic pop
 
3006
#endif
1970
3007
      free(mc.current_server);
1971
3008
      mc.current_server = next;
1972
3009
    }
1973
3010
  }
1974
3011
  
1975
 
  /* Take down the network interface */
1976
 
  if(take_down_interface){
1977
 
    /* Re-raise priviliges */
1978
 
    errno = 0;
1979
 
    ret = seteuid(0);
1980
 
    if(ret == -1){
1981
 
      perror_plus("seteuid");
1982
 
    }
1983
 
    if(geteuid() == 0){
1984
 
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
1985
 
      if(ret == -1){
1986
 
        perror_plus("ioctl SIOCGIFFLAGS");
1987
 
      } else if(network.ifr_flags & IFF_UP) {
1988
 
        network.ifr_flags &= ~(short)IFF_UP; /* clear flag */
1989
 
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
1990
 
        if(ret == -1){
1991
 
          perror_plus("ioctl SIOCSIFFLAGS -IFF_UP");
1992
 
        }
1993
 
      }
1994
 
      ret = (int)TEMP_FAILURE_RETRY(close(sd));
1995
 
      if(ret == -1){
1996
 
        perror_plus("close");
1997
 
      }
1998
 
      /* Lower privileges permanently */
1999
 
      errno = 0;
2000
 
      ret = setuid(uid);
2001
 
      if(ret == -1){
2002
 
        perror_plus("setuid");
2003
 
      }
2004
 
    }
 
3012
  /* Re-raise privileges */
 
3013
  {
 
3014
    ret = raise_privileges();
 
3015
    if(ret != 0){
 
3016
      errno = ret;
 
3017
      perror_plus("Failed to raise privileges");
 
3018
    } else {
 
3019
      
 
3020
      /* Run network hooks */
 
3021
      run_network_hooks("stop", interfaces_hooks != NULL ?
 
3022
                        interfaces_hooks : "", delay);
 
3023
      
 
3024
      /* Take down the network interfaces which were brought up */
 
3025
      {
 
3026
        char *interface = NULL;
 
3027
        while((interface = argz_next(interfaces_to_take_down,
 
3028
                                     interfaces_to_take_down_size,
 
3029
                                     interface))){
 
3030
          ret = take_down_interface(interface);
 
3031
          if(ret != 0){
 
3032
            errno = ret;
 
3033
            perror_plus("Failed to take down interface");
 
3034
          }
 
3035
        }
 
3036
        if(debug and (interfaces_to_take_down == NULL)){
 
3037
          fprintf_plus(stderr, "No interfaces needed to be taken"
 
3038
                       " down\n");
 
3039
        }
 
3040
      }
 
3041
    }
 
3042
    
 
3043
    ret = lower_privileges_permanently();
 
3044
    if(ret != 0){
 
3045
      errno = ret;
 
3046
      perror_plus("Failed to lower privileges permanently");
 
3047
    }
 
3048
  }
 
3049
  
 
3050
  free(interfaces_to_take_down);
 
3051
  free(interfaces_hooks);
 
3052
  
 
3053
  void clean_dir_at(int base, const char * const dirname,
 
3054
                    uintmax_t level){
 
3055
    struct dirent **direntries = NULL;
 
3056
    int dret;
 
3057
    int dir_fd = (int)TEMP_FAILURE_RETRY(openat(base, dirname,
 
3058
                                                O_RDONLY
 
3059
                                                | O_NOFOLLOW
 
3060
                                                | O_DIRECTORY
 
3061
                                                | O_PATH));
 
3062
    if(dir_fd == -1){
 
3063
      perror_plus("open");
 
3064
    }
 
3065
    int numentries = scandirat(dir_fd, ".", &direntries,
 
3066
                               notdotentries, alphasort);
 
3067
    if(numentries >= 0){
 
3068
      for(int i = 0; i < numentries; i++){
 
3069
        if(debug){
 
3070
          fprintf_plus(stderr, "Unlinking \"%s/%s\"\n",
 
3071
                       dirname, direntries[i]->d_name);
 
3072
        }
 
3073
        dret = unlinkat(dir_fd, direntries[i]->d_name, 0);
 
3074
        if(dret == -1){
 
3075
          if(errno == EISDIR){
 
3076
              dret = unlinkat(dir_fd, direntries[i]->d_name,
 
3077
                              AT_REMOVEDIR);
 
3078
          }         
 
3079
          if((dret == -1) and (errno == ENOTEMPTY)
 
3080
             and (strcmp(direntries[i]->d_name, "private-keys-v1.d")
 
3081
                  == 0) and (level == 0)){
 
3082
            /* Recurse only in this special case */
 
3083
            clean_dir_at(dir_fd, direntries[i]->d_name, level+1);
 
3084
            dret = 0;
 
3085
          }
 
3086
          if(dret == -1){
 
3087
            fprintf_plus(stderr, "unlink(\"%s/%s\"): %s\n", dirname,
 
3088
                         direntries[i]->d_name, strerror(errno));
 
3089
          }
 
3090
        }
 
3091
        free(direntries[i]);
 
3092
      }
 
3093
      
 
3094
      /* need to clean even if 0 because man page doesn't specify */
 
3095
      free(direntries);
 
3096
      if(numentries == -1){
 
3097
        perror_plus("scandirat");
 
3098
      }
 
3099
      dret = unlinkat(base, dirname, AT_REMOVEDIR);
 
3100
      if(dret == -1 and errno != ENOENT){
 
3101
        perror_plus("rmdir");
 
3102
      }
 
3103
    } else {
 
3104
      perror_plus("scandirat");
 
3105
    }
 
3106
    close(dir_fd);
2005
3107
  }
2006
3108
  
2007
3109
  /* Removes the GPGME temp directory and all files inside */
2008
 
  if(tempdir_created){
2009
 
    struct dirent **direntries = NULL;
2010
 
    struct dirent *direntry = NULL;
2011
 
    int numentries = scandir(tempdir, &direntries, notdotentries,
2012
 
                             alphasort);
2013
 
    if (numentries > 0){
2014
 
      for(int i = 0; i < numentries; i++){
2015
 
        direntry = direntries[i];
2016
 
        char *fullname = NULL;
2017
 
        ret = asprintf(&fullname, "%s/%s", tempdir,
2018
 
                       direntry->d_name);
2019
 
        if(ret < 0){
2020
 
          perror_plus("asprintf");
2021
 
          continue;
2022
 
        }
2023
 
        ret = remove(fullname);
2024
 
        if(ret == -1){
2025
 
          fprintf(stderr, "remove(\"%s\"): %s\n", fullname,
2026
 
                  strerror(errno));
2027
 
        }
2028
 
        free(fullname);
2029
 
      }
2030
 
    }
2031
 
 
2032
 
    /* need to clean even if 0 because man page doesn't specify */
2033
 
    free(direntries);
2034
 
    if (numentries == -1){
2035
 
      perror_plus("scandir");
2036
 
    }
2037
 
    ret = rmdir(tempdir);
2038
 
    if(ret == -1 and errno != ENOENT){
2039
 
      perror_plus("rmdir");
2040
 
    }
 
3110
  if(tempdir != NULL){
 
3111
    clean_dir_at(-1, tempdir, 0);
2041
3112
  }
2042
3113
  
2043
3114
  if(quit_now){