/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/password-request.c

version 1.0

Show diffs side-by-side

added added

removed removed

Lines of Context:
25
25
 * along with this program.  If not, see
26
26
 * <http://www.gnu.org/licenses/>.
27
27
 * 
28
 
 * Contact the authors at <https://www.fukt.bsnet.se/~belorn/> and
29
 
 * <https://www.fukt.bsnet.se/~teddy/>.
 
28
 * Contact the authors at <mandos@fukt.bsnet.se>.
30
29
 */
31
30
 
32
31
/* Needed by GPGME, specifically gpgme_data_seek() */
33
32
#define _LARGEFILE_SOURCE
34
33
#define _FILE_OFFSET_BITS 64
35
34
 
36
 
#include <stdio.h>
37
 
#include <assert.h>
38
 
#include <stdlib.h>
39
 
#include <time.h>
40
 
#include <net/if.h>             /* if_nametoindex */
41
 
 
 
35
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY() */
 
36
 
 
37
#include <stdio.h>              /* fprintf(), stderr, fwrite(), stdout,
 
38
                                   ferror() */
 
39
#include <stdint.h>             /* uint16_t, uint32_t */
 
40
#include <stddef.h>             /* NULL, size_t, ssize_t */
 
41
#include <stdlib.h>             /* free(), EXIT_SUCCESS, EXIT_FAILURE,
 
42
                                   srand() */
 
43
#include <stdbool.h>            /* bool, true */
 
44
#include <string.h>             /* memset(), strcmp(), strlen(),
 
45
                                   strerror(), memcpy(), strcpy() */
 
46
#include <sys/ioctl.h>          /* ioctl */
 
47
#include <net/if.h>             /* ifreq, SIOCGIFFLAGS, SIOCSIFFLAGS,
 
48
                                   IFF_UP */
 
49
#include <sys/types.h>          /* socket(), inet_pton(), sockaddr,
 
50
                                   sockaddr_in6, PF_INET6,
 
51
                                   SOCK_STREAM, INET6_ADDRSTRLEN,
 
52
                                   uid_t, gid_t */
 
53
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
 
54
                                   struct in6_addr, inet_pton(),
 
55
                                   connect() */
 
56
#include <assert.h>             /* assert() */
 
57
#include <errno.h>              /* perror(), errno */
 
58
#include <time.h>               /* time() */
 
59
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
 
60
                                   SIOCSIFFLAGS, if_indextoname(),
 
61
                                   if_nametoindex(), IF_NAMESIZE */
 
62
#include <unistd.h>             /* close(), SEEK_SET, off_t, write(),
 
63
                                   getuid(), getgid(), setuid(),
 
64
                                   setgid() */
 
65
#include <netinet/in.h>
 
66
#include <arpa/inet.h>          /* inet_pton(), htons */
 
67
#include <iso646.h>             /* not, and */
 
68
#include <argp.h>               /* struct argp_option, error_t, struct
 
69
                                   argp_state, struct argp,
 
70
                                   argp_parse(), ARGP_KEY_ARG,
 
71
                                   ARGP_KEY_END, ARGP_ERR_UNKNOWN */
 
72
 
 
73
/* Avahi */
 
74
/* All Avahi types, constants and functions
 
75
 Avahi*, avahi_*,
 
76
 AVAHI_* */
42
77
#include <avahi-core/core.h>
43
78
#include <avahi-core/lookup.h>
44
79
#include <avahi-core/log.h>
46
81
#include <avahi-common/malloc.h>
47
82
#include <avahi-common/error.h>
48
83
 
49
 
//mandos client part
50
 
#include <sys/types.h>          /* socket(), inet_pton() */
51
 
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
52
 
                                   struct in6_addr, inet_pton() */
53
 
#include <gnutls/gnutls.h>      /* All GnuTLS stuff */
54
 
#include <gnutls/openpgp.h>     /* GnuTLS with openpgp stuff */
55
 
 
56
 
#include <unistd.h>             /* close() */
57
 
#include <netinet/in.h>
58
 
#include <stdbool.h>            /* true */
59
 
#include <string.h>             /* memset */
60
 
#include <arpa/inet.h>          /* inet_pton() */
61
 
#include <iso646.h>             /* not */
62
 
 
63
 
// gpgme
64
 
#include <errno.h>              /* perror() */
65
 
#include <gpgme.h>
66
 
 
67
 
// getopt long
68
 
#include <getopt.h>
 
84
/* GnuTLS */
 
85
#include <gnutls/gnutls.h>      /* All GnuTLS types, constants and functions
 
86
                                   gnutls_*
 
87
                                   init_gnutls_session(),
 
88
                                   GNUTLS_* */
 
89
#include <gnutls/openpgp.h>     /* gnutls_certificate_set_openpgp_key_file(),
 
90
                                   GNUTLS_OPENPGP_FMT_BASE64 */
 
91
 
 
92
/* GPGME */
 
93
#include <gpgme.h>              /* All GPGME types, constants and functions
 
94
                                   gpgme_*
 
95
                                   GPGME_PROTOCOL_OpenPGP,
 
96
                                   GPG_ERR_NO_* */
69
97
 
70
98
#define BUFFER_SIZE 256
71
 
#define DH_BITS 1024
72
 
 
73
 
const char *certdir = "/conf/conf.d/cryptkeyreq/";
74
 
const char *certfile = "openpgp-client.txt";
75
 
const char *certkey = "openpgp-client-key.txt";
76
99
 
77
100
bool debug = false;
 
101
static const char *keydir = "/conf/conf.d/mandos";
 
102
static const char mandos_protocol_version[] = "1";
 
103
const char *argp_program_version = "mandosclient 1.0";
 
104
const char *argp_program_bug_address = "<mandos@fukt.bsnet.se>";
78
105
 
 
106
/* Used for passing in values through the Avahi callback functions */
79
107
typedef struct {
80
 
  gnutls_session_t session;
 
108
  AvahiSimplePoll *simple_poll;
 
109
  AvahiServer *server;
81
110
  gnutls_certificate_credentials_t cred;
 
111
  unsigned int dh_bits;
82
112
  gnutls_dh_params_t dh_params;
83
 
} encrypted_session;
84
 
 
85
 
 
86
 
ssize_t pgp_packet_decrypt (char *packet, size_t packet_size,
87
 
                            char **new_packet, const char *homedir){
 
113
  const char *priority;
 
114
} mandos_context;
 
115
 
 
116
/*
 
117
 * Make room in "buffer" for at least BUFFER_SIZE additional bytes.
 
118
 * "buffer_capacity" is how much is currently allocated,
 
119
 * "buffer_length" is how much is already used.
 
120
 */
 
121
size_t adjustbuffer(char **buffer, size_t buffer_length,
 
122
                  size_t buffer_capacity){
 
123
  if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
124
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
 
125
    if (buffer == NULL){
 
126
      return 0;
 
127
    }
 
128
    buffer_capacity += BUFFER_SIZE;
 
129
  }
 
130
  return buffer_capacity;
 
131
}
 
132
 
 
133
/* 
 
134
 * Decrypt OpenPGP data using keyrings in HOMEDIR.
 
135
 * Returns -1 on error
 
136
 */
 
137
static ssize_t pgp_packet_decrypt (const char *cryptotext,
 
138
                                   size_t crypto_size,
 
139
                                   char **plaintext,
 
140
                                   const char *homedir){
88
141
  gpgme_data_t dh_crypto, dh_plain;
89
142
  gpgme_ctx_t ctx;
90
143
  gpgme_error_t rc;
91
144
  ssize_t ret;
92
 
  ssize_t new_packet_capacity = 0;
93
 
  ssize_t new_packet_length = 0;
 
145
  size_t plaintext_capacity = 0;
 
146
  ssize_t plaintext_length = 0;
94
147
  gpgme_engine_info_t engine_info;
95
 
 
 
148
  
96
149
  if (debug){
97
 
    fprintf(stderr, "Trying to decrypt OpenPGP packet\n");
 
150
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
98
151
  }
99
152
  
100
153
  /* Init GPGME */
106
159
    return -1;
107
160
  }
108
161
  
109
 
  /* Set GPGME home directory */
 
162
  /* Set GPGME home directory for the OpenPGP engine only */
110
163
  rc = gpgme_get_engine_info (&engine_info);
111
164
  if (rc != GPG_ERR_NO_ERROR){
112
165
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
122
175
    engine_info = engine_info->next;
123
176
  }
124
177
  if(engine_info == NULL){
125
 
    fprintf(stderr, "Could not set home dir to %s\n", homedir);
 
178
    fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
126
179
    return -1;
127
180
  }
128
181
  
129
 
  /* Create new GPGME data buffer from packet buffer */
130
 
  rc = gpgme_data_new_from_mem(&dh_crypto, packet, packet_size, 0);
 
182
  /* Create new GPGME data buffer from memory cryptotext */
 
183
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
 
184
                               0);
131
185
  if (rc != GPG_ERR_NO_ERROR){
132
186
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
133
187
            gpgme_strsource(rc), gpgme_strerror(rc));
139
193
  if (rc != GPG_ERR_NO_ERROR){
140
194
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
141
195
            gpgme_strsource(rc), gpgme_strerror(rc));
 
196
    gpgme_data_release(dh_crypto);
142
197
    return -1;
143
198
  }
144
199
  
147
202
  if (rc != GPG_ERR_NO_ERROR){
148
203
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
149
204
            gpgme_strsource(rc), gpgme_strerror(rc));
150
 
    return -1;
 
205
    plaintext_length = -1;
 
206
    goto decrypt_end;
151
207
  }
152
208
  
153
 
  /* Decrypt data from the FILE pointer to the plaintext data
154
 
     buffer */
 
209
  /* Decrypt data from the cryptotext data buffer to the plaintext
 
210
     data buffer */
155
211
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
156
212
  if (rc != GPG_ERR_NO_ERROR){
157
213
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
158
214
            gpgme_strsource(rc), gpgme_strerror(rc));
159
 
    return -1;
 
215
    plaintext_length = -1;
 
216
    goto decrypt_end;
160
217
  }
161
 
 
 
218
  
162
219
  if(debug){
163
 
    fprintf(stderr, "Decryption of OpenPGP packet succeeded\n");
 
220
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
164
221
  }
165
 
 
 
222
  
166
223
  if (debug){
167
224
    gpgme_decrypt_result_t result;
168
225
    result = gpgme_op_decrypt_result(ctx);
192
249
    }
193
250
  }
194
251
  
195
 
  /* Delete the GPGME FILE pointer cryptotext data buffer */
196
 
  gpgme_data_release(dh_crypto);
197
 
  
198
252
  /* Seek back to the beginning of the GPGME plaintext data buffer */
199
253
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
200
254
    perror("pgpme_data_seek");
 
255
    plaintext_length = -1;
 
256
    goto decrypt_end;
201
257
  }
202
258
  
203
 
  *new_packet = 0;
 
259
  *plaintext = NULL;
204
260
  while(true){
205
 
    if (new_packet_length + BUFFER_SIZE > new_packet_capacity){
206
 
      *new_packet = realloc(*new_packet,
207
 
                            (unsigned int)new_packet_capacity
208
 
                            + BUFFER_SIZE);
209
 
      if (*new_packet == NULL){
210
 
        perror("realloc");
211
 
        return -1;
212
 
      }
213
 
      new_packet_capacity += BUFFER_SIZE;
 
261
    plaintext_capacity = adjustbuffer(plaintext,
 
262
                                      (size_t)plaintext_length,
 
263
                                      plaintext_capacity);
 
264
    if (plaintext_capacity == 0){
 
265
        perror("adjustbuffer");
 
266
        plaintext_length = -1;
 
267
        goto decrypt_end;
214
268
    }
215
269
    
216
 
    ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length,
 
270
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
217
271
                          BUFFER_SIZE);
218
272
    /* Print the data, if any */
219
273
    if (ret == 0){
 
274
      /* EOF */
220
275
      break;
221
276
    }
222
277
    if(ret < 0){
223
278
      perror("gpgme_data_read");
224
 
      return -1;
 
279
      plaintext_length = -1;
 
280
      goto decrypt_end;
225
281
    }
226
 
    new_packet_length += ret;
 
282
    plaintext_length += ret;
227
283
  }
228
284
 
229
 
  /* FIXME: check characters before printing to screen so to not print
230
 
     terminal control characters */
231
 
  /*   if(debug){ */
232
 
  /*     fprintf(stderr, "decrypted password is: "); */
233
 
  /*     fwrite(*new_packet, 1, new_packet_length, stderr); */
234
 
  /*     fprintf(stderr, "\n"); */
235
 
  /*   } */
 
285
  if(debug){
 
286
    fprintf(stderr, "Decrypted password is: ");
 
287
    for(ssize_t i = 0; i < plaintext_length; i++){
 
288
      fprintf(stderr, "%02hhX ", (*plaintext)[i]);
 
289
    }
 
290
    fprintf(stderr, "\n");
 
291
  }
 
292
  
 
293
 decrypt_end:
 
294
  
 
295
  /* Delete the GPGME cryptotext data buffer */
 
296
  gpgme_data_release(dh_crypto);
236
297
  
237
298
  /* Delete the GPGME plaintext data buffer */
238
299
  gpgme_data_release(dh_plain);
239
 
  return new_packet_length;
 
300
  return plaintext_length;
240
301
}
241
302
 
242
303
static const char * safer_gnutls_strerror (int value) {
246
307
  return ret;
247
308
}
248
309
 
249
 
void debuggnutls(__attribute__((unused)) int level,
250
 
                 const char* string){
251
 
  fprintf(stderr, "%s", string);
 
310
/* GnuTLS log function callback */
 
311
static void debuggnutls(__attribute__((unused)) int level,
 
312
                        const char* string){
 
313
  fprintf(stderr, "GnuTLS: %s", string);
252
314
}
253
315
 
254
 
int initgnutls(encrypted_session *es){
255
 
  const char *err;
 
316
static int init_gnutls_global(mandos_context *mc,
 
317
                              const char *pubkeyfile,
 
318
                              const char *seckeyfile){
256
319
  int ret;
257
320
  
258
321
  if(debug){
259
322
    fprintf(stderr, "Initializing GnuTLS\n");
260
323
  }
261
 
 
262
 
  if ((ret = gnutls_global_init ())
263
 
      != GNUTLS_E_SUCCESS) {
264
 
    fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
 
324
  
 
325
  ret = gnutls_global_init();
 
326
  if (ret != GNUTLS_E_SUCCESS) {
 
327
    fprintf (stderr, "GnuTLS global_init: %s\n",
 
328
             safer_gnutls_strerror(ret));
265
329
    return -1;
266
330
  }
267
 
 
 
331
  
268
332
  if (debug){
 
333
    /* "Use a log level over 10 to enable all debugging options."
 
334
     * - GnuTLS manual
 
335
     */
269
336
    gnutls_global_set_log_level(11);
270
337
    gnutls_global_set_log_function(debuggnutls);
271
338
  }
272
339
  
273
 
  /* openpgp credentials */
274
 
  if ((ret = gnutls_certificate_allocate_credentials (&es->cred))
275
 
      != GNUTLS_E_SUCCESS) {
276
 
    fprintf (stderr, "memory error: %s\n",
 
340
  /* OpenPGP credentials */
 
341
  gnutls_certificate_allocate_credentials(&mc->cred);
 
342
  if (ret != GNUTLS_E_SUCCESS){
 
343
    fprintf (stderr, "GnuTLS memory error: %s\n",
277
344
             safer_gnutls_strerror(ret));
 
345
    gnutls_global_deinit ();
278
346
    return -1;
279
347
  }
280
348
  
281
349
  if(debug){
282
350
    fprintf(stderr, "Attempting to use OpenPGP certificate %s"
283
 
            " and keyfile %s as GnuTLS credentials\n", certfile,
284
 
            certkey);
 
351
            " and keyfile %s as GnuTLS credentials\n", pubkeyfile,
 
352
            seckeyfile);
285
353
  }
286
354
  
287
355
  ret = gnutls_certificate_set_openpgp_key_file
288
 
    (es->cred, certfile, certkey, GNUTLS_OPENPGP_FMT_BASE64);
 
356
    (mc->cred, pubkeyfile, seckeyfile, GNUTLS_OPENPGP_FMT_BASE64);
289
357
  if (ret != GNUTLS_E_SUCCESS) {
290
 
    fprintf
291
 
      (stderr, "Error[%d] while reading the OpenPGP key pair ('%s',"
292
 
       " '%s')\n",
293
 
       ret, certfile, certkey);
294
 
    fprintf(stdout, "The Error is: %s\n",
 
358
    fprintf(stderr,
 
359
            "Error[%d] while reading the OpenPGP key pair ('%s',"
 
360
            " '%s')\n", ret, pubkeyfile, seckeyfile);
 
361
    fprintf(stdout, "The GnuTLS error is: %s\n",
295
362
            safer_gnutls_strerror(ret));
296
 
    return -1;
297
 
  }
298
 
  
299
 
  //GnuTLS server initialization
300
 
  if ((ret = gnutls_dh_params_init (&es->dh_params))
301
 
      != GNUTLS_E_SUCCESS) {
302
 
    fprintf (stderr, "Error in dh parameter initialization: %s\n",
303
 
             safer_gnutls_strerror(ret));
304
 
    return -1;
305
 
  }
306
 
  
307
 
  if ((ret = gnutls_dh_params_generate2 (es->dh_params, DH_BITS))
308
 
      != GNUTLS_E_SUCCESS) {
309
 
    fprintf (stderr, "Error in prime generation: %s\n",
310
 
             safer_gnutls_strerror(ret));
311
 
    return -1;
312
 
  }
313
 
  
314
 
  gnutls_certificate_set_dh_params (es->cred, es->dh_params);
315
 
  
316
 
  // GnuTLS session creation
317
 
  if ((ret = gnutls_init (&es->session, GNUTLS_SERVER))
318
 
      != GNUTLS_E_SUCCESS){
 
363
    goto globalfail;
 
364
  }
 
365
  
 
366
  /* GnuTLS server initialization */
 
367
  ret = gnutls_dh_params_init(&mc->dh_params);
 
368
  if (ret != GNUTLS_E_SUCCESS) {
 
369
    fprintf (stderr, "Error in GnuTLS DH parameter initialization:"
 
370
             " %s\n", safer_gnutls_strerror(ret));
 
371
    goto globalfail;
 
372
  }
 
373
  ret = gnutls_dh_params_generate2(mc->dh_params, mc->dh_bits);
 
374
  if (ret != GNUTLS_E_SUCCESS) {
 
375
    fprintf (stderr, "Error in GnuTLS prime generation: %s\n",
 
376
             safer_gnutls_strerror(ret));
 
377
    goto globalfail;
 
378
  }
 
379
  
 
380
  gnutls_certificate_set_dh_params(mc->cred, mc->dh_params);
 
381
 
 
382
  return 0;
 
383
 
 
384
 globalfail:
 
385
 
 
386
  gnutls_certificate_free_credentials(mc->cred);
 
387
  gnutls_global_deinit();
 
388
  return -1;
 
389
 
 
390
}
 
391
 
 
392
static int init_gnutls_session(mandos_context *mc,
 
393
                               gnutls_session_t *session){
 
394
  int ret;
 
395
  /* GnuTLS session creation */
 
396
  ret = gnutls_init(session, GNUTLS_SERVER);
 
397
  if (ret != GNUTLS_E_SUCCESS){
319
398
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
320
399
            safer_gnutls_strerror(ret));
321
400
  }
322
401
  
323
 
  if ((ret = gnutls_priority_set_direct (es->session, "NORMAL", &err))
324
 
      != GNUTLS_E_SUCCESS) {
325
 
    fprintf(stderr, "Syntax error at: %s\n", err);
326
 
    fprintf(stderr, "GnuTLS error: %s\n",
327
 
            safer_gnutls_strerror(ret));
328
 
    return -1;
 
402
  {
 
403
    const char *err;
 
404
    ret = gnutls_priority_set_direct(*session, mc->priority, &err);
 
405
    if (ret != GNUTLS_E_SUCCESS) {
 
406
      fprintf(stderr, "Syntax error at: %s\n", err);
 
407
      fprintf(stderr, "GnuTLS error: %s\n",
 
408
              safer_gnutls_strerror(ret));
 
409
      gnutls_deinit (*session);
 
410
      return -1;
 
411
    }
329
412
  }
330
413
  
331
 
  if ((ret = gnutls_credentials_set
332
 
       (es->session, GNUTLS_CRD_CERTIFICATE, es->cred))
333
 
      != GNUTLS_E_SUCCESS) {
334
 
    fprintf(stderr, "Error setting a credentials set: %s\n",
 
414
  ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
 
415
                               mc->cred);
 
416
  if (ret != GNUTLS_E_SUCCESS) {
 
417
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
335
418
            safer_gnutls_strerror(ret));
 
419
    gnutls_deinit (*session);
336
420
    return -1;
337
421
  }
338
422
  
339
423
  /* ignore client certificate if any. */
340
 
  gnutls_certificate_server_set_request (es->session,
 
424
  gnutls_certificate_server_set_request (*session,
341
425
                                         GNUTLS_CERT_IGNORE);
342
426
  
343
 
  gnutls_dh_set_prime_bits (es->session, DH_BITS);
 
427
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
344
428
  
345
429
  return 0;
346
430
}
347
431
 
348
 
void empty_log(__attribute__((unused)) AvahiLogLevel level,
349
 
               __attribute__((unused)) const char *txt){}
 
432
/* Avahi log function callback */
 
433
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
 
434
                      __attribute__((unused)) const char *txt){}
350
435
 
351
 
int start_mandos_communication(const char *ip, uint16_t port,
352
 
                               AvahiIfIndex if_index){
 
436
/* Called when a Mandos server is found */
 
437
static int start_mandos_communication(const char *ip, uint16_t port,
 
438
                                      AvahiIfIndex if_index,
 
439
                                      mandos_context *mc){
353
440
  int ret, tcp_sd;
354
 
  struct sockaddr_in6 to;
355
 
  encrypted_session es;
 
441
  union { struct sockaddr in; struct sockaddr_in6 in6; } to;
356
442
  char *buffer = NULL;
357
443
  char *decrypted_buffer;
358
444
  size_t buffer_length = 0;
359
445
  size_t buffer_capacity = 0;
360
446
  ssize_t decrypted_buffer_size;
361
 
  size_t written = 0;
 
447
  size_t written;
362
448
  int retval = 0;
363
449
  char interface[IF_NAMESIZE];
 
450
  gnutls_session_t session;
 
451
  
 
452
  ret = init_gnutls_session (mc, &session);
 
453
  if (ret != 0){
 
454
    return -1;
 
455
  }
364
456
  
365
457
  if(debug){
366
458
    fprintf(stderr, "Setting up a tcp connection to %s, port %d\n",
372
464
    perror("socket");
373
465
    return -1;
374
466
  }
375
 
  
376
 
  if(if_indextoname((unsigned int)if_index, interface) == NULL){
377
 
    if(debug){
 
467
 
 
468
  if(debug){
 
469
    if(if_indextoname((unsigned int)if_index, interface) == NULL){
378
470
      perror("if_indextoname");
 
471
      return -1;
379
472
    }
380
 
    return -1;
381
 
  }
382
 
  
383
 
  if(debug){
384
473
    fprintf(stderr, "Binding to interface %s\n", interface);
385
474
  }
386
475
  
387
476
  memset(&to,0,sizeof(to));     /* Spurious warning */
388
 
  to.sin6_family = AF_INET6;
389
 
  ret = inet_pton(AF_INET6, ip, &to.sin6_addr);
 
477
  to.in6.sin6_family = AF_INET6;
 
478
  /* It would be nice to have a way to detect if we were passed an
 
479
     IPv4 address here.   Now we assume an IPv6 address. */
 
480
  ret = inet_pton(AF_INET6, ip, &to.in6.sin6_addr);
390
481
  if (ret < 0 ){
391
482
    perror("inet_pton");
392
483
    return -1;
393
 
  }  
 
484
  }
394
485
  if(ret == 0){
395
486
    fprintf(stderr, "Bad address: %s\n", ip);
396
487
    return -1;
397
488
  }
398
 
  to.sin6_port = htons(port);   /* Spurious warning */
 
489
  to.in6.sin6_port = htons(port);       /* Spurious warning */
399
490
  
400
 
  to.sin6_scope_id = (uint32_t)if_index;
 
491
  to.in6.sin6_scope_id = (uint32_t)if_index;
401
492
  
402
493
  if(debug){
403
494
    fprintf(stderr, "Connection to: %s, port %d\n", ip, port);
404
 
/*     char addrstr[INET6_ADDRSTRLEN]; */
405
 
/*     if(inet_ntop(to.sin6_family, &(to.sin6_addr), addrstr, */
406
 
/*               sizeof(addrstr)) == NULL){ */
407
 
/*       perror("inet_ntop"); */
408
 
/*     } else { */
409
 
/*       fprintf(stderr, "Really connecting to: %s, port %d\n", */
410
 
/*            addrstr, ntohs(to.sin6_port)); */
411
 
/*     } */
 
495
    char addrstr[INET6_ADDRSTRLEN] = "";
 
496
    if(inet_ntop(to.in6.sin6_family, &(to.in6.sin6_addr), addrstr,
 
497
                 sizeof(addrstr)) == NULL){
 
498
      perror("inet_ntop");
 
499
    } else {
 
500
      if(strcmp(addrstr, ip) != 0){
 
501
        fprintf(stderr, "Canonical address form: %s\n", addrstr);
 
502
      }
 
503
    }
412
504
  }
413
505
  
414
 
  ret = connect(tcp_sd, (struct sockaddr *) &to, sizeof(to));
 
506
  ret = connect(tcp_sd, &to.in, sizeof(to));
415
507
  if (ret < 0){
416
508
    perror("connect");
417
509
    return -1;
418
510
  }
419
 
  
420
 
  ret = initgnutls (&es);
421
 
  if (ret != 0){
422
 
    retval = -1;
423
 
    return -1;
 
511
 
 
512
  const char *out = mandos_protocol_version;
 
513
  written = 0;
 
514
  while (true){
 
515
    size_t out_size = strlen(out);
 
516
    ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
 
517
                                   out_size - written));
 
518
    if (ret == -1){
 
519
      perror("write");
 
520
      retval = -1;
 
521
      goto mandos_end;
 
522
    }
 
523
    written += (size_t)ret;
 
524
    if(written < out_size){
 
525
      continue;
 
526
    } else {
 
527
      if (out == mandos_protocol_version){
 
528
        written = 0;
 
529
        out = "\r\n";
 
530
      } else {
 
531
        break;
 
532
      }
 
533
    }
424
534
  }
425
 
  
426
 
  gnutls_transport_set_ptr (es.session,
427
 
                            (gnutls_transport_ptr_t) tcp_sd);
428
 
  
 
535
 
429
536
  if(debug){
430
537
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
431
538
  }
432
539
  
433
 
  ret = gnutls_handshake (es.session);
 
540
  gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
 
541
 
 
542
  do{
 
543
    ret = gnutls_handshake (session);
 
544
  } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
434
545
  
435
546
  if (ret != GNUTLS_E_SUCCESS){
436
547
    if(debug){
437
 
      fprintf(stderr, "\n*** Handshake failed ***\n");
 
548
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
438
549
      gnutls_perror (ret);
439
550
    }
440
551
    retval = -1;
441
 
    goto exit;
 
552
    goto mandos_end;
442
553
  }
443
554
  
444
 
  //Retrieve OpenPGP packet that contains the wanted password
 
555
  /* Read OpenPGP packet that contains the wanted password */
445
556
  
446
557
  if(debug){
447
558
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
449
560
  }
450
561
 
451
562
  while(true){
452
 
    if (buffer_length + BUFFER_SIZE > buffer_capacity){
453
 
      buffer = realloc(buffer, buffer_capacity + BUFFER_SIZE);
454
 
      if (buffer == NULL){
455
 
        perror("realloc");
456
 
        goto exit;
457
 
      }
458
 
      buffer_capacity += BUFFER_SIZE;
 
563
    buffer_capacity = adjustbuffer(&buffer, buffer_length,
 
564
                                   buffer_capacity);
 
565
    if (buffer_capacity == 0){
 
566
      perror("adjustbuffer");
 
567
      retval = -1;
 
568
      goto mandos_end;
459
569
    }
460
570
    
461
 
    ret = gnutls_record_recv
462
 
      (es.session, buffer+buffer_length, BUFFER_SIZE);
 
571
    ret = gnutls_record_recv(session, buffer+buffer_length,
 
572
                             BUFFER_SIZE);
463
573
    if (ret == 0){
464
574
      break;
465
575
    }
469
579
      case GNUTLS_E_AGAIN:
470
580
        break;
471
581
      case GNUTLS_E_REHANDSHAKE:
472
 
        ret = gnutls_handshake (es.session);
 
582
        do{
 
583
          ret = gnutls_handshake (session);
 
584
        } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
473
585
        if (ret < 0){
474
 
          fprintf(stderr, "\n*** Handshake failed ***\n");
 
586
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
475
587
          gnutls_perror (ret);
476
588
          retval = -1;
477
 
          goto exit;
 
589
          goto mandos_end;
478
590
        }
479
591
        break;
480
592
      default:
481
593
        fprintf(stderr, "Unknown error while reading data from"
482
 
                " encrypted session with mandos server\n");
 
594
                " encrypted session with Mandos server\n");
483
595
        retval = -1;
484
 
        gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
485
 
        goto exit;
 
596
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
597
        goto mandos_end;
486
598
      }
487
599
    } else {
488
600
      buffer_length += (size_t) ret;
489
601
    }
490
602
  }
491
603
  
 
604
  if(debug){
 
605
    fprintf(stderr, "Closing TLS session\n");
 
606
  }
 
607
  
 
608
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
609
  
492
610
  if (buffer_length > 0){
493
611
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
494
612
                                               buffer_length,
495
613
                                               &decrypted_buffer,
496
 
                                               certdir);
 
614
                                               keydir);
497
615
    if (decrypted_buffer_size >= 0){
 
616
      written = 0;
498
617
      while(written < (size_t) decrypted_buffer_size){
499
618
        ret = (int)fwrite (decrypted_buffer + written, 1,
500
619
                           (size_t)decrypted_buffer_size - written,
514
633
      retval = -1;
515
634
    }
516
635
  }
517
 
 
518
 
  //shutdown procedure
519
 
 
520
 
  if(debug){
521
 
    fprintf(stderr, "Closing TLS session\n");
522
 
  }
523
 
 
 
636
  
 
637
  /* Shutdown procedure */
 
638
  
 
639
 mandos_end:
524
640
  free(buffer);
525
 
  gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
526
 
 exit:
527
641
  close(tcp_sd);
528
 
  gnutls_deinit (es.session);
529
 
  gnutls_certificate_free_credentials (es.cred);
530
 
  gnutls_global_deinit ();
 
642
  gnutls_deinit (session);
531
643
  return retval;
532
644
}
533
645
 
534
 
static AvahiSimplePoll *simple_poll = NULL;
535
 
static AvahiServer *server = NULL;
536
 
 
537
 
static void resolve_callback(
538
 
    AvahiSServiceResolver *r,
539
 
    AvahiIfIndex interface,
540
 
    AVAHI_GCC_UNUSED AvahiProtocol protocol,
541
 
    AvahiResolverEvent event,
542
 
    const char *name,
543
 
    const char *type,
544
 
    const char *domain,
545
 
    const char *host_name,
546
 
    const AvahiAddress *address,
547
 
    uint16_t port,
548
 
    AVAHI_GCC_UNUSED AvahiStringList *txt,
549
 
    AVAHI_GCC_UNUSED AvahiLookupResultFlags flags,
550
 
    AVAHI_GCC_UNUSED void* userdata) {
551
 
    
 
646
static void resolve_callback(AvahiSServiceResolver *r,
 
647
                             AvahiIfIndex interface,
 
648
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
649
                             AvahiResolverEvent event,
 
650
                             const char *name,
 
651
                             const char *type,
 
652
                             const char *domain,
 
653
                             const char *host_name,
 
654
                             const AvahiAddress *address,
 
655
                             uint16_t port,
 
656
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
 
657
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
658
                             flags,
 
659
                             void* userdata) {
 
660
  mandos_context *mc = userdata;
552
661
  assert(r);                    /* Spurious warning */
553
662
  
554
663
  /* Called whenever a service has been resolved successfully or
557
666
  switch (event) {
558
667
  default:
559
668
  case AVAHI_RESOLVER_FAILURE:
560
 
    fprintf(stderr, "(Resolver) Failed to resolve service '%s' of"
561
 
            " type '%s' in domain '%s': %s\n", name, type, domain,
562
 
            avahi_strerror(avahi_server_errno(server)));
 
669
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
 
670
            " of type '%s' in domain '%s': %s\n", name, type, domain,
 
671
            avahi_strerror(avahi_server_errno(mc->server)));
563
672
    break;
564
673
    
565
674
  case AVAHI_RESOLVER_FOUND:
567
676
      char ip[AVAHI_ADDRESS_STR_MAX];
568
677
      avahi_address_snprint(ip, sizeof(ip), address);
569
678
      if(debug){
570
 
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s) on"
571
 
                " port %d\n", name, host_name, ip, port);
 
679
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %d) on"
 
680
                " port %d\n", name, host_name, ip, interface, port);
572
681
      }
573
 
      int ret = start_mandos_communication(ip, port, interface);
 
682
      int ret = start_mandos_communication(ip, port, interface, mc);
574
683
      if (ret == 0){
575
684
        exit(EXIT_SUCCESS);
576
685
      }
579
688
  avahi_s_service_resolver_free(r);
580
689
}
581
690
 
582
 
static void browse_callback(
583
 
    AvahiSServiceBrowser *b,
584
 
    AvahiIfIndex interface,
585
 
    AvahiProtocol protocol,
586
 
    AvahiBrowserEvent event,
587
 
    const char *name,
588
 
    const char *type,
589
 
    const char *domain,
590
 
    AVAHI_GCC_UNUSED AvahiLookupResultFlags flags,
591
 
    void* userdata) {
592
 
    
593
 
    AvahiServer *s = userdata;
594
 
    assert(b);                  /* Spurious warning */
595
 
    
596
 
    /* Called whenever a new services becomes available on the LAN or
597
 
       is removed from the LAN */
598
 
    
599
 
    switch (event) {
600
 
    default:
601
 
    case AVAHI_BROWSER_FAILURE:
602
 
      
603
 
      fprintf(stderr, "(Browser) %s\n",
604
 
              avahi_strerror(avahi_server_errno(server)));
605
 
      avahi_simple_poll_quit(simple_poll);
606
 
      return;
607
 
      
608
 
    case AVAHI_BROWSER_NEW:
609
 
      /* We ignore the returned resolver object. In the callback
610
 
         function we free it. If the server is terminated before
611
 
         the callback function is called the server will free
612
 
         the resolver for us. */
613
 
      
614
 
      if (!(avahi_s_service_resolver_new(s, interface, protocol, name,
615
 
                                         type, domain,
616
 
                                         AVAHI_PROTO_INET6, 0,
617
 
                                         resolve_callback, s)))
618
 
        fprintf(stderr, "Failed to resolve service '%s': %s\n", name,
619
 
                avahi_strerror(avahi_server_errno(s)));
620
 
      break;
621
 
      
622
 
    case AVAHI_BROWSER_REMOVE:
623
 
      break;
624
 
      
625
 
    case AVAHI_BROWSER_ALL_FOR_NOW:
626
 
    case AVAHI_BROWSER_CACHE_EXHAUSTED:
627
 
      break;
 
691
static void browse_callback( AvahiSServiceBrowser *b,
 
692
                             AvahiIfIndex interface,
 
693
                             AvahiProtocol protocol,
 
694
                             AvahiBrowserEvent event,
 
695
                             const char *name,
 
696
                             const char *type,
 
697
                             const char *domain,
 
698
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
699
                             flags,
 
700
                             void* userdata) {
 
701
  mandos_context *mc = userdata;
 
702
  assert(b);                    /* Spurious warning */
 
703
  
 
704
  /* Called whenever a new services becomes available on the LAN or
 
705
     is removed from the LAN */
 
706
  
 
707
  switch (event) {
 
708
  default:
 
709
  case AVAHI_BROWSER_FAILURE:
 
710
    
 
711
    fprintf(stderr, "(Avahi browser) %s\n",
 
712
            avahi_strerror(avahi_server_errno(mc->server)));
 
713
    avahi_simple_poll_quit(mc->simple_poll);
 
714
    return;
 
715
    
 
716
  case AVAHI_BROWSER_NEW:
 
717
    /* We ignore the returned Avahi resolver object. In the callback
 
718
       function we free it. If the Avahi server is terminated before
 
719
       the callback function is called the Avahi server will free the
 
720
       resolver for us. */
 
721
    
 
722
    if (!(avahi_s_service_resolver_new(mc->server, interface,
 
723
                                       protocol, name, type, domain,
 
724
                                       AVAHI_PROTO_INET6, 0,
 
725
                                       resolve_callback, mc)))
 
726
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
 
727
              name, avahi_strerror(avahi_server_errno(mc->server)));
 
728
    break;
 
729
    
 
730
  case AVAHI_BROWSER_REMOVE:
 
731
    break;
 
732
    
 
733
  case AVAHI_BROWSER_ALL_FOR_NOW:
 
734
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
 
735
    if(debug){
 
736
      fprintf(stderr, "No Mandos server found, still searching...\n");
628
737
    }
 
738
    break;
 
739
  }
629
740
}
630
741
 
631
 
/* combinds file name and path and returns the malloced new string. som sane checks could/should be added */
632
 
const char *combinepath(const char *first, const char *second){
633
 
  char *tmp;
634
 
  tmp = malloc(strlen(first) + strlen(second) + 2);
 
742
/* Combines file name and path and returns the malloced new
 
743
   string. some sane checks could/should be added */
 
744
static const char *combinepath(const char *first, const char *second){
 
745
  size_t f_len = strlen(first);
 
746
  size_t s_len = strlen(second);
 
747
  char *tmp = malloc(f_len + s_len + 2);
635
748
  if (tmp == NULL){
636
 
    perror("malloc");
637
749
    return NULL;
638
750
  }
639
 
  strcpy(tmp, first);
640
 
  if (first[0] != '\0' and first[strlen(first) - 1] != '/'){
641
 
    strcat(tmp, "/");
642
 
  }
643
 
  strcat(tmp, second);
 
751
  if(f_len > 0){
 
752
    memcpy(tmp, first, f_len);  /* Spurious warning */
 
753
  }
 
754
  tmp[f_len] = '/';
 
755
  if(s_len > 0){
 
756
    memcpy(tmp + f_len + 1, second, s_len); /* Spurious warning */
 
757
  }
 
758
  tmp[f_len + 1 + s_len] = '\0';
644
759
  return tmp;
645
760
}
646
761
 
647
762
 
648
 
int main(AVAHI_GCC_UNUSED int argc, AVAHI_GCC_UNUSED char*argv[]) {
649
 
    AvahiServerConfig config;
 
763
int main(int argc, char *argv[]){
650
764
    AvahiSServiceBrowser *sb = NULL;
651
765
    int error;
652
766
    int ret;
653
 
    int returncode = EXIT_SUCCESS;
654
 
    const char *interface = NULL;
 
767
    int exitcode = EXIT_SUCCESS;
 
768
    const char *interface = "eth0";
 
769
    struct ifreq network;
 
770
    int sd;
 
771
    uid_t uid;
 
772
    gid_t gid;
 
773
    char *connect_to = NULL;
655
774
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
656
 
    char *connect_to = NULL;
657
 
    
658
 
    while (true){
659
 
      static struct option long_options[] = {
660
 
        {"debug", no_argument, (int *)&debug, 1},
661
 
        {"connect", required_argument, 0, 'C'},
662
 
        {"interface", required_argument, 0, 'i'},
663
 
        {"certdir", required_argument, 0, 'd'},
664
 
        {"certkey", required_argument, 0, 'c'},
665
 
        {"certfile", required_argument, 0, 'k'},
666
 
        {0, 0, 0, 0} };
667
 
      
668
 
      int option_index = 0;
669
 
      ret = getopt_long (argc, argv, "i:", long_options,
670
 
                         &option_index);
671
 
      
672
 
      if (ret == -1){
673
 
        break;
674
 
      }
675
 
      
676
 
      switch(ret){
677
 
      case 0:
678
 
        break;
679
 
      case 'i':
680
 
        interface = optarg;
681
 
        break;
682
 
      case 'C':
683
 
        connect_to = optarg;
684
 
        break;
685
 
      case 'd':
686
 
        certdir = optarg;
687
 
        break;
688
 
      case 'c':
689
 
        certfile = optarg;
690
 
        break;
691
 
      case 'k':
692
 
        certkey = optarg;
693
 
        break;
694
 
      default:
695
 
        exit(EXIT_FAILURE);
696
 
      }
697
 
    }
698
 
 
699
 
    certfile = combinepath(certdir, certfile);
700
 
    if (certfile == NULL){
701
 
      goto exit;
702
 
    }
703
 
    
704
 
    if(interface != NULL){
705
 
      if_index = (AvahiIfIndex) if_nametoindex(interface);
706
 
      if(if_index == 0){
707
 
        fprintf(stderr, "No such interface: \"%s\"\n", interface);
708
 
        exit(EXIT_FAILURE);
709
 
      }
 
775
    const char *pubkeyfile = "pubkey.txt";
 
776
    const char *seckeyfile = "seckey.txt";
 
777
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
 
778
                          .dh_bits = 1024, .priority = "SECURE256"};
 
779
    bool gnutls_initalized = false;
 
780
    
 
781
    {
 
782
      struct argp_option options[] = {
 
783
        { .name = "debug", .key = 128,
 
784
          .doc = "Debug mode", .group = 3 },
 
785
        { .name = "connect", .key = 'c',
 
786
          .arg = "IP",
 
787
          .doc = "Connect directly to a sepcified mandos server",
 
788
          .group = 1 },
 
789
        { .name = "interface", .key = 'i',
 
790
          .arg = "INTERFACE",
 
791
          .doc = "Interface that Avahi will conntect through",
 
792
          .group = 1 },
 
793
        { .name = "keydir", .key = 'd',
 
794
          .arg = "KEYDIR",
 
795
          .doc = "Directory where the openpgp keyring is",
 
796
          .group = 1 },
 
797
        { .name = "seckey", .key = 's',
 
798
          .arg = "SECKEY",
 
799
          .doc = "Secret openpgp key for gnutls authentication",
 
800
          .group = 1 },
 
801
        { .name = "pubkey", .key = 'p',
 
802
          .arg = "PUBKEY",
 
803
          .doc = "Public openpgp key for gnutls authentication",
 
804
          .group = 2 },
 
805
        { .name = "dh-bits", .key = 129,
 
806
          .arg = "BITS",
 
807
          .doc = "dh-bits to use in gnutls communication",
 
808
          .group = 2 },
 
809
        { .name = "priority", .key = 130,
 
810
          .arg = "PRIORITY",
 
811
          .doc = "GNUTLS priority", .group = 1 },
 
812
        { .name = NULL }
 
813
      };
 
814
 
 
815
      
 
816
      error_t parse_opt (int key, char *arg,
 
817
                         struct argp_state *state) {
 
818
        /* Get the INPUT argument from `argp_parse', which we know is
 
819
           a pointer to our plugin list pointer. */
 
820
        switch (key) {
 
821
        case 128:
 
822
          debug = true;
 
823
          break;
 
824
        case 'c':
 
825
          connect_to = arg;
 
826
          break;
 
827
        case 'i':
 
828
          interface = arg;
 
829
          break;
 
830
        case 'd':
 
831
          keydir = arg;
 
832
          break;
 
833
        case 's':
 
834
          seckeyfile = arg;
 
835
          break;
 
836
        case 'p':
 
837
          pubkeyfile = arg;
 
838
          break;
 
839
        case 129:
 
840
          errno = 0;
 
841
          mc.dh_bits = (unsigned int) strtol(arg, NULL, 10);
 
842
          if (errno){
 
843
            perror("strtol");
 
844
            exit(EXIT_FAILURE);
 
845
          }
 
846
          break;
 
847
        case 130:
 
848
          mc.priority = arg;
 
849
          break;
 
850
        case ARGP_KEY_ARG:
 
851
          argp_usage (state);
 
852
          break;
 
853
          case ARGP_KEY_END:
 
854
            break;
 
855
        default:
 
856
          return ARGP_ERR_UNKNOWN;
 
857
        }
 
858
        return 0;
 
859
      }
 
860
 
 
861
      struct argp argp = { .options = options, .parser = parse_opt,
 
862
                           .args_doc = "",
 
863
                           .doc = "Mandos client -- Get and decrypt"
 
864
                           " passwords from mandos server" };
 
865
      ret = argp_parse (&argp, argc, argv, 0, 0, NULL);
 
866
      if (ret == ARGP_ERR_UNKNOWN){
 
867
        fprintf(stderr, "Unkown error while parsing arguments\n");
 
868
        exitcode = EXIT_FAILURE;
 
869
        goto end;
 
870
      }
 
871
    }
 
872
      
 
873
    pubkeyfile = combinepath(keydir, pubkeyfile);
 
874
    if (pubkeyfile == NULL){
 
875
      perror("combinepath");
 
876
      exitcode = EXIT_FAILURE;
 
877
      goto end;
 
878
    }
 
879
    
 
880
    seckeyfile = combinepath(keydir, seckeyfile);
 
881
    if (seckeyfile == NULL){
 
882
      perror("combinepath");
 
883
      goto end;
 
884
    }
 
885
 
 
886
    ret = init_gnutls_global(&mc, pubkeyfile, seckeyfile);
 
887
    if (ret == -1){
 
888
      fprintf(stderr, "init_gnutls_global\n");
 
889
      goto end;
 
890
    } else {
 
891
      gnutls_initalized = true;
 
892
    }
 
893
 
 
894
    uid = getuid();
 
895
    gid = getgid();
 
896
 
 
897
    ret = setuid(uid);
 
898
    if (ret == -1){
 
899
      perror("setuid");
 
900
    }
 
901
    
 
902
    setgid(gid);
 
903
    if (ret == -1){
 
904
      perror("setgid");
 
905
    }
 
906
    
 
907
    if_index = (AvahiIfIndex) if_nametoindex(interface);
 
908
    if(if_index == 0){
 
909
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
 
910
      exit(EXIT_FAILURE);
710
911
    }
711
912
    
712
913
    if(connect_to != NULL){
715
916
      char *address = strrchr(connect_to, ':');
716
917
      if(address == NULL){
717
918
        fprintf(stderr, "No colon in address\n");
718
 
        exit(EXIT_FAILURE);
 
919
        exitcode = EXIT_FAILURE;
 
920
        goto end;
719
921
      }
720
922
      errno = 0;
721
923
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
722
924
      if(errno){
723
925
        perror("Bad port number");
724
 
        exit(EXIT_FAILURE);
 
926
        exitcode = EXIT_FAILURE;
 
927
        goto end;
725
928
      }
726
929
      *address = '\0';
727
930
      address = connect_to;
728
 
      ret = start_mandos_communication(address, port, if_index);
 
931
      ret = start_mandos_communication(address, port, if_index, &mc);
729
932
      if(ret < 0){
730
 
        exit(EXIT_FAILURE);
 
933
        exitcode = EXIT_FAILURE;
731
934
      } else {
732
 
        exit(EXIT_SUCCESS);
 
935
        exitcode = EXIT_SUCCESS;
733
936
      }
 
937
      goto end;
734
938
    }
735
939
    
736
 
    certkey = combinepath(certdir, certkey);
737
 
    if (certkey == NULL){
738
 
      goto exit;
 
940
    /* If the interface is down, bring it up */
 
941
    {
 
942
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
943
      if(sd < 0) {
 
944
        perror("socket");
 
945
        exitcode = EXIT_FAILURE;
 
946
        goto end;
 
947
      }
 
948
      strcpy(network.ifr_name, interface); /* Spurious warning */
 
949
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
950
      if(ret == -1){
 
951
        perror("ioctl SIOCGIFFLAGS");
 
952
        exitcode = EXIT_FAILURE;
 
953
        goto end;
 
954
      }
 
955
      if((network.ifr_flags & IFF_UP) == 0){
 
956
        network.ifr_flags |= IFF_UP;
 
957
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
958
        if(ret == -1){
 
959
          perror("ioctl SIOCSIFFLAGS");
 
960
          exitcode = EXIT_FAILURE;
 
961
          goto end;
 
962
        }
 
963
      }
 
964
      close(sd);
739
965
    }
740
966
    
741
967
    if (not debug){
742
968
      avahi_set_log_function(empty_log);
743
969
    }
744
970
    
745
 
    /* Initialize the psuedo-RNG */
 
971
    /* Initialize the pseudo-RNG for Avahi */
746
972
    srand((unsigned int) time(NULL));
747
 
 
748
 
    /* Allocate main loop object */
749
 
    if (!(simple_poll = avahi_simple_poll_new())) {
750
 
        fprintf(stderr, "Failed to create simple poll object.\n");
751
 
        
752
 
        goto exit;
753
 
    }
754
 
 
755
 
    /* Do not publish any local records */
756
 
    avahi_server_config_init(&config);
757
 
    config.publish_hinfo = 0;
758
 
    config.publish_addresses = 0;
759
 
    config.publish_workstation = 0;
760
 
    config.publish_domain = 0;
761
 
 
762
 
    /* Allocate a new server */
763
 
    server = avahi_server_new(avahi_simple_poll_get(simple_poll),
764
 
                              &config, NULL, NULL, &error);
765
 
 
766
 
    /* Free the configuration data */
767
 
    avahi_server_config_free(&config);
768
 
 
769
 
    /* Check if creating the server object succeeded */
770
 
    if (!server) {
771
 
        fprintf(stderr, "Failed to create server: %s\n",
 
973
    
 
974
    /* Allocate main Avahi loop object */
 
975
    mc.simple_poll = avahi_simple_poll_new();
 
976
    if (mc.simple_poll == NULL) {
 
977
        fprintf(stderr, "Avahi: Failed to create simple poll"
 
978
                " object.\n");
 
979
        exitcode = EXIT_FAILURE;
 
980
        goto end;
 
981
    }
 
982
 
 
983
    {
 
984
      AvahiServerConfig config;
 
985
      /* Do not publish any local Zeroconf records */
 
986
      avahi_server_config_init(&config);
 
987
      config.publish_hinfo = 0;
 
988
      config.publish_addresses = 0;
 
989
      config.publish_workstation = 0;
 
990
      config.publish_domain = 0;
 
991
 
 
992
      /* Allocate a new server */
 
993
      mc.server = avahi_server_new(avahi_simple_poll_get
 
994
                                   (mc.simple_poll), &config, NULL,
 
995
                                   NULL, &error);
 
996
    
 
997
      /* Free the Avahi configuration data */
 
998
      avahi_server_config_free(&config);
 
999
    }
 
1000
    
 
1001
    /* Check if creating the Avahi server object succeeded */
 
1002
    if (mc.server == NULL) {
 
1003
        fprintf(stderr, "Failed to create Avahi server: %s\n",
772
1004
                avahi_strerror(error));
773
 
        returncode = EXIT_FAILURE;
774
 
        goto exit;
 
1005
        exitcode = EXIT_FAILURE;
 
1006
        goto end;
775
1007
    }
776
1008
    
777
 
    /* Create the service browser */
778
 
    sb = avahi_s_service_browser_new(server, if_index,
 
1009
    /* Create the Avahi service browser */
 
1010
    sb = avahi_s_service_browser_new(mc.server, if_index,
779
1011
                                     AVAHI_PROTO_INET6,
780
1012
                                     "_mandos._tcp", NULL, 0,
781
 
                                     browse_callback, server);
782
 
    if (!sb) {
 
1013
                                     browse_callback, &mc);
 
1014
    if (sb == NULL) {
783
1015
        fprintf(stderr, "Failed to create service browser: %s\n",
784
 
                avahi_strerror(avahi_server_errno(server)));
785
 
        returncode = EXIT_FAILURE;
786
 
        goto exit;
 
1016
                avahi_strerror(avahi_server_errno(mc.server)));
 
1017
        exitcode = EXIT_FAILURE;
 
1018
        goto end;
787
1019
    }
788
1020
    
789
1021
    /* Run the main loop */
790
1022
 
791
1023
    if (debug){
792
 
      fprintf(stderr, "Starting avahi loop search\n");
 
1024
      fprintf(stderr, "Starting Avahi loop search\n");
793
1025
    }
794
1026
    
795
 
    avahi_simple_poll_loop(simple_poll);
 
1027
    avahi_simple_poll_loop(mc.simple_poll);
796
1028
    
797
 
 exit:
 
1029
 end:
798
1030
 
799
1031
    if (debug){
800
1032
      fprintf(stderr, "%s exiting\n", argv[0]);
801
1033
    }
802
1034
    
803
1035
    /* Cleanup things */
804
 
    if (sb)
 
1036
    if (sb != NULL)
805
1037
        avahi_s_service_browser_free(sb);
806
1038
    
807
 
    if (server)
808
 
        avahi_server_free(server);
809
 
 
810
 
    if (simple_poll)
811
 
        avahi_simple_poll_free(simple_poll);
812
 
    free(certfile);
813
 
    free(certkey);
 
1039
    if (mc.server != NULL)
 
1040
        avahi_server_free(mc.server);
 
1041
 
 
1042
    if (mc.simple_poll != NULL)
 
1043
        avahi_simple_poll_free(mc.simple_poll);
 
1044
    free(pubkeyfile);
 
1045
    free(seckeyfile);
 
1046
 
 
1047
    if (gnutls_initalized){
 
1048
      gnutls_certificate_free_credentials(mc.cred);
 
1049
      gnutls_global_deinit ();
 
1050
    }
814
1051
    
815
 
    return returncode;
 
1052
    return exitcode;
816
1053
}