/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

  • Committer: Björn Påhlsson
  • Date: 2008-07-20 02:52:20 UTC
  • Revision ID: belorn@braxen-20080720025220-r5u0388uy9iu23h6
Added following support:
Pluginbased client handler
rewritten Mandos client
       Avahi instead of udp server discovery
       openpgp encrypted key support
Passprompt stand alone application for direct console input
Added logging for Mandos server

Show diffs side-by-side

added added

removed removed

Lines of Context:
1
 
/*  -*- coding: utf-8 -*- */
2
 
/*
3
 
 * Mandos client - get and decrypt data from a Mandos server
 
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.
4
6
 *
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>.
 
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.
29
12
 */
30
13
 
31
 
/* Needed by GPGME, specifically gpgme_data_seek() */
 
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
 
32
33
#define _LARGEFILE_SOURCE
33
34
#define _FILE_OFFSET_BITS 64
34
35
 
35
 
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY() */
36
 
 
37
36
#include <stdio.h>
38
37
#include <assert.h>
39
38
#include <stdlib.h>
40
39
#include <time.h>
41
40
#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 */
46
41
 
47
42
#include <avahi-core/core.h>
48
43
#include <avahi-core/lookup.h>
51
46
#include <avahi-common/malloc.h>
52
47
#include <avahi-common/error.h>
53
48
 
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 */
 
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 */
60
54
 
61
55
#include <unistd.h>             /* close() */
62
56
#include <netinet/in.h>
64
58
#include <string.h>             /* memset */
65
59
#include <arpa/inet.h>          /* inet_pton() */
66
60
#include <iso646.h>             /* not */
67
 
#include <net/if.h>             /* IF_NAMESIZE */
68
61
 
69
 
/* GPGME */
 
62
// gpgme
70
63
#include <errno.h>              /* perror() */
71
64
#include <gpgme.h>
72
65
 
73
 
/* getopt_long */
74
 
#include <getopt.h>
75
66
 
 
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"
76
72
#define BUFFER_SIZE 256
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 */
 
73
#define DH_BITS 1024
 
74
 
87
75
typedef struct {
88
 
  AvahiSimplePoll *simple_poll;
89
 
  AvahiServer *server;
 
76
  gnutls_session_t session;
90
77
  gnutls_certificate_credentials_t cred;
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){
 
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){
115
83
  gpgme_data_t dh_crypto, dh_plain;
116
84
  gpgme_ctx_t ctx;
117
85
  gpgme_error_t rc;
118
86
  ssize_t ret;
119
 
  size_t plaintext_capacity = 0;
120
 
  ssize_t plaintext_length = 0;
 
87
  size_t new_packet_capacity = 0;
 
88
  size_t new_packet_length = 0;
121
89
  gpgme_engine_info_t engine_info;
122
 
  
123
 
  if (debug){
124
 
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
125
 
  }
126
 
  
 
90
 
127
91
  /* Init GPGME */
128
92
  gpgme_check_version(NULL);
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
 
  }
 
93
  gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
135
94
  
136
 
  /* Set GPGME home directory for the OpenPGP engine only */
 
95
  /* Set GPGME home directory */
137
96
  rc = gpgme_get_engine_info (&engine_info);
138
97
  if (rc != GPG_ERR_NO_ERROR){
139
98
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
149
108
    engine_info = engine_info->next;
150
109
  }
151
110
  if(engine_info == NULL){
152
 
    fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
 
111
    fprintf(stderr, "Could not set home dir to %s\n", homedir);
153
112
    return -1;
154
113
  }
155
114
  
156
 
  /* Create new GPGME data buffer from memory cryptotext */
157
 
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
158
 
                               0);
 
115
  /* Create new GPGME data buffer from packet buffer */
 
116
  rc = gpgme_data_new_from_mem(&dh_crypto, packet, packet_size, 0);
159
117
  if (rc != GPG_ERR_NO_ERROR){
160
118
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
161
119
            gpgme_strsource(rc), gpgme_strerror(rc));
167
125
  if (rc != GPG_ERR_NO_ERROR){
168
126
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
169
127
            gpgme_strsource(rc), gpgme_strerror(rc));
170
 
    gpgme_data_release(dh_crypto);
171
128
    return -1;
172
129
  }
173
130
  
176
133
  if (rc != GPG_ERR_NO_ERROR){
177
134
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
178
135
            gpgme_strsource(rc), gpgme_strerror(rc));
179
 
    plaintext_length = -1;
180
 
    goto decrypt_end;
 
136
    return -1;
181
137
  }
182
138
  
183
 
  /* Decrypt data from the cryptotext data buffer to the plaintext
184
 
     data buffer */
 
139
  /* Decrypt data from the FILE pointer to the plaintext data buffer */
185
140
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
186
141
  if (rc != GPG_ERR_NO_ERROR){
187
142
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
188
143
            gpgme_strsource(rc), gpgme_strerror(rc));
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
 
  }
 
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);
225
169
  
226
170
  /* Seek back to the beginning of the GPGME plaintext data buffer */
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;
 
171
  gpgme_data_seek(dh_plain, 0, SEEK_SET);
 
172
 
 
173
  *new_packet = 0;
234
174
  while(true){
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;
 
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;
241
182
    }
242
183
    
243
 
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
244
 
                          BUFFER_SIZE);
 
184
    ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length, BUFFER_SIZE);
245
185
    /* Print the data, if any */
246
186
    if (ret == 0){
247
 
      /* EOF */
 
187
      /* If password is empty, then a incorrect error will be printed */
248
188
      break;
249
189
    }
250
190
    if(ret < 0){
251
191
      perror("gpgme_data_read");
252
 
      plaintext_length = -1;
253
 
      goto decrypt_end;
 
192
      return -1;
254
193
    }
255
 
    plaintext_length += ret;
 
194
    new_packet_length += ret;
256
195
  }
257
196
 
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 */
 
197
   /* Delete the GPGME plaintext data buffer */
272
198
  gpgme_data_release(dh_plain);
273
 
  return plaintext_length;
 
199
  return new_packet_length;
274
200
}
275
201
 
276
202
static const char * safer_gnutls_strerror (int value) {
280
206
  return ret;
281
207
}
282
208
 
283
 
/* GnuTLS log function callback */
284
 
static void debuggnutls(__attribute__((unused)) int level,
285
 
                        const char* string){
286
 
  fprintf(stderr, "GnuTLS: %s", string);
 
209
void debuggnutls(int level, const char* string){
 
210
  fprintf(stderr, "%s", string);
287
211
}
288
212
 
289
 
static int initgnutls(mandos_context *mc, gnutls_session_t *session,
290
 
                      gnutls_dh_params_t *dh_params){
 
213
int initgnutls(encrypted_session *es){
 
214
  const char *err;
291
215
  int ret;
292
216
  
293
 
  if(debug){
294
 
    fprintf(stderr, "Initializing GnuTLS\n");
295
 
  }
296
 
 
297
217
  if ((ret = gnutls_global_init ())
298
218
      != GNUTLS_E_SUCCESS) {
299
 
    fprintf (stderr, "GnuTLS global_init: %s\n",
300
 
             safer_gnutls_strerror(ret));
 
219
    fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
301
220
    return -1;
302
221
  }
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))
 
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))
314
230
      != GNUTLS_E_SUCCESS) {
315
 
    fprintf (stderr, "GnuTLS memory error: %s\n",
316
 
             safer_gnutls_strerror(ret));
 
231
    fprintf (stderr, "memory error: %s\n", safer_gnutls_strerror(ret));
317
232
    return -1;
318
233
  }
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
 
  
 
234
 
326
235
  ret = gnutls_certificate_set_openpgp_key_file
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
 
  
 
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
 
379
286
  /* ignore client certificate if any. */
380
 
  gnutls_certificate_server_set_request (*session,
381
 
                                         GNUTLS_CERT_IGNORE);
 
287
  gnutls_certificate_server_set_request (es->session, GNUTLS_CERT_IGNORE);
382
288
  
383
 
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
 
289
  gnutls_dh_set_prime_bits (es->session, DH_BITS);
384
290
  
385
291
  return 0;
386
292
}
387
293
 
388
 
/* Avahi log function callback */
389
 
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
390
 
                      __attribute__((unused)) const char *txt){}
 
294
void empty_log(AvahiLogLevel level, const char *txt){}
391
295
 
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){
 
296
int start_mandos_communcation(char *ip, uint16_t port){
396
297
  int ret, tcp_sd;
397
298
  struct sockaddr_in6 to;
 
299
  struct in6_addr ip_addr;
 
300
  encrypted_session es;
398
301
  char *buffer = NULL;
399
302
  char *decrypted_buffer;
400
303
  size_t buffer_length = 0;
401
304
  size_t buffer_capacity = 0;
402
305
  ssize_t decrypted_buffer_size;
403
 
  size_t written;
404
306
  int retval = 0;
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
 
  }
 
307
 
418
308
  
419
309
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
420
310
  if(tcp_sd < 0) {
421
311
    perror("socket");
422
312
    return -1;
423
313
  }
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);
 
314
  
 
315
  ret = setsockopt(tcp_sd, SOL_SOCKET, SO_BINDTODEVICE, "eth0", 5);
 
316
  if(tcp_sd < 0) {
 
317
    perror("setsockopt bindtodevice");
 
318
    return -1;
431
319
  }
432
320
  
433
 
  memset(&to,0,sizeof(to));     /* Spurious warning */
 
321
  memset(&to,0,sizeof(to));
434
322
  to.sin6_family = AF_INET6;
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);
 
323
  ret = inet_pton(AF_INET6, ip, &ip_addr);
438
324
  if (ret < 0 ){
439
325
    perror("inet_pton");
440
326
    return -1;
441
 
  }
 
327
  }  
442
328
  if(ret == 0){
443
329
    fprintf(stderr, "Bad address: %s\n", ip);
444
330
    return -1;
445
331
  }
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
 
  }
 
332
  to.sin6_port = htons(port);
 
333
  to.sin6_scope_id = if_nametoindex("eth0");
462
334
  
463
335
  ret = connect(tcp_sd, (struct sockaddr *) &to, sizeof(to));
464
336
  if (ret < 0){
465
337
    perror("connect");
466
338
    return -1;
467
339
  }
 
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);
468
349
 
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);
 
350
  ret = gnutls_handshake (es.session);
500
351
  
501
352
  if (ret != GNUTLS_E_SUCCESS){
502
 
    if(debug){
503
 
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
504
 
      gnutls_perror (ret);
505
 
    }
 
353
    fprintf(stderr, "\n*** Handshake failed ***\n");
 
354
    gnutls_perror (ret);
506
355
    retval = -1;
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);
 
356
    goto exit;
515
357
  }
516
358
 
 
359
  //retrive password
517
360
  while(true){
518
 
    buffer_capacity = adjustbuffer(&buffer, buffer_length, buffer_capacity);
519
 
    if (buffer_capacity == 0){
520
 
      perror("adjustbuffer");
521
 
      retval = -1;
522
 
      goto mandos_end;
 
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;
523
368
    }
524
369
    
525
 
    ret = gnutls_record_recv(session, buffer+buffer_length,
526
 
                             BUFFER_SIZE);
 
370
    ret = gnutls_record_recv
 
371
      (es.session, buffer+buffer_length, BUFFER_SIZE);
527
372
    if (ret == 0){
528
373
      break;
529
374
    }
533
378
      case GNUTLS_E_AGAIN:
534
379
        break;
535
380
      case GNUTLS_E_REHANDSHAKE:
536
 
        ret = gnutls_handshake (session);
 
381
        ret = gnutls_handshake (es.session);
537
382
        if (ret < 0){
538
 
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
 
383
          fprintf(stderr, "\n*** Handshake failed ***\n");
539
384
          gnutls_perror (ret);
540
385
          retval = -1;
541
 
          goto mandos_end;
 
386
          goto exit;
542
387
        }
543
388
        break;
544
389
      default:
545
 
        fprintf(stderr, "Unknown error while reading data from"
546
 
                " encrypted session with Mandos server\n");
 
390
        fprintf(stderr, "Unknown error while reading data from encrypted session with mandos server\n");
547
391
        retval = -1;
548
 
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
549
 
        goto mandos_end;
 
392
        gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
 
393
        goto exit;
550
394
      }
551
395
    } else {
552
 
      buffer_length += (size_t) ret;
 
396
      buffer_length += ret;
553
397
    }
554
398
  }
555
 
  
556
 
  if(debug){
557
 
    fprintf(stderr, "Closing TLS session\n");
558
 
  }
559
 
  
560
 
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
561
 
  
 
399
 
562
400
  if (buffer_length > 0){
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
 
      }
 
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);
583
405
      free(decrypted_buffer);
584
 
    } else {
585
 
      retval = -1;
586
406
    }
587
407
  }
588
 
  
589
 
  /* Shutdown procedure */
590
 
  
591
 
 mandos_end:
 
408
 
592
409
  free(buffer);
 
410
 
 
411
  //shutdown procedure
 
412
  gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
 
413
 exit:
593
414
  close(tcp_sd);
594
 
  gnutls_deinit (session);
595
 
  gnutls_certificate_free_credentials (mc->cred);
 
415
  gnutls_deinit (es.session);
 
416
  gnutls_certificate_free_credentials (es.cred);
596
417
  gnutls_global_deinit ();
597
418
  return retval;
598
419
}
599
420
 
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[]){
 
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;
718
508
    AvahiSServiceBrowser *sb = NULL;
719
509
    int error;
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;
 
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;
915
551
    }
916
552
    
917
553
    /* Run the main loop */
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
 
    }
 
554
    avahi_simple_poll_loop(simple_poll);
 
555
    
 
556
    ret = 0;
 
557
    
 
558
fail:
930
559
    
931
560
    /* Cleanup things */
932
 
    if (sb != NULL)
 
561
    if (sb)
933
562
        avahi_s_service_browser_free(sb);
934
563
    
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;
 
564
    if (server)
 
565
        avahi_server_free(server);
 
566
 
 
567
    if (simple_poll)
 
568
        avahi_simple_poll_free(simple_poll);
 
569
 
 
570
    return ret;
944
571
}