/mandos/release

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

« back to all changes in this revision

Viewing changes to plugins.d/mandosclient.c

merge +
mandosclient
        Added a adjustbuffer function.

Show diffs side-by-side

added added

removed removed

Lines of Context:
1
 
/* $Id$ */
2
 
 
3
 
/* PLEASE NOTE *
4
 
 * This file demonstrates how to use Avahi's core API, this is
5
 
 * the embeddable mDNS stack for embedded applications.
 
1
/*  -*- coding: utf-8 -*- */
 
2
/*
 
3
 * Mandos client - get and decrypt data from a Mandos server
6
4
 *
7
 
 * End user applications should *not* use this API and should use
8
 
 * the D-Bus or C APIs, please see
9
 
 * client-browse-services.c and glib-integration.c
10
 
 * 
11
 
 * I repeat, you probably do *not* want to use this example.
 
5
 * This program is partly derived from an example program for an Avahi
 
6
 * service browser, downloaded from
 
7
 * <http://avahi.org/browser/examples/core-browse-services.c>.  This
 
8
 * includes the following functions: "resolve_callback",
 
9
 * "browse_callback", and parts of "main".
 
10
 * 
 
11
 * Everything else is
 
12
 * Copyright © 2007-2008 Teddy Hogeborn & Björn Påhlsson
 
13
 * 
 
14
 * This program is free software: you can redistribute it and/or
 
15
 * modify it under the terms of the GNU General Public License as
 
16
 * published by the Free Software Foundation, either version 3 of the
 
17
 * License, or (at your option) any later version.
 
18
 * 
 
19
 * This program is distributed in the hope that it will be useful, but
 
20
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 
21
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 
22
 * General Public License for more details.
 
23
 * 
 
24
 * You should have received a copy of the GNU General Public License
 
25
 * along with this program.  If not, see
 
26
 * <http://www.gnu.org/licenses/>.
 
27
 * 
 
28
 * Contact the authors at <mandos@fukt.bsnet.se>.
12
29
 */
13
30
 
14
 
/***
15
 
  This file is part of avahi.
16
 
 
17
 
  avahi is free software; you can redistribute it and/or modify it
18
 
  under the terms of the GNU Lesser General Public License as
19
 
  published by the Free Software Foundation; either version 2.1 of the
20
 
  License, or (at your option) any later version.
21
 
 
22
 
  avahi is distributed in the hope that it will be useful, but WITHOUT
23
 
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
24
 
  or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General
25
 
  Public License for more details.
26
 
 
27
 
  You should have received a copy of the GNU Lesser General Public
28
 
  License along with avahi; if not, write to the Free Software
29
 
  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
30
 
  USA.
31
 
***/
32
 
 
 
31
/* Needed by GPGME, specifically gpgme_data_seek() */
33
32
#define _LARGEFILE_SOURCE
34
33
#define _FILE_OFFSET_BITS 64
35
34
 
 
35
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY() */
 
36
 
36
37
#include <stdio.h>
37
38
#include <assert.h>
38
39
#include <stdlib.h>
39
40
#include <time.h>
40
41
#include <net/if.h>             /* if_nametoindex */
 
42
#include <sys/ioctl.h>          /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
 
43
                                   SIOCSIFFLAGS */
 
44
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
 
45
                                   SIOCSIFFLAGS */
41
46
 
42
47
#include <avahi-core/core.h>
43
48
#include <avahi-core/lookup.h>
46
51
#include <avahi-common/malloc.h>
47
52
#include <avahi-common/error.h>
48
53
 
49
 
//mandos client part
50
 
#include <sys/types.h>          /* socket(), setsockopt(), inet_pton() */
51
 
#include <sys/socket.h>         /* socket(), setsockopt(), struct sockaddr_in6, struct in6_addr, inet_pton() */
52
 
#include <gnutls/gnutls.h>      /* ALL GNUTLS STUFF */
53
 
#include <gnutls/openpgp.h>     /* gnutls with openpgp stuff */
 
54
/* Mandos client part */
 
55
#include <sys/types.h>          /* socket(), inet_pton() */
 
56
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
 
57
                                   struct in6_addr, inet_pton() */
 
58
#include <gnutls/gnutls.h>      /* All GnuTLS stuff */
 
59
#include <gnutls/openpgp.h>     /* GnuTLS with openpgp stuff */
54
60
 
55
61
#include <unistd.h>             /* close() */
56
62
#include <netinet/in.h>
58
64
#include <string.h>             /* memset */
59
65
#include <arpa/inet.h>          /* inet_pton() */
60
66
#include <iso646.h>             /* not */
 
67
#include <net/if.h>             /* IF_NAMESIZE */
61
68
 
62
 
// gpgme
 
69
/* GPGME */
63
70
#include <errno.h>              /* perror() */
64
71
#include <gpgme.h>
65
72
 
 
73
/* getopt_long */
 
74
#include <getopt.h>
66
75
 
67
 
#ifndef CERT_ROOT
68
 
#define CERT_ROOT "/conf/conf.d/cryptkeyreq/"
69
 
#endif
70
 
#define CERTFILE CERT_ROOT "openpgp-client.txt"
71
 
#define KEYFILE CERT_ROOT "openpgp-client-key.txt"
72
76
#define BUFFER_SIZE 256
73
 
#define DH_BITS 1024
74
 
 
 
77
 
 
78
static const char *keydir = "/conf/conf.d/mandos";
 
79
static const char *pubkeyfile = "pubkey.txt";
 
80
static const char *seckeyfile = "seckey.txt";
 
81
 
 
82
bool debug = false;
 
83
 
 
84
const char mandos_protocol_version[] = "1";
 
85
 
 
86
/* Used for passing in values through all the callback functions */
75
87
typedef struct {
76
 
  gnutls_session_t session;
 
88
  AvahiSimplePoll *simple_poll;
 
89
  AvahiServer *server;
77
90
  gnutls_certificate_credentials_t cred;
78
 
  gnutls_dh_params_t dh_params;
79
 
} encrypted_session;
80
 
 
81
 
 
82
 
ssize_t gpg_packet_decrypt (char *packet, size_t packet_size, char **new_packet, char *homedir){
 
91
  unsigned int dh_bits;
 
92
  const char *priority;
 
93
} mandos_context;
 
94
 
 
95
size_t adjustbuffer(char **buffer, size_t buffer_length,
 
96
                  size_t buffer_capacity){
 
97
  if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
98
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
 
99
    if (buffer == NULL){
 
100
      return 0;
 
101
    }
 
102
    buffer_capacity += BUFFER_SIZE;
 
103
  }
 
104
  return buffer_capacity;
 
105
}
 
106
 
 
107
/* 
 
108
 * Decrypt OpenPGP data using keyrings in HOMEDIR.
 
109
 * Returns -1 on error
 
110
 */
 
111
static ssize_t pgp_packet_decrypt (const char *cryptotext,
 
112
                                   size_t crypto_size,
 
113
                                   char **plaintext,
 
114
                                   const char *homedir){
83
115
  gpgme_data_t dh_crypto, dh_plain;
84
116
  gpgme_ctx_t ctx;
85
117
  gpgme_error_t rc;
86
118
  ssize_t ret;
87
 
  size_t new_packet_capacity = 0;
88
 
  size_t new_packet_length = 0;
 
119
  size_t plaintext_capacity = 0;
 
120
  ssize_t plaintext_length = 0;
89
121
  gpgme_engine_info_t engine_info;
90
 
 
 
122
  
 
123
  if (debug){
 
124
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
 
125
  }
 
126
  
91
127
  /* Init GPGME */
92
128
  gpgme_check_version(NULL);
93
 
  gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
 
129
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
 
130
  if (rc != GPG_ERR_NO_ERROR){
 
131
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
 
132
            gpgme_strsource(rc), gpgme_strerror(rc));
 
133
    return -1;
 
134
  }
94
135
  
95
 
  /* Set GPGME home directory */
 
136
  /* Set GPGME home directory for the OpenPGP engine only */
96
137
  rc = gpgme_get_engine_info (&engine_info);
97
138
  if (rc != GPG_ERR_NO_ERROR){
98
139
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
108
149
    engine_info = engine_info->next;
109
150
  }
110
151
  if(engine_info == NULL){
111
 
    fprintf(stderr, "Could not set home dir to %s\n", homedir);
 
152
    fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
112
153
    return -1;
113
154
  }
114
155
  
115
 
  /* Create new GPGME data buffer from packet buffer */
116
 
  rc = gpgme_data_new_from_mem(&dh_crypto, packet, packet_size, 0);
 
156
  /* Create new GPGME data buffer from memory cryptotext */
 
157
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
 
158
                               0);
117
159
  if (rc != GPG_ERR_NO_ERROR){
118
160
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
119
161
            gpgme_strsource(rc), gpgme_strerror(rc));
125
167
  if (rc != GPG_ERR_NO_ERROR){
126
168
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
127
169
            gpgme_strsource(rc), gpgme_strerror(rc));
 
170
    gpgme_data_release(dh_crypto);
128
171
    return -1;
129
172
  }
130
173
  
133
176
  if (rc != GPG_ERR_NO_ERROR){
134
177
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
135
178
            gpgme_strsource(rc), gpgme_strerror(rc));
136
 
    return -1;
 
179
    plaintext_length = -1;
 
180
    goto decrypt_end;
137
181
  }
138
182
  
139
 
  /* Decrypt data from the FILE pointer to the plaintext data buffer */
 
183
  /* Decrypt data from the cryptotext data buffer to the plaintext
 
184
     data buffer */
140
185
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
141
186
  if (rc != GPG_ERR_NO_ERROR){
142
187
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
143
188
            gpgme_strsource(rc), gpgme_strerror(rc));
144
 
    return -1;
145
 
  }
146
 
  
147
 
/*   gpgme_decrypt_result_t result; */
148
 
/*   result = gpgme_op_decrypt_result(ctx); */
149
 
/*   fprintf(stderr, "Unsupported algorithm: %s\n", result->unsupported_algorithm); */
150
 
/*   fprintf(stderr, "Wrong key usage: %d\n", result->wrong_key_usage); */
151
 
/*   if(result->file_name != NULL){ */
152
 
/*     fprintf(stderr, "File name: %s\n", result->file_name); */
153
 
/*   } */
154
 
/*   gpgme_recipient_t recipient; */
155
 
/*   recipient = result->recipients; */
156
 
/*   if(recipient){ */
157
 
/*     while(recipient != NULL){ */
158
 
/*       fprintf(stderr, "Public key algorithm: %s\n", */
159
 
/*            gpgme_pubkey_algo_name(recipient->pubkey_algo)); */
160
 
/*       fprintf(stderr, "Key ID: %s\n", recipient->keyid); */
161
 
/*       fprintf(stderr, "Secret key available: %s\n", */
162
 
/*            recipient->status == GPG_ERR_NO_SECKEY ? "No" : "Yes"); */
163
 
/*       recipient = recipient->next; */
164
 
/*     } */
165
 
/*   } */
166
 
 
167
 
  /* Delete the GPGME FILE pointer cryptotext data buffer */
168
 
  gpgme_data_release(dh_crypto);
 
189
    plaintext_length = -1;
 
190
    goto decrypt_end;
 
191
  }
 
192
  
 
193
  if(debug){
 
194
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
 
195
  }
 
196
  
 
197
  if (debug){
 
198
    gpgme_decrypt_result_t result;
 
199
    result = gpgme_op_decrypt_result(ctx);
 
200
    if (result == NULL){
 
201
      fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
202
    } else {
 
203
      fprintf(stderr, "Unsupported algorithm: %s\n",
 
204
              result->unsupported_algorithm);
 
205
      fprintf(stderr, "Wrong key usage: %d\n",
 
206
              result->wrong_key_usage);
 
207
      if(result->file_name != NULL){
 
208
        fprintf(stderr, "File name: %s\n", result->file_name);
 
209
      }
 
210
      gpgme_recipient_t recipient;
 
211
      recipient = result->recipients;
 
212
      if(recipient){
 
213
        while(recipient != NULL){
 
214
          fprintf(stderr, "Public key algorithm: %s\n",
 
215
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
 
216
          fprintf(stderr, "Key ID: %s\n", recipient->keyid);
 
217
          fprintf(stderr, "Secret key available: %s\n",
 
218
                  recipient->status == GPG_ERR_NO_SECKEY
 
219
                  ? "No" : "Yes");
 
220
          recipient = recipient->next;
 
221
        }
 
222
      }
 
223
    }
 
224
  }
169
225
  
170
226
  /* Seek back to the beginning of the GPGME plaintext data buffer */
171
 
  gpgme_data_seek(dh_plain, 0, SEEK_SET);
172
 
 
173
 
  *new_packet = 0;
 
227
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
 
228
    perror("pgpme_data_seek");
 
229
    plaintext_length = -1;
 
230
    goto decrypt_end;
 
231
  }
 
232
  
 
233
  *plaintext = NULL;
174
234
  while(true){
175
 
    if (new_packet_length + BUFFER_SIZE > new_packet_capacity){
176
 
      *new_packet = realloc(*new_packet, new_packet_capacity + BUFFER_SIZE);
177
 
      if (*new_packet == NULL){
178
 
        perror("realloc");
179
 
        return -1;
180
 
      }
181
 
      new_packet_capacity += BUFFER_SIZE;
 
235
    plaintext_capacity = adjustbuffer(plaintext, (size_t)plaintext_length,
 
236
                                      plaintext_capacity);
 
237
    if (plaintext_capacity == 0){
 
238
        perror("adjustbuffer");
 
239
        plaintext_length = -1;
 
240
        goto decrypt_end;
182
241
    }
183
242
    
184
 
    ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length, BUFFER_SIZE);
 
243
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
 
244
                          BUFFER_SIZE);
185
245
    /* Print the data, if any */
186
246
    if (ret == 0){
187
 
      /* If password is empty, then a incorrect error will be printed */
 
247
      /* EOF */
188
248
      break;
189
249
    }
190
250
    if(ret < 0){
191
251
      perror("gpgme_data_read");
192
 
      return -1;
 
252
      plaintext_length = -1;
 
253
      goto decrypt_end;
193
254
    }
194
 
    new_packet_length += ret;
 
255
    plaintext_length += ret;
195
256
  }
196
257
 
197
 
   /* Delete the GPGME plaintext data buffer */
 
258
  if(debug){
 
259
    fprintf(stderr, "Decrypted password is: ");
 
260
    for(ssize_t i = 0; i < plaintext_length; i++){
 
261
      fprintf(stderr, "%02hhX ", (*plaintext)[i]);
 
262
    }
 
263
    fprintf(stderr, "\n");
 
264
  }
 
265
  
 
266
 decrypt_end:
 
267
  
 
268
  /* Delete the GPGME cryptotext data buffer */
 
269
  gpgme_data_release(dh_crypto);
 
270
  
 
271
  /* Delete the GPGME plaintext data buffer */
198
272
  gpgme_data_release(dh_plain);
199
 
  return new_packet_length;
 
273
  return plaintext_length;
200
274
}
201
275
 
202
276
static const char * safer_gnutls_strerror (int value) {
206
280
  return ret;
207
281
}
208
282
 
209
 
void debuggnutls(int level, const char* string){
210
 
  fprintf(stderr, "%s", string);
 
283
/* GnuTLS log function callback */
 
284
static void debuggnutls(__attribute__((unused)) int level,
 
285
                        const char* string){
 
286
  fprintf(stderr, "GnuTLS: %s", string);
211
287
}
212
288
 
213
 
int initgnutls(encrypted_session *es){
214
 
  const char *err;
 
289
static int initgnutls(mandos_context *mc, gnutls_session_t *session,
 
290
                      gnutls_dh_params_t *dh_params){
215
291
  int ret;
216
292
  
 
293
  if(debug){
 
294
    fprintf(stderr, "Initializing GnuTLS\n");
 
295
  }
 
296
 
217
297
  if ((ret = gnutls_global_init ())
218
298
      != GNUTLS_E_SUCCESS) {
219
 
    fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
 
299
    fprintf (stderr, "GnuTLS global_init: %s\n",
 
300
             safer_gnutls_strerror(ret));
220
301
    return -1;
221
302
  }
222
 
 
223
 
  /* Uncomment to enable full debuggin on the gnutls library */
224
 
  /*   gnutls_global_set_log_level(11); */
225
 
  /*   gnutls_global_set_log_function(debuggnutls); */
226
 
 
227
 
 
228
 
  /* openpgp credentials */
229
 
  if ((ret = gnutls_certificate_allocate_credentials (&es->cred))
 
303
  
 
304
  if (debug){
 
305
    /* "Use a log level over 10 to enable all debugging options."
 
306
     * - GnuTLS manual
 
307
     */
 
308
    gnutls_global_set_log_level(11);
 
309
    gnutls_global_set_log_function(debuggnutls);
 
310
  }
 
311
  
 
312
  /* OpenPGP credentials */
 
313
  if ((ret = gnutls_certificate_allocate_credentials (&mc->cred))
230
314
      != GNUTLS_E_SUCCESS) {
231
 
    fprintf (stderr, "memory error: %s\n", safer_gnutls_strerror(ret));
 
315
    fprintf (stderr, "GnuTLS memory error: %s\n",
 
316
             safer_gnutls_strerror(ret));
232
317
    return -1;
233
318
  }
234
 
 
 
319
  
 
320
  if(debug){
 
321
    fprintf(stderr, "Attempting to use OpenPGP certificate %s"
 
322
            " and keyfile %s as GnuTLS credentials\n", pubkeyfile,
 
323
            seckeyfile);
 
324
  }
 
325
  
235
326
  ret = gnutls_certificate_set_openpgp_key_file
236
 
    (es->cred, CERTFILE, KEYFILE, GNUTLS_OPENPGP_FMT_BASE64);
237
 
  if (ret != GNUTLS_E_SUCCESS) {
238
 
    fprintf
239
 
      (stderr, "Error[%d] while reading the OpenPGP key pair ('%s', '%s')\n",
240
 
       ret, CERTFILE, KEYFILE);
241
 
    fprintf(stdout, "The Error is: %s\n",
242
 
            safer_gnutls_strerror(ret));
243
 
    return -1;
244
 
  }
245
 
 
246
 
  //Gnutls server initialization
247
 
  if ((ret = gnutls_dh_params_init (&es->dh_params))
248
 
      != GNUTLS_E_SUCCESS) {
249
 
    fprintf (stderr, "Error in dh parameter initialization: %s\n",
250
 
             safer_gnutls_strerror(ret));
251
 
    return -1;
252
 
  }
253
 
 
254
 
  if ((ret = gnutls_dh_params_generate2 (es->dh_params, DH_BITS))
255
 
      != GNUTLS_E_SUCCESS) {
256
 
    fprintf (stderr, "Error in prime generation: %s\n",
257
 
             safer_gnutls_strerror(ret));
258
 
    return -1;
259
 
  }
260
 
 
261
 
  gnutls_certificate_set_dh_params (es->cred, es->dh_params);
262
 
 
263
 
  // Gnutls session creation
264
 
  if ((ret = gnutls_init (&es->session, GNUTLS_SERVER))
265
 
      != GNUTLS_E_SUCCESS){
266
 
    fprintf(stderr, "Error in gnutls session initialization: %s\n",
267
 
            safer_gnutls_strerror(ret));
268
 
  }
269
 
 
270
 
  if ((ret = gnutls_priority_set_direct (es->session, "NORMAL", &err))
271
 
      != GNUTLS_E_SUCCESS) {
272
 
    fprintf(stderr, "Syntax error at: %s\n", err);
273
 
    fprintf(stderr, "Gnutls error: %s\n",
274
 
            safer_gnutls_strerror(ret));
275
 
    return -1;
276
 
  }
277
 
 
278
 
  if ((ret = gnutls_credentials_set
279
 
       (es->session, GNUTLS_CRD_CERTIFICATE, es->cred))
280
 
      != GNUTLS_E_SUCCESS) {
281
 
    fprintf(stderr, "Error setting a credentials set: %s\n",
282
 
            safer_gnutls_strerror(ret));
283
 
    return -1;
284
 
  }
285
 
 
 
327
    (mc->cred, pubkeyfile, seckeyfile, GNUTLS_OPENPGP_FMT_BASE64);
 
328
  if (ret != GNUTLS_E_SUCCESS) {
 
329
    fprintf(stderr,
 
330
            "Error[%d] while reading the OpenPGP key pair ('%s',"
 
331
            " '%s')\n", ret, pubkeyfile, seckeyfile);
 
332
    fprintf(stdout, "The GnuTLS error is: %s\n",
 
333
            safer_gnutls_strerror(ret));
 
334
    return -1;
 
335
  }
 
336
  
 
337
  /* GnuTLS server initialization */
 
338
  ret = gnutls_dh_params_init(dh_params);
 
339
  if (ret != GNUTLS_E_SUCCESS) {
 
340
    fprintf (stderr, "Error in GnuTLS DH parameter initialization:"
 
341
             " %s\n", safer_gnutls_strerror(ret));
 
342
    return -1;
 
343
  }
 
344
  ret = gnutls_dh_params_generate2(*dh_params, mc->dh_bits);
 
345
  if (ret != GNUTLS_E_SUCCESS) {
 
346
    fprintf (stderr, "Error in GnuTLS prime generation: %s\n",
 
347
             safer_gnutls_strerror(ret));
 
348
    return -1;
 
349
  }
 
350
  
 
351
  gnutls_certificate_set_dh_params(mc->cred, *dh_params);
 
352
  
 
353
  /* GnuTLS session creation */
 
354
  ret = gnutls_init(session, GNUTLS_SERVER);
 
355
  if (ret != GNUTLS_E_SUCCESS){
 
356
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
 
357
            safer_gnutls_strerror(ret));
 
358
  }
 
359
  
 
360
  {
 
361
    const char *err;
 
362
    ret = gnutls_priority_set_direct(*session, mc->priority, &err);
 
363
    if (ret != GNUTLS_E_SUCCESS) {
 
364
      fprintf(stderr, "Syntax error at: %s\n", err);
 
365
      fprintf(stderr, "GnuTLS error: %s\n",
 
366
              safer_gnutls_strerror(ret));
 
367
      return -1;
 
368
    }
 
369
  }
 
370
  
 
371
  ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
 
372
                               mc->cred);
 
373
  if (ret != GNUTLS_E_SUCCESS) {
 
374
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
 
375
            safer_gnutls_strerror(ret));
 
376
    return -1;
 
377
  }
 
378
  
286
379
  /* ignore client certificate if any. */
287
 
  gnutls_certificate_server_set_request (es->session, GNUTLS_CERT_IGNORE);
 
380
  gnutls_certificate_server_set_request (*session,
 
381
                                         GNUTLS_CERT_IGNORE);
288
382
  
289
 
  gnutls_dh_set_prime_bits (es->session, DH_BITS);
 
383
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
290
384
  
291
385
  return 0;
292
386
}
293
387
 
294
 
void empty_log(AvahiLogLevel level, const char *txt){}
 
388
/* Avahi log function callback */
 
389
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
 
390
                      __attribute__((unused)) const char *txt){}
295
391
 
296
 
int start_mandos_communcation(char *ip, uint16_t port){
 
392
/* Called when a Mandos server is found */
 
393
static int start_mandos_communication(const char *ip, uint16_t port,
 
394
                                      AvahiIfIndex if_index,
 
395
                                      mandos_context *mc){
297
396
  int ret, tcp_sd;
298
397
  struct sockaddr_in6 to;
299
 
  struct in6_addr ip_addr;
300
 
  encrypted_session es;
301
398
  char *buffer = NULL;
302
399
  char *decrypted_buffer;
303
400
  size_t buffer_length = 0;
304
401
  size_t buffer_capacity = 0;
305
402
  ssize_t decrypted_buffer_size;
 
403
  size_t written;
306
404
  int retval = 0;
307
 
 
 
405
  char interface[IF_NAMESIZE];
 
406
  gnutls_session_t session;
 
407
  gnutls_dh_params_t dh_params;
 
408
  
 
409
  ret = initgnutls (mc, &session, &dh_params);
 
410
  if (ret != 0){
 
411
    return -1;
 
412
  }
 
413
  
 
414
  if(debug){
 
415
    fprintf(stderr, "Setting up a tcp connection to %s, port %d\n",
 
416
            ip, port);
 
417
  }
308
418
  
309
419
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
310
420
  if(tcp_sd < 0) {
311
421
    perror("socket");
312
422
    return -1;
313
423
  }
314
 
  
315
 
  ret = setsockopt(tcp_sd, SOL_SOCKET, SO_BINDTODEVICE, "eth0", 5);
316
 
  if(tcp_sd < 0) {
317
 
    perror("setsockopt bindtodevice");
318
 
    return -1;
 
424
 
 
425
  if(debug){
 
426
    if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
427
      perror("if_indextoname");
 
428
      return -1;
 
429
    }
 
430
    fprintf(stderr, "Binding to interface %s\n", interface);
319
431
  }
320
432
  
321
 
  memset(&to,0,sizeof(to));
 
433
  memset(&to,0,sizeof(to));     /* Spurious warning */
322
434
  to.sin6_family = AF_INET6;
323
 
  ret = inet_pton(AF_INET6, ip, &ip_addr);
 
435
  /* It would be nice to have a way to detect if we were passed an
 
436
     IPv4 address here.   Now we assume an IPv6 address. */
 
437
  ret = inet_pton(AF_INET6, ip, &to.sin6_addr);
324
438
  if (ret < 0 ){
325
439
    perror("inet_pton");
326
440
    return -1;
327
 
  }  
 
441
  }
328
442
  if(ret == 0){
329
443
    fprintf(stderr, "Bad address: %s\n", ip);
330
444
    return -1;
331
445
  }
332
 
  to.sin6_port = htons(port);
333
 
  to.sin6_scope_id = if_nametoindex("eth0");
 
446
  to.sin6_port = htons(port);   /* Spurious warning */
 
447
  
 
448
  to.sin6_scope_id = (uint32_t)if_index;
 
449
  
 
450
  if(debug){
 
451
    fprintf(stderr, "Connection to: %s, port %d\n", ip, port);
 
452
    char addrstr[INET6_ADDRSTRLEN] = "";
 
453
    if(inet_ntop(to.sin6_family, &(to.sin6_addr), addrstr,
 
454
                 sizeof(addrstr)) == NULL){
 
455
      perror("inet_ntop");
 
456
    } else {
 
457
      if(strcmp(addrstr, ip) != 0){
 
458
        fprintf(stderr, "Canonical address form: %s\n", addrstr);
 
459
      }
 
460
    }
 
461
  }
334
462
  
335
463
  ret = connect(tcp_sd, (struct sockaddr *) &to, sizeof(to));
336
464
  if (ret < 0){
337
465
    perror("connect");
338
466
    return -1;
339
467
  }
340
 
  
341
 
  ret = initgnutls (&es);
342
 
  if (ret != 0){
343
 
    retval = -1;
344
 
    return -1;
345
 
  }
346
 
    
347
 
  
348
 
  gnutls_transport_set_ptr (es.session, (gnutls_transport_ptr_t) tcp_sd);
349
468
 
350
 
  ret = gnutls_handshake (es.session);
 
469
  const char *out = mandos_protocol_version;
 
470
  written = 0;
 
471
  while (true){
 
472
    size_t out_size = strlen(out);
 
473
    ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
 
474
                                   out_size - written));
 
475
    if (ret == -1){
 
476
      perror("write");
 
477
      retval = -1;
 
478
      goto mandos_end;
 
479
    }
 
480
    written += (size_t)ret;
 
481
    if(written < out_size){
 
482
      continue;
 
483
    } else {
 
484
      if (out == mandos_protocol_version){
 
485
        written = 0;
 
486
        out = "\r\n";
 
487
      } else {
 
488
        break;
 
489
      }
 
490
    }
 
491
  }
 
492
 
 
493
  if(debug){
 
494
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
 
495
  }
 
496
  
 
497
  gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
 
498
  
 
499
  ret = gnutls_handshake (session);
351
500
  
352
501
  if (ret != GNUTLS_E_SUCCESS){
353
 
    fprintf(stderr, "\n*** Handshake failed ***\n");
354
 
    gnutls_perror (ret);
 
502
    if(debug){
 
503
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
 
504
      gnutls_perror (ret);
 
505
    }
355
506
    retval = -1;
356
 
    goto exit;
 
507
    goto mandos_end;
 
508
  }
 
509
  
 
510
  /* Read OpenPGP packet that contains the wanted password */
 
511
  
 
512
  if(debug){
 
513
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
 
514
            ip);
357
515
  }
358
516
 
359
 
  //retrive password
360
517
  while(true){
361
 
    if (buffer_length + BUFFER_SIZE > buffer_capacity){
362
 
      buffer = realloc(buffer, buffer_capacity + BUFFER_SIZE);
363
 
      if (buffer == NULL){
364
 
        perror("realloc");
365
 
        goto exit;
366
 
      }
367
 
      buffer_capacity += BUFFER_SIZE;
 
518
    buffer_capacity = adjustbuffer(&buffer, buffer_length, buffer_capacity);
 
519
    if (buffer_capacity == 0){
 
520
      perror("adjustbuffer");
 
521
      retval = -1;
 
522
      goto mandos_end;
368
523
    }
369
524
    
370
 
    ret = gnutls_record_recv
371
 
      (es.session, buffer+buffer_length, BUFFER_SIZE);
 
525
    ret = gnutls_record_recv(session, buffer+buffer_length,
 
526
                             BUFFER_SIZE);
372
527
    if (ret == 0){
373
528
      break;
374
529
    }
378
533
      case GNUTLS_E_AGAIN:
379
534
        break;
380
535
      case GNUTLS_E_REHANDSHAKE:
381
 
        ret = gnutls_handshake (es.session);
 
536
        ret = gnutls_handshake (session);
382
537
        if (ret < 0){
383
 
          fprintf(stderr, "\n*** Handshake failed ***\n");
 
538
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
384
539
          gnutls_perror (ret);
385
540
          retval = -1;
386
 
          goto exit;
 
541
          goto mandos_end;
387
542
        }
388
543
        break;
389
544
      default:
390
 
        fprintf(stderr, "Unknown error while reading data from encrypted session with mandos server\n");
 
545
        fprintf(stderr, "Unknown error while reading data from"
 
546
                " encrypted session with Mandos server\n");
391
547
        retval = -1;
392
 
        gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
393
 
        goto exit;
 
548
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
549
        goto mandos_end;
394
550
      }
395
551
    } else {
396
 
      buffer_length += ret;
 
552
      buffer_length += (size_t) ret;
397
553
    }
398
554
  }
399
 
 
 
555
  
 
556
  if(debug){
 
557
    fprintf(stderr, "Closing TLS session\n");
 
558
  }
 
559
  
 
560
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
561
  
400
562
  if (buffer_length > 0){
401
 
    if ((decrypted_buffer_size = gpg_packet_decrypt(buffer, buffer_length, &decrypted_buffer, CERT_ROOT)) == 0){
402
 
      retval = -1;
403
 
    } else {
404
 
      fwrite (decrypted_buffer, 1, decrypted_buffer_size, stdout);
 
563
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
 
564
                                               buffer_length,
 
565
                                               &decrypted_buffer,
 
566
                                               keydir);
 
567
    if (decrypted_buffer_size >= 0){
 
568
      written = 0;
 
569
      while(written < (size_t) decrypted_buffer_size){
 
570
        ret = (int)fwrite (decrypted_buffer + written, 1,
 
571
                           (size_t)decrypted_buffer_size - written,
 
572
                           stdout);
 
573
        if(ret == 0 and ferror(stdout)){
 
574
          if(debug){
 
575
            fprintf(stderr, "Error writing encrypted data: %s\n",
 
576
                    strerror(errno));
 
577
          }
 
578
          retval = -1;
 
579
          break;
 
580
        }
 
581
        written += (size_t)ret;
 
582
      }
405
583
      free(decrypted_buffer);
 
584
    } else {
 
585
      retval = -1;
406
586
    }
407
587
  }
408
 
 
 
588
  
 
589
  /* Shutdown procedure */
 
590
  
 
591
 mandos_end:
409
592
  free(buffer);
410
 
 
411
 
  //shutdown procedure
412
 
  gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
413
 
 exit:
414
593
  close(tcp_sd);
415
 
  gnutls_deinit (es.session);
416
 
  gnutls_certificate_free_credentials (es.cred);
 
594
  gnutls_deinit (session);
 
595
  gnutls_certificate_free_credentials (mc->cred);
417
596
  gnutls_global_deinit ();
418
597
  return retval;
419
598
}
420
599
 
421
 
static AvahiSimplePoll *simple_poll = NULL;
422
 
static AvahiServer *server = NULL;
423
 
 
424
 
static void resolve_callback(
425
 
    AvahiSServiceResolver *r,
426
 
    AVAHI_GCC_UNUSED AvahiIfIndex interface,
427
 
    AVAHI_GCC_UNUSED AvahiProtocol protocol,
428
 
    AvahiResolverEvent event,
429
 
    const char *name,
430
 
    const char *type,
431
 
    const char *domain,
432
 
    const char *host_name,
433
 
    const AvahiAddress *address,
434
 
    uint16_t port,
435
 
    AvahiStringList *txt,
436
 
    AvahiLookupResultFlags flags,
437
 
    AVAHI_GCC_UNUSED void* userdata) {
438
 
    
439
 
    assert(r);
440
 
 
441
 
    /* Called whenever a service has been resolved successfully or timed out */
442
 
 
443
 
    switch (event) {
444
 
        case AVAHI_RESOLVER_FAILURE:
445
 
            fprintf(stderr, "(Resolver) Failed to resolve service '%s' of type '%s' in domain '%s': %s\n", name, type, domain, avahi_strerror(avahi_server_errno(server)));
446
 
            break;
447
 
 
448
 
        case AVAHI_RESOLVER_FOUND: {
449
 
          char ip[AVAHI_ADDRESS_STR_MAX];
450
 
            avahi_address_snprint(ip, sizeof(ip), address);
451
 
            int ret = start_mandos_communcation(ip, port);
452
 
            if (ret == 0){
453
 
              exit(EXIT_SUCCESS);
454
 
            } else {
455
 
              exit(EXIT_FAILURE);
456
 
            }
457
 
        }
458
 
    }
459
 
    avahi_s_service_resolver_free(r);
460
 
}
461
 
 
462
 
static void browse_callback(
463
 
    AvahiSServiceBrowser *b,
464
 
    AvahiIfIndex interface,
465
 
    AvahiProtocol protocol,
466
 
    AvahiBrowserEvent event,
467
 
    const char *name,
468
 
    const char *type,
469
 
    const char *domain,
470
 
    AVAHI_GCC_UNUSED AvahiLookupResultFlags flags,
471
 
    void* userdata) {
472
 
    
473
 
    AvahiServer *s = userdata;
474
 
    assert(b);
475
 
 
476
 
    /* Called whenever a new services becomes available on the LAN or is removed from the LAN */
477
 
 
478
 
    switch (event) {
479
 
 
480
 
        case AVAHI_BROWSER_FAILURE:
481
 
            
482
 
            fprintf(stderr, "(Browser) %s\n", avahi_strerror(avahi_server_errno(server)));
483
 
            avahi_simple_poll_quit(simple_poll);
484
 
            return;
485
 
 
486
 
        case AVAHI_BROWSER_NEW:
487
 
            /* We ignore the returned resolver object. In the callback
488
 
               function we free it. If the server is terminated before
489
 
               the callback function is called the server will free
490
 
               the resolver for us. */
491
 
            
492
 
            if (!(avahi_s_service_resolver_new(s, interface, protocol, name, type, domain, AVAHI_PROTO_INET6, 0, resolve_callback, s)))
493
 
                fprintf(stderr, "Failed to resolve service '%s': %s\n", name, avahi_strerror(avahi_server_errno(s)));
494
 
            
495
 
            break;
496
 
 
497
 
        case AVAHI_BROWSER_REMOVE:
498
 
            break;
499
 
 
500
 
        case AVAHI_BROWSER_ALL_FOR_NOW:
501
 
        case AVAHI_BROWSER_CACHE_EXHAUSTED:
502
 
            break;
503
 
    }
504
 
}
505
 
 
506
 
int main(AVAHI_GCC_UNUSED int argc, AVAHI_GCC_UNUSED char*argv[]) {
507
 
    AvahiServerConfig config;
 
600
static void resolve_callback(AvahiSServiceResolver *r,
 
601
                             AvahiIfIndex interface,
 
602
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
603
                             AvahiResolverEvent event,
 
604
                             const char *name,
 
605
                             const char *type,
 
606
                             const char *domain,
 
607
                             const char *host_name,
 
608
                             const AvahiAddress *address,
 
609
                             uint16_t port,
 
610
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
 
611
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
612
                             flags,
 
613
                             void* userdata) {
 
614
  mandos_context *mc = userdata;
 
615
  assert(r);                    /* Spurious warning */
 
616
  
 
617
  /* Called whenever a service has been resolved successfully or
 
618
     timed out */
 
619
  
 
620
  switch (event) {
 
621
  default:
 
622
  case AVAHI_RESOLVER_FAILURE:
 
623
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
 
624
            " of type '%s' in domain '%s': %s\n", name, type, domain,
 
625
            avahi_strerror(avahi_server_errno(mc->server)));
 
626
    break;
 
627
    
 
628
  case AVAHI_RESOLVER_FOUND:
 
629
    {
 
630
      char ip[AVAHI_ADDRESS_STR_MAX];
 
631
      avahi_address_snprint(ip, sizeof(ip), address);
 
632
      if(debug){
 
633
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %d) on"
 
634
                " port %d\n", name, host_name, ip, interface, port);
 
635
      }
 
636
      int ret = start_mandos_communication(ip, port, interface, mc);
 
637
      if (ret == 0){
 
638
        exit(EXIT_SUCCESS);
 
639
      }
 
640
    }
 
641
  }
 
642
  avahi_s_service_resolver_free(r);
 
643
}
 
644
 
 
645
static void browse_callback( AvahiSServiceBrowser *b,
 
646
                             AvahiIfIndex interface,
 
647
                             AvahiProtocol protocol,
 
648
                             AvahiBrowserEvent event,
 
649
                             const char *name,
 
650
                             const char *type,
 
651
                             const char *domain,
 
652
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
653
                             flags,
 
654
                             void* userdata) {
 
655
  mandos_context *mc = userdata;
 
656
  assert(b);                    /* Spurious warning */
 
657
  
 
658
  /* Called whenever a new services becomes available on the LAN or
 
659
     is removed from the LAN */
 
660
  
 
661
  switch (event) {
 
662
  default:
 
663
  case AVAHI_BROWSER_FAILURE:
 
664
    
 
665
    fprintf(stderr, "(Avahi browser) %s\n",
 
666
            avahi_strerror(avahi_server_errno(mc->server)));
 
667
    avahi_simple_poll_quit(mc->simple_poll);
 
668
    return;
 
669
    
 
670
  case AVAHI_BROWSER_NEW:
 
671
    /* We ignore the returned Avahi resolver object. In the callback
 
672
       function we free it. If the Avahi server is terminated before
 
673
       the callback function is called the Avahi server will free the
 
674
       resolver for us. */
 
675
    
 
676
    if (!(avahi_s_service_resolver_new(mc->server, interface,
 
677
                                       protocol, name, type, domain,
 
678
                                       AVAHI_PROTO_INET6, 0,
 
679
                                       resolve_callback, mc)))
 
680
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
 
681
              name, avahi_strerror(avahi_server_errno(mc->server)));
 
682
    break;
 
683
    
 
684
  case AVAHI_BROWSER_REMOVE:
 
685
    break;
 
686
    
 
687
  case AVAHI_BROWSER_ALL_FOR_NOW:
 
688
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
 
689
    if(debug){
 
690
      fprintf(stderr, "No Mandos server found, still searching...\n");
 
691
    }
 
692
    break;
 
693
  }
 
694
}
 
695
 
 
696
/* Combines file name and path and returns the malloced new
 
697
   string. some sane checks could/should be added */
 
698
static const char *combinepath(const char *first, const char *second){
 
699
  size_t f_len = strlen(first);
 
700
  size_t s_len = strlen(second);
 
701
  char *tmp = malloc(f_len + s_len + 2);
 
702
  if (tmp == NULL){
 
703
    return NULL;
 
704
  }
 
705
  if(f_len > 0){
 
706
    memcpy(tmp, first, f_len);  /* Spurious warning */
 
707
  }
 
708
  tmp[f_len] = '/';
 
709
  if(s_len > 0){
 
710
    memcpy(tmp + f_len + 1, second, s_len); /* Spurious warning */
 
711
  }
 
712
  tmp[f_len + 1 + s_len] = '\0';
 
713
  return tmp;
 
714
}
 
715
 
 
716
 
 
717
int main(int argc, char *argv[]){
508
718
    AvahiSServiceBrowser *sb = NULL;
509
719
    int error;
510
 
    int ret = 1;
511
 
 
512
 
    avahi_set_log_function(empty_log);
513
 
    
514
 
    /* Initialize the psuedo-RNG */
515
 
    srand(time(NULL));
516
 
 
517
 
    /* Allocate main loop object */
518
 
    if (!(simple_poll = avahi_simple_poll_new())) {
519
 
        fprintf(stderr, "Failed to create simple poll object.\n");
520
 
        goto fail;
521
 
    }
522
 
 
523
 
    /* Do not publish any local records */
524
 
    avahi_server_config_init(&config);
525
 
    config.publish_hinfo = 0;
526
 
    config.publish_addresses = 0;
527
 
    config.publish_workstation = 0;
528
 
    config.publish_domain = 0;
529
 
 
530
 
/*     /\* Set a unicast DNS server for wide area DNS-SD *\/ */
531
 
/*     avahi_address_parse("193.11.177.11", AVAHI_PROTO_UNSPEC, &config.wide_area_servers[0]); */
532
 
/*     config.n_wide_area_servers = 1; */
533
 
/*     config.enable_wide_area = 1; */
534
 
    
535
 
    /* Allocate a new server */
536
 
    server = avahi_server_new(avahi_simple_poll_get(simple_poll), &config, NULL, NULL, &error);
537
 
 
538
 
    /* Free the configuration data */
539
 
    avahi_server_config_free(&config);
540
 
 
541
 
    /* Check wether creating the server object succeeded */
542
 
    if (!server) {
543
 
        fprintf(stderr, "Failed to create server: %s\n", avahi_strerror(error));
544
 
        goto fail;
545
 
    }
546
 
    
547
 
    /* Create the service browser */
548
 
    if (!(sb = avahi_s_service_browser_new(server, if_nametoindex("eth0"), AVAHI_PROTO_INET6, "_mandos._tcp", NULL, 0, browse_callback, server))) {
549
 
        fprintf(stderr, "Failed to create service browser: %s\n", avahi_strerror(avahi_server_errno(server)));
550
 
        goto fail;
 
720
    int ret;
 
721
    int exitcode = EXIT_SUCCESS;
 
722
    const char *interface = "eth0";
 
723
    struct ifreq network;
 
724
    int sd;
 
725
    char *connect_to = NULL;
 
726
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
 
727
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
 
728
                          .dh_bits = 1024, .priority = "SECURE256"};
 
729
    
 
730
    {
 
731
      /* Temporary int to get the address of for getopt_long */
 
732
      int debug_int = debug ? 1 : 0;
 
733
      while (true){
 
734
        struct option long_options[] = {
 
735
          {"debug", no_argument, &debug_int, 1},
 
736
          {"connect", required_argument, NULL, 'c'},
 
737
          {"interface", required_argument, NULL, 'i'},
 
738
          {"keydir", required_argument, NULL, 'd'},
 
739
          {"seckey", required_argument, NULL, 's'},
 
740
          {"pubkey", required_argument, NULL, 'p'},
 
741
          {"dh-bits", required_argument, NULL, 'D'},
 
742
          {"priority", required_argument, NULL, 'P'},
 
743
          {0, 0, 0, 0} };
 
744
      
 
745
        int option_index = 0;
 
746
        ret = getopt_long (argc, argv, "i:", long_options,
 
747
                           &option_index);
 
748
      
 
749
        if (ret == -1){
 
750
          break;
 
751
        }
 
752
      
 
753
        switch(ret){
 
754
        case 0:
 
755
          break;
 
756
        case 'i':
 
757
          interface = optarg;
 
758
          break;
 
759
        case 'c':
 
760
          connect_to = optarg;
 
761
          break;
 
762
        case 'd':
 
763
          keydir = optarg;
 
764
          break;
 
765
        case 'p':
 
766
          pubkeyfile = optarg;
 
767
          break;
 
768
        case 's':
 
769
          seckeyfile = optarg;
 
770
          break;
 
771
        case 'D':
 
772
          errno = 0;
 
773
          mc.dh_bits = (unsigned int) strtol(optarg, NULL, 10);
 
774
          if (errno){
 
775
            perror("strtol");
 
776
            exit(EXIT_FAILURE);
 
777
          }
 
778
          break;
 
779
        case 'P':
 
780
          mc.priority = optarg;
 
781
          break;
 
782
        case '?':
 
783
        default:
 
784
          /* getopt_long() has already printed a message about the
 
785
             unrcognized option, so just exit. */
 
786
          exit(EXIT_FAILURE);
 
787
        }
 
788
      }
 
789
      /* Set the global debug flag from the temporary int */
 
790
      debug = debug_int ? true : false;
 
791
    }
 
792
    
 
793
    pubkeyfile = combinepath(keydir, pubkeyfile);
 
794
    if (pubkeyfile == NULL){
 
795
      perror("combinepath");
 
796
      exitcode = EXIT_FAILURE;
 
797
      goto end;
 
798
    }
 
799
    
 
800
    seckeyfile = combinepath(keydir, seckeyfile);
 
801
    if (seckeyfile == NULL){
 
802
      perror("combinepath");
 
803
      goto end;
 
804
    }
 
805
    
 
806
    if_index = (AvahiIfIndex) if_nametoindex(interface);
 
807
    if(if_index == 0){
 
808
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
 
809
      exit(EXIT_FAILURE);
 
810
    }
 
811
    
 
812
    if(connect_to != NULL){
 
813
      /* Connect directly, do not use Zeroconf */
 
814
      /* (Mainly meant for debugging) */
 
815
      char *address = strrchr(connect_to, ':');
 
816
      if(address == NULL){
 
817
        fprintf(stderr, "No colon in address\n");
 
818
        exit(EXIT_FAILURE);
 
819
      }
 
820
      errno = 0;
 
821
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
 
822
      if(errno){
 
823
        perror("Bad port number");
 
824
        exit(EXIT_FAILURE);
 
825
      }
 
826
      *address = '\0';
 
827
      address = connect_to;
 
828
      ret = start_mandos_communication(address, port, if_index, &mc);
 
829
      if(ret < 0){
 
830
        exit(EXIT_FAILURE);
 
831
      } else {
 
832
        exit(EXIT_SUCCESS);
 
833
      }
 
834
    }
 
835
    
 
836
    /* If the interface is down, bring it up */
 
837
    {
 
838
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
839
      if(sd < 0) {
 
840
        perror("socket");
 
841
        exitcode = EXIT_FAILURE;
 
842
        goto end;
 
843
      }
 
844
      strcpy(network.ifr_name, interface); /* Spurious warning */
 
845
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
846
      if(ret == -1){
 
847
        perror("ioctl SIOCGIFFLAGS");
 
848
        exitcode = EXIT_FAILURE;
 
849
        goto end;
 
850
      }
 
851
      if((network.ifr_flags & IFF_UP) == 0){
 
852
        network.ifr_flags |= IFF_UP;
 
853
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
854
        if(ret == -1){
 
855
          perror("ioctl SIOCSIFFLAGS");
 
856
          exitcode = EXIT_FAILURE;
 
857
          goto end;
 
858
        }
 
859
      }
 
860
      close(sd);
 
861
    }
 
862
    
 
863
    if (not debug){
 
864
      avahi_set_log_function(empty_log);
 
865
    }
 
866
    
 
867
    /* Initialize the pseudo-RNG for Avahi */
 
868
    srand((unsigned int) time(NULL));
 
869
    
 
870
    /* Allocate main Avahi loop object */
 
871
    mc.simple_poll = avahi_simple_poll_new();
 
872
    if (mc.simple_poll == NULL) {
 
873
        fprintf(stderr, "Avahi: Failed to create simple poll"
 
874
                " object.\n");
 
875
        exitcode = EXIT_FAILURE;
 
876
        goto end;
 
877
    }
 
878
 
 
879
    {
 
880
      AvahiServerConfig config;
 
881
      /* Do not publish any local Zeroconf records */
 
882
      avahi_server_config_init(&config);
 
883
      config.publish_hinfo = 0;
 
884
      config.publish_addresses = 0;
 
885
      config.publish_workstation = 0;
 
886
      config.publish_domain = 0;
 
887
 
 
888
      /* Allocate a new server */
 
889
      mc.server = avahi_server_new(avahi_simple_poll_get
 
890
                                   (mc.simple_poll), &config, NULL,
 
891
                                   NULL, &error);
 
892
    
 
893
      /* Free the Avahi configuration data */
 
894
      avahi_server_config_free(&config);
 
895
    }
 
896
    
 
897
    /* Check if creating the Avahi server object succeeded */
 
898
    if (mc.server == NULL) {
 
899
        fprintf(stderr, "Failed to create Avahi server: %s\n",
 
900
                avahi_strerror(error));
 
901
        exitcode = EXIT_FAILURE;
 
902
        goto end;
 
903
    }
 
904
    
 
905
    /* Create the Avahi service browser */
 
906
    sb = avahi_s_service_browser_new(mc.server, if_index,
 
907
                                     AVAHI_PROTO_INET6,
 
908
                                     "_mandos._tcp", NULL, 0,
 
909
                                     browse_callback, &mc);
 
910
    if (sb == NULL) {
 
911
        fprintf(stderr, "Failed to create service browser: %s\n",
 
912
                avahi_strerror(avahi_server_errno(mc.server)));
 
913
        exitcode = EXIT_FAILURE;
 
914
        goto end;
551
915
    }
552
916
    
553
917
    /* Run the main loop */
554
 
    avahi_simple_poll_loop(simple_poll);
555
 
    
556
 
    ret = 0;
557
 
    
558
 
fail:
 
918
 
 
919
    if (debug){
 
920
      fprintf(stderr, "Starting Avahi loop search\n");
 
921
    }
 
922
    
 
923
    avahi_simple_poll_loop(mc.simple_poll);
 
924
    
 
925
 end:
 
926
 
 
927
    if (debug){
 
928
      fprintf(stderr, "%s exiting\n", argv[0]);
 
929
    }
559
930
    
560
931
    /* Cleanup things */
561
 
    if (sb)
 
932
    if (sb != NULL)
562
933
        avahi_s_service_browser_free(sb);
563
934
    
564
 
    if (server)
565
 
        avahi_server_free(server);
566
 
 
567
 
    if (simple_poll)
568
 
        avahi_simple_poll_free(simple_poll);
569
 
 
570
 
    return ret;
 
935
    if (mc.server != NULL)
 
936
        avahi_server_free(mc.server);
 
937
 
 
938
    if (mc.simple_poll != NULL)
 
939
        avahi_simple_poll_free(mc.simple_poll);
 
940
    free(pubkeyfile);
 
941
    free(seckeyfile);
 
942
    
 
943
    return exitcode;
571
944
}