/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
 
    if (debug){
218
 
      gpgme_decrypt_result_t result;
219
 
      result = gpgme_op_decrypt_result(ctx);
220
 
      if (result == NULL){
221
 
        fprintf(stderr, "gpgme_op_decrypt_result failed\n");
222
 
      } else {
223
 
        fprintf(stderr, "Unsupported algorithm: %s\n",
224
 
                result->unsupported_algorithm);
225
 
        fprintf(stderr, "Wrong key usage: %u\n",
226
 
                result->wrong_key_usage);
227
 
        if(result->file_name != NULL){
228
 
          fprintf(stderr, "File name: %s\n", result->file_name);
229
 
        }
230
 
        gpgme_recipient_t recipient;
231
 
        recipient = result->recipients;
232
 
        if(recipient){
233
 
          while(recipient != NULL){
234
 
            fprintf(stderr, "Public key algorithm: %s\n",
235
 
                    gpgme_pubkey_algo_name(recipient->pubkey_algo));
236
 
            fprintf(stderr, "Key ID: %s\n", recipient->keyid);
237
 
            fprintf(stderr, "Secret key available: %s\n",
238
 
                    recipient->status == GPG_ERR_NO_SECKEY
239
 
                    ? "No" : "Yes");
240
 
            recipient = recipient->next;
241
 
          }
 
178
    return -1;
 
179
  }
 
180
 
 
181
  if(debug){
 
182
    fprintf(stderr, "Decryption of OpenPGP packet succeeded\n");
 
183
  }
 
184
 
 
185
  if (debug){
 
186
    gpgme_decrypt_result_t result;
 
187
    result = gpgme_op_decrypt_result(ctx);
 
188
    if (result == NULL){
 
189
      fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
190
    } else {
 
191
      fprintf(stderr, "Unsupported algorithm: %s\n",
 
192
              result->unsupported_algorithm);
 
193
      fprintf(stderr, "Wrong key usage: %d\n",
 
194
              result->wrong_key_usage);
 
195
      if(result->file_name != NULL){
 
196
        fprintf(stderr, "File name: %s\n", result->file_name);
 
197
      }
 
198
      gpgme_recipient_t recipient;
 
199
      recipient = result->recipients;
 
200
      if(recipient){
 
201
        while(recipient != NULL){
 
202
          fprintf(stderr, "Public key algorithm: %s\n",
 
203
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
 
204
          fprintf(stderr, "Key ID: %s\n", recipient->keyid);
 
205
          fprintf(stderr, "Secret key available: %s\n",
 
206
                  recipient->status == GPG_ERR_NO_SECKEY
 
207
                  ? "No" : "Yes");
 
208
          recipient = recipient->next;
242
209
        }
243
210
      }
244
211
    }
245
 
    goto decrypt_end;
246
212
  }
247
213
  
248
 
  if(debug){
249
 
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
250
 
  }
 
214
  /* Delete the GPGME FILE pointer cryptotext data buffer */
 
215
  gpgme_data_release(dh_crypto);
251
216
  
252
217
  /* Seek back to the beginning of the GPGME plaintext data buffer */
253
218
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
254
219
    perror("pgpme_data_seek");
255
 
    plaintext_length = -1;
256
 
    goto decrypt_end;
257
220
  }
258
221
  
259
 
  *plaintext = NULL;
 
222
  *new_packet = 0;
260
223
  while(true){
261
 
    plaintext_capacity = adjustbuffer(plaintext,
262
 
                                      (size_t)plaintext_length,
263
 
                                      plaintext_capacity);
264
 
    if (plaintext_capacity == 0){
 
224
    new_packet_capacity = adjustbuffer(*new_packet, new_packet_length,
 
225
                                       new_packet_capacity);
 
226
    if (new_packet_capacity == 0){
265
227
        perror("adjustbuffer");
266
 
        plaintext_length = -1;
267
 
        goto decrypt_end;
 
228
        return -1;
 
229
      }
 
230
      new_packet_capacity += BUFFER_SIZE;
268
231
    }
269
232
    
270
 
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
 
233
    ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length,
271
234
                          BUFFER_SIZE);
272
235
    /* Print the data, if any */
273
236
    if (ret == 0){
274
 
      /* EOF */
275
237
      break;
276
238
    }
277
239
    if(ret < 0){
278
240
      perror("gpgme_data_read");
279
 
      plaintext_length = -1;
280
 
      goto decrypt_end;
 
241
      return -1;
281
242
    }
282
 
    plaintext_length += ret;
 
243
    new_packet_length += ret;
283
244
  }
284
245
 
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);
 
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
  /*   } */
297
253
  
298
254
  /* Delete the GPGME plaintext data buffer */
299
255
  gpgme_data_release(dh_plain);
300
 
  return plaintext_length;
 
256
  return new_packet_length;
301
257
}
302
258
 
303
259
static const char * safer_gnutls_strerror (int value) {
304
 
  const char *ret = gnutls_strerror (value); /* Spurious warning */
 
260
  const char *ret = gnutls_strerror (value);
305
261
  if (ret == NULL)
306
262
    ret = "(unknown)";
307
263
  return ret;
308
264
}
309
265
 
310
 
/* GnuTLS log function callback */
311
266
static void debuggnutls(__attribute__((unused)) int level,
312
267
                        const char* string){
313
 
  fprintf(stderr, "GnuTLS: %s", string);
 
268
  fprintf(stderr, "%s", string);
314
269
}
315
270
 
316
 
static int init_gnutls_global(mandos_context *mc,
317
 
                              const char *pubkeyfilename,
318
 
                              const char *seckeyfilename){
 
271
static int initgnutls(mandos_context *mc){
 
272
  const char *err;
319
273
  int ret;
320
274
  
321
275
  if(debug){
322
276
    fprintf(stderr, "Initializing GnuTLS\n");
323
277
  }
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));
 
278
 
 
279
  if ((ret = gnutls_global_init ())
 
280
      != GNUTLS_E_SUCCESS) {
 
281
    fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
329
282
    return -1;
330
283
  }
331
 
  
 
284
 
332
285
  if (debug){
333
 
    /* "Use a log level over 10 to enable all debugging options."
334
 
     * - GnuTLS manual
335
 
     */
336
286
    gnutls_global_set_log_level(11);
337
287
    gnutls_global_set_log_function(debuggnutls);
338
288
  }
339
289
  
340
 
  /* OpenPGP credentials */
341
 
  gnutls_certificate_allocate_credentials(&mc->cred);
342
 
  if (ret != GNUTLS_E_SUCCESS){
343
 
    fprintf (stderr, "GnuTLS memory error: %s\n", /* Spurious
344
 
                                                     warning */
 
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));
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){
635
554
    } else {
636
555
      retval = -1;
637
556
    }
638
 
  } else {
639
 
    retval = -1;
640
 
  }
641
 
  
642
 
  /* Shutdown procedure */
643
 
  
644
 
 mandos_end:
 
557
  }
 
558
 
 
559
  //shutdown procedure
 
560
 
 
561
  if(debug){
 
562
    fprintf(stderr, "Closing TLS session\n");
 
563
  }
 
564
 
645
565
  free(buffer);
 
566
  gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
 
567
 exit:
646
568
  close(tcp_sd);
647
 
  gnutls_deinit (session);
 
569
  gnutls_deinit (es.session);
 
570
  gnutls_certificate_free_credentials (es.cred);
 
571
  gnutls_global_deinit ();
648
572
  return retval;
649
573
}
650
574
 
651
 
static void resolve_callback(AvahiSServiceResolver *r,
652
 
                             AvahiIfIndex interface,
653
 
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
654
 
                             AvahiResolverEvent event,
655
 
                             const char *name,
656
 
                             const char *type,
657
 
                             const char *domain,
658
 
                             const char *host_name,
659
 
                             const AvahiAddress *address,
660
 
                             uint16_t port,
661
 
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
662
 
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
663
 
                             flags,
664
 
                             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) {
665
588
  mandos_context *mc = userdata;
666
 
  assert(r);
 
589
  assert(r);                    /* Spurious warning */
667
590
  
668
591
  /* Called whenever a service has been resolved successfully or
669
592
     timed out */
671
594
  switch (event) {
672
595
  default:
673
596
  case AVAHI_RESOLVER_FAILURE:
674
 
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
675
 
            " 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,
676
599
            avahi_strerror(avahi_server_errno(mc->server)));
677
600
    break;
678
601
    
681
604
      char ip[AVAHI_ADDRESS_STR_MAX];
682
605
      avahi_address_snprint(ip, sizeof(ip), address);
683
606
      if(debug){
684
 
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %"
685
 
                PRIu16 ") on port %d\n", name, host_name, ip,
686
 
                interface, port);
 
607
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s) on"
 
608
                " port %d\n", name, host_name, ip, port);
687
609
      }
688
610
      int ret = start_mandos_communication(ip, port, interface, mc);
689
611
      if (ret == 0){
690
 
        avahi_simple_poll_quit(mc->simple_poll);
 
612
        exit(EXIT_SUCCESS);
691
613
      }
692
614
    }
693
615
  }
701
623
                             const char *name,
702
624
                             const char *type,
703
625
                             const char *domain,
704
 
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
705
 
                             flags,
 
626
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags flags,
706
627
                             void* userdata) {
707
628
  mandos_context *mc = userdata;
708
 
  assert(b);
 
629
  assert(b);                    /* Spurious warning */
709
630
  
710
631
  /* Called whenever a new services becomes available on the LAN or
711
632
     is removed from the LAN */
713
634
  switch (event) {
714
635
  default:
715
636
  case AVAHI_BROWSER_FAILURE:
716
 
    
717
 
    fprintf(stderr, "(Avahi browser) %s\n",
 
637
      
 
638
    fprintf(stderr, "(Browser) %s\n",
718
639
            avahi_strerror(avahi_server_errno(mc->server)));
719
640
    avahi_simple_poll_quit(mc->simple_poll);
720
641
    return;
721
 
    
 
642
      
722
643
  case AVAHI_BROWSER_NEW:
723
 
    /* We ignore the returned Avahi resolver object. In the callback
724
 
       function we free it. If the Avahi server is terminated before
725
 
       the callback function is called the Avahi server will free the
726
 
       resolver for us. */
727
 
    
728
 
    if (!(avahi_s_service_resolver_new(mc->server, interface,
729
 
                                       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,
730
651
                                       AVAHI_PROTO_INET6, 0,
731
652
                                       resolve_callback, mc)))
732
 
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
733
 
              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)));
734
655
    break;
735
 
    
 
656
      
736
657
  case AVAHI_BROWSER_REMOVE:
737
658
    break;
738
 
    
 
659
      
739
660
  case AVAHI_BROWSER_ALL_FOR_NOW:
740
661
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
741
 
    if(debug){
742
 
      fprintf(stderr, "No Mandos server found, still searching...\n");
743
 
    }
744
662
    break;
745
663
  }
746
664
}
747
665
 
748
666
/* Combines file name and path and returns the malloced new
749
667
   string. some sane checks could/should be added */
750
 
static char *combinepath(const char *first, const char *second){
751
 
  char *tmp;
752
 
  int ret = asprintf(&tmp, "%s/%s", first, second);
753
 
  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){
754
673
    return NULL;
755
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';
756
683
  return tmp;
757
684
}
758
685
 
759
686
 
760
 
int main(int argc, char *argv[]){
 
687
int main(AVAHI_GCC_UNUSED int argc, AVAHI_GCC_UNUSED char*argv[]) {
 
688
    AvahiServerConfig config;
761
689
    AvahiSServiceBrowser *sb = NULL;
762
690
    int error;
763
691
    int ret;
764
 
    int exitcode = EXIT_SUCCESS;
 
692
    int returncode = EXIT_SUCCESS;
765
693
    const char *interface = "eth0";
766
694
    struct ifreq network;
767
695
    int sd;
768
 
    uid_t uid;
769
 
    gid_t gid;
770
696
    char *connect_to = NULL;
771
697
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
772
 
    char *pubkeyfilename = NULL;
773
 
    char *seckeyfilename = NULL;
774
 
    const char *pubkeyname = "pubkey.txt";
775
 
    const char *seckeyname = "seckey.txt";
776
698
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
777
 
                          .dh_bits = 1024, .priority = "SECURE256"};
778
 
    bool gnutls_initalized = false;
 
699
                          .dh_bits = 2048, .priority = "SECURE256"};
779
700
    
780
 
    {
781
 
      struct argp_option options[] = {
782
 
        { .name = "debug", .key = 128,
783
 
          .doc = "Debug mode", .group = 3 },
784
 
        { .name = "connect", .key = 'c',
785
 
          .arg = "IP",
786
 
          .doc = "Connect directly to a sepcified mandos server",
787
 
          .group = 1 },
788
 
        { .name = "interface", .key = 'i',
789
 
          .arg = "INTERFACE",
790
 
          .doc = "Interface that Avahi will conntect through",
791
 
          .group = 1 },
792
 
        { .name = "keydir", .key = 'd',
793
 
          .arg = "KEYDIR",
794
 
          .doc = "Directory where the openpgp keyring is",
795
 
          .group = 1 },
796
 
        { .name = "seckey", .key = 's',
797
 
          .arg = "SECKEY",
798
 
          .doc = "Secret openpgp key for gnutls authentication",
799
 
          .group = 1 },
800
 
        { .name = "pubkey", .key = 'p',
801
 
          .arg = "PUBKEY",
802
 
          .doc = "Public openpgp key for gnutls authentication",
803
 
          .group = 2 },
804
 
        { .name = "dh-bits", .key = 129,
805
 
          .arg = "BITS",
806
 
          .doc = "dh-bits to use in gnutls communication",
807
 
          .group = 2 },
808
 
        { .name = "priority", .key = 130,
809
 
          .arg = "PRIORITY",
810
 
          .doc = "GNUTLS priority", .group = 1 },
811
 
        { .name = NULL }
812
 
      };
813
 
 
814
 
      
815
 
      error_t parse_opt (int key, char *arg,
816
 
                         struct argp_state *state) {
817
 
        /* Get the INPUT argument from `argp_parse', which we know is
818
 
           a pointer to our plugin list pointer. */
819
 
        switch (key) {
820
 
        case 128:
821
 
          debug = true;
822
 
          break;
823
 
        case 'c':
824
 
          connect_to = arg;
825
 
          break;
826
 
        case 'i':
827
 
          interface = arg;
828
 
          break;
829
 
        case 'd':
830
 
          keydir = arg;
831
 
          break;
832
 
        case 's':
833
 
          seckeyname = arg;
834
 
          break;
835
 
        case 'p':
836
 
          pubkeyname = arg;
837
 
          break;
838
 
        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;
839
742
          errno = 0;
840
 
          mc.dh_bits = (unsigned int) strtol(arg, NULL, 10);
841
 
          if (errno){
 
743
          tmp = strtol(optarg, NULL, 10);
 
744
          if (errno == ERANGE){
842
745
            perror("strtol");
843
746
            exit(EXIT_FAILURE);
844
747
          }
845
 
          break;
846
 
        case 130:
847
 
          mc.priority = arg;
848
 
          break;
849
 
        case ARGP_KEY_ARG:
850
 
          argp_usage (state);
851
 
        case ARGP_KEY_END:
852
 
          break;
853
 
        default:
854
 
          return ARGP_ERR_UNKNOWN;
855
 
        }
856
 
        return 0;
857
 
      }
858
 
 
859
 
      struct argp argp = { .options = options, .parser = parse_opt,
860
 
                           .args_doc = "",
861
 
                           .doc = "Mandos client -- Get and decrypt"
862
 
                           " passwords from mandos server" };
863
 
      ret = argp_parse (&argp, argc, argv, 0, 0, NULL);
864
 
      if (ret == ARGP_ERR_UNKNOWN){
865
 
        fprintf(stderr, "Unknown error while parsing arguments\n");
866
 
        exitcode = EXIT_FAILURE;
867
 
        goto end;
868
 
      }
869
 
    }
870
 
      
871
 
    pubkeyfilename = combinepath(keydir, pubkeyname);
872
 
    if (pubkeyfilename == NULL){
873
 
      perror("combinepath");
874
 
      exitcode = EXIT_FAILURE;
875
 
      goto end;
876
 
    }
877
 
    
878
 
    seckeyfilename = combinepath(keydir, seckeyname);
879
 
    if (seckeyfilename == NULL){
880
 
      perror("combinepath");
881
 
      exitcode = EXIT_FAILURE;
882
 
      goto end;
883
 
    }
884
 
 
885
 
    ret = init_gnutls_global(&mc, pubkeyfilename, seckeyfilename);
886
 
    if (ret == -1){
887
 
      fprintf(stderr, "init_gnutls_global failed\n");
888
 
      exitcode = EXIT_FAILURE;
889
 
      goto end;
890
 
    } else {
891
 
      gnutls_initalized = true;
892
 
    }
893
 
    
894
 
    /* If the interface is down, bring it up */
895
 
    {
896
 
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
897
 
      if(sd < 0) {
898
 
        perror("socket");
899
 
        exitcode = EXIT_FAILURE;
900
 
        goto end;
901
 
      }
902
 
      strcpy(network.ifr_name, interface);
903
 
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
904
 
      if(ret == -1){
905
 
        perror("ioctl SIOCGIFFLAGS");
906
 
        exitcode = EXIT_FAILURE;
907
 
        goto end;
908
 
      }
909
 
      if((network.ifr_flags & IFF_UP) == 0){
910
 
        network.ifr_flags |= IFF_UP;
911
 
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
912
 
        if(ret == -1){
913
 
          perror("ioctl SIOCSIFFLAGS");
914
 
          exitcode = EXIT_FAILURE;
915
 
          goto end;
916
 
        }
917
 
      }
918
 
      close(sd);
919
 
    }
920
 
    
921
 
    uid = getuid();
922
 
    gid = getgid();
923
 
    
924
 
    ret = setuid(uid);
925
 
    if (ret == -1){
926
 
      perror("setuid");
927
 
    }
928
 
    
929
 
    setgid(gid);
930
 
    if (ret == -1){
931
 
      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;
932
771
    }
933
772
    
934
773
    if_index = (AvahiIfIndex) if_nametoindex(interface);
943
782
      char *address = strrchr(connect_to, ':');
944
783
      if(address == NULL){
945
784
        fprintf(stderr, "No colon in address\n");
946
 
        exitcode = EXIT_FAILURE;
947
 
        goto end;
 
785
        exit(EXIT_FAILURE);
948
786
      }
949
787
      errno = 0;
950
788
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
951
789
      if(errno){
952
790
        perror("Bad port number");
953
 
        exitcode = EXIT_FAILURE;
954
 
        goto end;
 
791
        exit(EXIT_FAILURE);
955
792
      }
956
793
      *address = '\0';
957
794
      address = connect_to;
958
 
      ret = start_mandos_communication(address, port, if_index, &mc);
 
795
      ret = start_mandos_communication(address, port, if_index);
959
796
      if(ret < 0){
960
 
        exitcode = EXIT_FAILURE;
 
797
        exit(EXIT_FAILURE);
961
798
      } else {
962
 
        exitcode = EXIT_SUCCESS;
963
 
      }
964
 
      goto end;
965
 
    }
 
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);
966
827
    
967
828
    if (not debug){
968
829
      avahi_set_log_function(empty_log);
969
830
    }
970
831
    
971
 
    /* Initialize the pseudo-RNG for Avahi */
 
832
    /* Initialize the psuedo-RNG */
972
833
    srand((unsigned int) time(NULL));
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",
 
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",
1004
859
                avahi_strerror(error));
1005
 
        exitcode = EXIT_FAILURE;
1006
 
        goto end;
 
860
        returncode = EXIT_FAILURE;
 
861
        goto exit;
1007
862
    }
1008
863
    
1009
 
    /* Create the Avahi service browser */
 
864
    /* Create the service browser */
1010
865
    sb = avahi_s_service_browser_new(mc.server, if_index,
1011
866
                                     AVAHI_PROTO_INET6,
1012
867
                                     "_mandos._tcp", NULL, 0,
1013
868
                                     browse_callback, &mc);
1014
 
    if (sb == NULL) {
 
869
    if (!sb) {
1015
870
        fprintf(stderr, "Failed to create service browser: %s\n",
1016
871
                avahi_strerror(avahi_server_errno(mc.server)));
1017
 
        exitcode = EXIT_FAILURE;
1018
 
        goto end;
 
872
        returncode = EXIT_FAILURE;
 
873
        goto exit;
1019
874
    }
1020
875
    
1021
876
    /* Run the main loop */
1022
877
 
1023
878
    if (debug){
1024
 
      fprintf(stderr, "Starting Avahi loop search\n");
 
879
      fprintf(stderr, "Starting avahi loop search\n");
1025
880
    }
1026
881
    
1027
 
    avahi_simple_poll_loop(mc.simple_poll);
 
882
    avahi_simple_poll_loop(simple_poll);
1028
883
    
1029
 
 end:
 
884
 exit:
1030
885
 
1031
886
    if (debug){
1032
887
      fprintf(stderr, "%s exiting\n", argv[0]);
1033
888
    }
1034
889
    
1035
890
    /* Cleanup things */
1036
 
    if (sb != NULL)
 
891
    if (sb)
1037
892
        avahi_s_service_browser_free(sb);
1038
893
    
1039
 
    if (mc.server != NULL)
 
894
    if (mc.server)
1040
895
        avahi_server_free(mc.server);
1041
896
 
1042
 
    if (mc.simple_poll != NULL)
1043
 
        avahi_simple_poll_free(mc.simple_poll);
1044
 
    free(pubkeyfilename);
1045
 
    free(seckeyfilename);
1046
 
 
1047
 
    if (gnutls_initalized){
1048
 
      gnutls_certificate_free_credentials(mc.cred);
1049
 
      gnutls_global_deinit ();
1050
 
    }
 
897
    if (simple_poll)
 
898
        avahi_simple_poll_free(simple_poll);
 
899
    free(certfile);
 
900
    free(certkey);
1051
901
    
1052
 
    return exitcode;
 
902
    return returncode;
1053
903
}