/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/mandosclient.c

Added support for protocol version handling

Show diffs side-by-side

added added

removed removed

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