/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: Teddy Hogeborn
  • Date: 2008-08-03 21:45:14 UTC
  • mfrom: (24.1.13 mandos)
  • Revision ID: teddy@fukt.bsnet.se-20080803214514-plvvkrpoitwsrxeg
Merge.

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;
 
91
  unsigned int dh_bits;
78
92
  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){
 
93
  const char *priority;
 
94
} mandos_context;
 
95
 
 
96
size_t adjustbuffer(char **buffer, size_t buffer_length,
 
97
                  size_t buffer_capacity){
 
98
  if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
99
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
 
100
    if (buffer == NULL){
 
101
      return 0;
 
102
    }
 
103
    buffer_capacity += BUFFER_SIZE;
 
104
  }
 
105
  return buffer_capacity;
 
106
}
 
107
 
 
108
/* 
 
109
 * Decrypt OpenPGP data using keyrings in HOMEDIR.
 
110
 * Returns -1 on error
 
111
 */
 
112
static ssize_t pgp_packet_decrypt (const char *cryptotext,
 
113
                                   size_t crypto_size,
 
114
                                   char **plaintext,
 
115
                                   const char *homedir){
83
116
  gpgme_data_t dh_crypto, dh_plain;
84
117
  gpgme_ctx_t ctx;
85
118
  gpgme_error_t rc;
86
119
  ssize_t ret;
87
 
  size_t new_packet_capacity = 0;
88
 
  size_t new_packet_length = 0;
 
120
  size_t plaintext_capacity = 0;
 
121
  ssize_t plaintext_length = 0;
89
122
  gpgme_engine_info_t engine_info;
90
 
 
 
123
  
 
124
  if (debug){
 
125
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
 
126
  }
 
127
  
91
128
  /* Init GPGME */
92
129
  gpgme_check_version(NULL);
93
 
  gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
 
130
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
 
131
  if (rc != GPG_ERR_NO_ERROR){
 
132
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
 
133
            gpgme_strsource(rc), gpgme_strerror(rc));
 
134
    return -1;
 
135
  }
94
136
  
95
 
  /* Set GPGME home directory */
 
137
  /* Set GPGME home directory for the OpenPGP engine only */
96
138
  rc = gpgme_get_engine_info (&engine_info);
97
139
  if (rc != GPG_ERR_NO_ERROR){
98
140
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
108
150
    engine_info = engine_info->next;
109
151
  }
110
152
  if(engine_info == NULL){
111
 
    fprintf(stderr, "Could not set home dir to %s\n", homedir);
 
153
    fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
112
154
    return -1;
113
155
  }
114
156
  
115
 
  /* Create new GPGME data buffer from packet buffer */
116
 
  rc = gpgme_data_new_from_mem(&dh_crypto, packet, packet_size, 0);
 
157
  /* Create new GPGME data buffer from memory cryptotext */
 
158
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
 
159
                               0);
117
160
  if (rc != GPG_ERR_NO_ERROR){
118
161
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
119
162
            gpgme_strsource(rc), gpgme_strerror(rc));
125
168
  if (rc != GPG_ERR_NO_ERROR){
126
169
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
127
170
            gpgme_strsource(rc), gpgme_strerror(rc));
 
171
    gpgme_data_release(dh_crypto);
128
172
    return -1;
129
173
  }
130
174
  
133
177
  if (rc != GPG_ERR_NO_ERROR){
134
178
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
135
179
            gpgme_strsource(rc), gpgme_strerror(rc));
136
 
    return -1;
 
180
    plaintext_length = -1;
 
181
    goto decrypt_end;
137
182
  }
138
183
  
139
 
  /* Decrypt data from the FILE pointer to the plaintext data buffer */
 
184
  /* Decrypt data from the cryptotext data buffer to the plaintext
 
185
     data buffer */
140
186
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
141
187
  if (rc != GPG_ERR_NO_ERROR){
142
188
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
143
189
            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);
 
190
    plaintext_length = -1;
 
191
    goto decrypt_end;
 
192
  }
 
193
  
 
194
  if(debug){
 
195
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
 
196
  }
 
197
  
 
198
  if (debug){
 
199
    gpgme_decrypt_result_t result;
 
200
    result = gpgme_op_decrypt_result(ctx);
 
201
    if (result == NULL){
 
202
      fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
203
    } else {
 
204
      fprintf(stderr, "Unsupported algorithm: %s\n",
 
205
              result->unsupported_algorithm);
 
206
      fprintf(stderr, "Wrong key usage: %d\n",
 
207
              result->wrong_key_usage);
 
208
      if(result->file_name != NULL){
 
209
        fprintf(stderr, "File name: %s\n", result->file_name);
 
210
      }
 
211
      gpgme_recipient_t recipient;
 
212
      recipient = result->recipients;
 
213
      if(recipient){
 
214
        while(recipient != NULL){
 
215
          fprintf(stderr, "Public key algorithm: %s\n",
 
216
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
 
217
          fprintf(stderr, "Key ID: %s\n", recipient->keyid);
 
218
          fprintf(stderr, "Secret key available: %s\n",
 
219
                  recipient->status == GPG_ERR_NO_SECKEY
 
220
                  ? "No" : "Yes");
 
221
          recipient = recipient->next;
 
222
        }
 
223
      }
 
224
    }
 
225
  }
169
226
  
170
227
  /* 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;
 
228
  if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
 
229
    perror("pgpme_data_seek");
 
230
    plaintext_length = -1;
 
231
    goto decrypt_end;
 
232
  }
 
233
  
 
234
  *plaintext = NULL;
174
235
  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;
 
236
    plaintext_capacity = adjustbuffer(plaintext, (size_t)plaintext_length,
 
237
                                      plaintext_capacity);
 
238
    if (plaintext_capacity == 0){
 
239
        perror("adjustbuffer");
 
240
        plaintext_length = -1;
 
241
        goto decrypt_end;
182
242
    }
183
243
    
184
 
    ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length, BUFFER_SIZE);
 
244
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
 
245
                          BUFFER_SIZE);
185
246
    /* Print the data, if any */
186
247
    if (ret == 0){
187
 
      /* If password is empty, then a incorrect error will be printed */
 
248
      /* EOF */
188
249
      break;
189
250
    }
190
251
    if(ret < 0){
191
252
      perror("gpgme_data_read");
192
 
      return -1;
 
253
      plaintext_length = -1;
 
254
      goto decrypt_end;
193
255
    }
194
 
    new_packet_length += ret;
 
256
    plaintext_length += ret;
195
257
  }
196
258
 
197
 
   /* Delete the GPGME plaintext data buffer */
 
259
  if(debug){
 
260
    fprintf(stderr, "Decrypted password is: ");
 
261
    for(ssize_t i = 0; i < plaintext_length; i++){
 
262
      fprintf(stderr, "%02hhX ", (*plaintext)[i]);
 
263
    }
 
264
    fprintf(stderr, "\n");
 
265
  }
 
266
  
 
267
 decrypt_end:
 
268
  
 
269
  /* Delete the GPGME cryptotext data buffer */
 
270
  gpgme_data_release(dh_crypto);
 
271
  
 
272
  /* Delete the GPGME plaintext data buffer */
198
273
  gpgme_data_release(dh_plain);
199
 
  return new_packet_length;
 
274
  return plaintext_length;
200
275
}
201
276
 
202
277
static const char * safer_gnutls_strerror (int value) {
206
281
  return ret;
207
282
}
208
283
 
209
 
void debuggnutls(int level, const char* string){
210
 
  fprintf(stderr, "%s", string);
 
284
/* GnuTLS log function callback */
 
285
static void debuggnutls(__attribute__((unused)) int level,
 
286
                        const char* string){
 
287
  fprintf(stderr, "GnuTLS: %s", string);
211
288
}
212
289
 
213
 
int initgnutls(encrypted_session *es){
214
 
  const char *err;
 
290
static int init_gnutls_global(mandos_context *mc){
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(&mc->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(mc->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, mc->dh_params);
 
352
 
 
353
  return 0;
 
354
}
 
355
 
 
356
static int init_gnutls_session(mandos_context *mc, gnutls_session_t *session){
 
357
  int ret;
 
358
  /* GnuTLS session creation */
 
359
  ret = gnutls_init(session, GNUTLS_SERVER);
 
360
  if (ret != GNUTLS_E_SUCCESS){
 
361
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
 
362
            safer_gnutls_strerror(ret));
 
363
  }
 
364
  
 
365
  {
 
366
    const char *err;
 
367
    ret = gnutls_priority_set_direct(*session, mc->priority, &err);
 
368
    if (ret != GNUTLS_E_SUCCESS) {
 
369
      fprintf(stderr, "Syntax error at: %s\n", err);
 
370
      fprintf(stderr, "GnuTLS error: %s\n",
 
371
              safer_gnutls_strerror(ret));
 
372
      return -1;
 
373
    }
 
374
  }
 
375
  
 
376
  ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
 
377
                               mc->cred);
 
378
  if (ret != GNUTLS_E_SUCCESS) {
 
379
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
 
380
            safer_gnutls_strerror(ret));
 
381
    return -1;
 
382
  }
 
383
  
286
384
  /* ignore client certificate if any. */
287
 
  gnutls_certificate_server_set_request (es->session, GNUTLS_CERT_IGNORE);
 
385
  gnutls_certificate_server_set_request (*session,
 
386
                                         GNUTLS_CERT_IGNORE);
288
387
  
289
 
  gnutls_dh_set_prime_bits (es->session, DH_BITS);
 
388
  gnutls_dh_set_prime_bits (*session, mc->dh_bits);
290
389
  
291
390
  return 0;
292
391
}
293
392
 
294
 
void empty_log(AvahiLogLevel level, const char *txt){}
 
393
/* Avahi log function callback */
 
394
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
 
395
                      __attribute__((unused)) const char *txt){}
295
396
 
296
 
int start_mandos_communcation(char *ip, uint16_t port){
 
397
/* Called when a Mandos server is found */
 
398
static int start_mandos_communication(const char *ip, uint16_t port,
 
399
                                      AvahiIfIndex if_index,
 
400
                                      mandos_context *mc){
297
401
  int ret, tcp_sd;
298
402
  struct sockaddr_in6 to;
299
 
  struct in6_addr ip_addr;
300
 
  encrypted_session es;
301
403
  char *buffer = NULL;
302
404
  char *decrypted_buffer;
303
405
  size_t buffer_length = 0;
304
406
  size_t buffer_capacity = 0;
305
407
  ssize_t decrypted_buffer_size;
 
408
  size_t written;
306
409
  int retval = 0;
307
 
 
 
410
  char interface[IF_NAMESIZE];
 
411
  gnutls_session_t session;
 
412
  gnutls_dh_params_t dh_params;
 
413
  
 
414
  ret = init_gnutls_session (mc, &session);
 
415
  if (ret != 0){
 
416
    return -1;
 
417
  }
 
418
  
 
419
  if(debug){
 
420
    fprintf(stderr, "Setting up a tcp connection to %s, port %d\n",
 
421
            ip, port);
 
422
  }
308
423
  
309
424
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
310
425
  if(tcp_sd < 0) {
311
426
    perror("socket");
312
427
    return -1;
313
428
  }
314
 
  
315
 
  ret = setsockopt(tcp_sd, SOL_SOCKET, SO_BINDTODEVICE, "eth0", 5);
316
 
  if(tcp_sd < 0) {
317
 
    perror("setsockopt bindtodevice");
318
 
    return -1;
 
429
 
 
430
  if(debug){
 
431
    if(if_indextoname((unsigned int)if_index, interface) == NULL){
 
432
      perror("if_indextoname");
 
433
      return -1;
 
434
    }
 
435
    fprintf(stderr, "Binding to interface %s\n", interface);
319
436
  }
320
437
  
321
 
  memset(&to,0,sizeof(to));
 
438
  memset(&to,0,sizeof(to));     /* Spurious warning */
322
439
  to.sin6_family = AF_INET6;
323
 
  ret = inet_pton(AF_INET6, ip, &ip_addr);
 
440
  /* It would be nice to have a way to detect if we were passed an
 
441
     IPv4 address here.   Now we assume an IPv6 address. */
 
442
  ret = inet_pton(AF_INET6, ip, &to.sin6_addr);
324
443
  if (ret < 0 ){
325
444
    perror("inet_pton");
326
445
    return -1;
327
 
  }  
 
446
  }
328
447
  if(ret == 0){
329
448
    fprintf(stderr, "Bad address: %s\n", ip);
330
449
    return -1;
331
450
  }
332
 
  to.sin6_port = htons(port);
333
 
  to.sin6_scope_id = if_nametoindex("eth0");
 
451
  to.sin6_port = htons(port);   /* Spurious warning */
 
452
  
 
453
  to.sin6_scope_id = (uint32_t)if_index;
 
454
  
 
455
  if(debug){
 
456
    fprintf(stderr, "Connection to: %s, port %d\n", ip, port);
 
457
    char addrstr[INET6_ADDRSTRLEN] = "";
 
458
    if(inet_ntop(to.sin6_family, &(to.sin6_addr), addrstr,
 
459
                 sizeof(addrstr)) == NULL){
 
460
      perror("inet_ntop");
 
461
    } else {
 
462
      if(strcmp(addrstr, ip) != 0){
 
463
        fprintf(stderr, "Canonical address form: %s\n", addrstr);
 
464
      }
 
465
    }
 
466
  }
334
467
  
335
468
  ret = connect(tcp_sd, (struct sockaddr *) &to, sizeof(to));
336
469
  if (ret < 0){
337
470
    perror("connect");
338
471
    return -1;
339
472
  }
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
473
 
350
 
  ret = gnutls_handshake (es.session);
 
474
  const char *out = mandos_protocol_version;
 
475
  written = 0;
 
476
  while (true){
 
477
    size_t out_size = strlen(out);
 
478
    ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
 
479
                                   out_size - written));
 
480
    if (ret == -1){
 
481
      perror("write");
 
482
      retval = -1;
 
483
      goto mandos_end;
 
484
    }
 
485
    written += (size_t)ret;
 
486
    if(written < out_size){
 
487
      continue;
 
488
    } else {
 
489
      if (out == mandos_protocol_version){
 
490
        written = 0;
 
491
        out = "\r\n";
 
492
      } else {
 
493
        break;
 
494
      }
 
495
    }
 
496
  }
 
497
 
 
498
  if(debug){
 
499
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
 
500
  }
 
501
  
 
502
  gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
 
503
  
 
504
  ret = gnutls_handshake (session);
351
505
  
352
506
  if (ret != GNUTLS_E_SUCCESS){
353
 
    fprintf(stderr, "\n*** Handshake failed ***\n");
354
 
    gnutls_perror (ret);
 
507
    if(debug){
 
508
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
 
509
      gnutls_perror (ret);
 
510
    }
355
511
    retval = -1;
356
 
    goto exit;
 
512
    goto mandos_end;
 
513
  }
 
514
  
 
515
  /* Read OpenPGP packet that contains the wanted password */
 
516
  
 
517
  if(debug){
 
518
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
 
519
            ip);
357
520
  }
358
521
 
359
 
  //retrive password
360
522
  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;
 
523
    buffer_capacity = adjustbuffer(&buffer, buffer_length, buffer_capacity);
 
524
    if (buffer_capacity == 0){
 
525
      perror("adjustbuffer");
 
526
      retval = -1;
 
527
      goto mandos_end;
368
528
    }
369
529
    
370
 
    ret = gnutls_record_recv
371
 
      (es.session, buffer+buffer_length, BUFFER_SIZE);
 
530
    ret = gnutls_record_recv(session, buffer+buffer_length,
 
531
                             BUFFER_SIZE);
372
532
    if (ret == 0){
373
533
      break;
374
534
    }
378
538
      case GNUTLS_E_AGAIN:
379
539
        break;
380
540
      case GNUTLS_E_REHANDSHAKE:
381
 
        ret = gnutls_handshake (es.session);
 
541
        ret = gnutls_handshake (session);
382
542
        if (ret < 0){
383
 
          fprintf(stderr, "\n*** Handshake failed ***\n");
 
543
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
384
544
          gnutls_perror (ret);
385
545
          retval = -1;
386
 
          goto exit;
 
546
          goto mandos_end;
387
547
        }
388
548
        break;
389
549
      default:
390
 
        fprintf(stderr, "Unknown error while reading data from encrypted session with mandos server\n");
 
550
        fprintf(stderr, "Unknown error while reading data from"
 
551
                " encrypted session with Mandos server\n");
391
552
        retval = -1;
392
 
        gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
393
 
        goto exit;
 
553
        gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
554
        goto mandos_end;
394
555
      }
395
556
    } else {
396
 
      buffer_length += ret;
 
557
      buffer_length += (size_t) ret;
397
558
    }
398
559
  }
399
 
 
 
560
  
 
561
  if(debug){
 
562
    fprintf(stderr, "Closing TLS session\n");
 
563
  }
 
564
  
 
565
  gnutls_bye (session, GNUTLS_SHUT_RDWR);
 
566
  
400
567
  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);
 
568
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
 
569
                                               buffer_length,
 
570
                                               &decrypted_buffer,
 
571
                                               keydir);
 
572
    if (decrypted_buffer_size >= 0){
 
573
      written = 0;
 
574
      while(written < (size_t) decrypted_buffer_size){
 
575
        ret = (int)fwrite (decrypted_buffer + written, 1,
 
576
                           (size_t)decrypted_buffer_size - written,
 
577
                           stdout);
 
578
        if(ret == 0 and ferror(stdout)){
 
579
          if(debug){
 
580
            fprintf(stderr, "Error writing encrypted data: %s\n",
 
581
                    strerror(errno));
 
582
          }
 
583
          retval = -1;
 
584
          break;
 
585
        }
 
586
        written += (size_t)ret;
 
587
      }
405
588
      free(decrypted_buffer);
 
589
    } else {
 
590
      retval = -1;
406
591
    }
407
592
  }
408
 
 
 
593
  
 
594
  /* Shutdown procedure */
 
595
  
 
596
 mandos_end:
409
597
  free(buffer);
410
 
 
411
 
  //shutdown procedure
412
 
  gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
413
 
 exit:
414
598
  close(tcp_sd);
415
 
  gnutls_deinit (es.session);
416
 
  gnutls_certificate_free_credentials (es.cred);
 
599
  gnutls_deinit (session);
 
600
  gnutls_certificate_free_credentials (mc->cred);
417
601
  gnutls_global_deinit ();
418
602
  return retval;
419
603
}
420
604
 
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;
 
605
static void resolve_callback(AvahiSServiceResolver *r,
 
606
                             AvahiIfIndex interface,
 
607
                             AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
608
                             AvahiResolverEvent event,
 
609
                             const char *name,
 
610
                             const char *type,
 
611
                             const char *domain,
 
612
                             const char *host_name,
 
613
                             const AvahiAddress *address,
 
614
                             uint16_t port,
 
615
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
 
616
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
617
                             flags,
 
618
                             void* userdata) {
 
619
  mandos_context *mc = userdata;
 
620
  assert(r);                    /* Spurious warning */
 
621
  
 
622
  /* Called whenever a service has been resolved successfully or
 
623
     timed out */
 
624
  
 
625
  switch (event) {
 
626
  default:
 
627
  case AVAHI_RESOLVER_FAILURE:
 
628
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
 
629
            " of type '%s' in domain '%s': %s\n", name, type, domain,
 
630
            avahi_strerror(avahi_server_errno(mc->server)));
 
631
    break;
 
632
    
 
633
  case AVAHI_RESOLVER_FOUND:
 
634
    {
 
635
      char ip[AVAHI_ADDRESS_STR_MAX];
 
636
      avahi_address_snprint(ip, sizeof(ip), address);
 
637
      if(debug){
 
638
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %d) on"
 
639
                " port %d\n", name, host_name, ip, interface, port);
 
640
      }
 
641
      int ret = start_mandos_communication(ip, port, interface, mc);
 
642
      if (ret == 0){
 
643
        exit(EXIT_SUCCESS);
 
644
      }
 
645
    }
 
646
  }
 
647
  avahi_s_service_resolver_free(r);
 
648
}
 
649
 
 
650
static void browse_callback( AvahiSServiceBrowser *b,
 
651
                             AvahiIfIndex interface,
 
652
                             AvahiProtocol protocol,
 
653
                             AvahiBrowserEvent event,
 
654
                             const char *name,
 
655
                             const char *type,
 
656
                             const char *domain,
 
657
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
 
658
                             flags,
 
659
                             void* userdata) {
 
660
  mandos_context *mc = userdata;
 
661
  assert(b);                    /* Spurious warning */
 
662
  
 
663
  /* Called whenever a new services becomes available on the LAN or
 
664
     is removed from the LAN */
 
665
  
 
666
  switch (event) {
 
667
  default:
 
668
  case AVAHI_BROWSER_FAILURE:
 
669
    
 
670
    fprintf(stderr, "(Avahi browser) %s\n",
 
671
            avahi_strerror(avahi_server_errno(mc->server)));
 
672
    avahi_simple_poll_quit(mc->simple_poll);
 
673
    return;
 
674
    
 
675
  case AVAHI_BROWSER_NEW:
 
676
    /* We ignore the returned Avahi resolver object. In the callback
 
677
       function we free it. If the Avahi server is terminated before
 
678
       the callback function is called the Avahi server will free the
 
679
       resolver for us. */
 
680
    
 
681
    if (!(avahi_s_service_resolver_new(mc->server, interface,
 
682
                                       protocol, name, type, domain,
 
683
                                       AVAHI_PROTO_INET6, 0,
 
684
                                       resolve_callback, mc)))
 
685
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
 
686
              name, avahi_strerror(avahi_server_errno(mc->server)));
 
687
    break;
 
688
    
 
689
  case AVAHI_BROWSER_REMOVE:
 
690
    break;
 
691
    
 
692
  case AVAHI_BROWSER_ALL_FOR_NOW:
 
693
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
 
694
    if(debug){
 
695
      fprintf(stderr, "No Mandos server found, still searching...\n");
 
696
    }
 
697
    break;
 
698
  }
 
699
}
 
700
 
 
701
/* Combines file name and path and returns the malloced new
 
702
   string. some sane checks could/should be added */
 
703
static const char *combinepath(const char *first, const char *second){
 
704
  size_t f_len = strlen(first);
 
705
  size_t s_len = strlen(second);
 
706
  char *tmp = malloc(f_len + s_len + 2);
 
707
  if (tmp == NULL){
 
708
    return NULL;
 
709
  }
 
710
  if(f_len > 0){
 
711
    memcpy(tmp, first, f_len);  /* Spurious warning */
 
712
  }
 
713
  tmp[f_len] = '/';
 
714
  if(s_len > 0){
 
715
    memcpy(tmp + f_len + 1, second, s_len); /* Spurious warning */
 
716
  }
 
717
  tmp[f_len + 1 + s_len] = '\0';
 
718
  return tmp;
 
719
}
 
720
 
 
721
 
 
722
int main(int argc, char *argv[]){
508
723
    AvahiSServiceBrowser *sb = NULL;
509
724
    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;
 
725
    int ret;
 
726
    int exitcode = EXIT_SUCCESS;
 
727
    const char *interface = "eth0";
 
728
    struct ifreq network;
 
729
    int sd;
 
730
    uid_t uid;
 
731
    gid_t gid;
 
732
    char *connect_to = NULL;
 
733
    AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
 
734
    mandos_context mc = { .simple_poll = NULL, .server = NULL,
 
735
                          .dh_bits = 1024, .priority = "SECURE256"};
 
736
    
 
737
    {
 
738
      /* Temporary int to get the address of for getopt_long */
 
739
      int debug_int = debug ? 1 : 0;
 
740
      while (true){
 
741
        struct option long_options[] = {
 
742
          {"debug", no_argument, &debug_int, 1},
 
743
          {"connect", required_argument, NULL, 'c'},
 
744
          {"interface", required_argument, NULL, 'i'},
 
745
          {"keydir", required_argument, NULL, 'd'},
 
746
          {"seckey", required_argument, NULL, 's'},
 
747
          {"pubkey", required_argument, NULL, 'p'},
 
748
          {"dh-bits", required_argument, NULL, 'D'},
 
749
          {"priority", required_argument, NULL, 'P'},
 
750
          {0, 0, 0, 0} };
 
751
      
 
752
        int option_index = 0;
 
753
        ret = getopt_long (argc, argv, "i:", long_options,
 
754
                           &option_index);
 
755
      
 
756
        if (ret == -1){
 
757
          break;
 
758
        }
 
759
      
 
760
        switch(ret){
 
761
        case 0:
 
762
          break;
 
763
        case 'i':
 
764
          interface = optarg;
 
765
          break;
 
766
        case 'c':
 
767
          connect_to = optarg;
 
768
          break;
 
769
        case 'd':
 
770
          keydir = optarg;
 
771
          break;
 
772
        case 'p':
 
773
          pubkeyfile = optarg;
 
774
          break;
 
775
        case 's':
 
776
          seckeyfile = optarg;
 
777
          break;
 
778
        case 'D':
 
779
          errno = 0;
 
780
          mc.dh_bits = (unsigned int) strtol(optarg, NULL, 10);
 
781
          if (errno){
 
782
            perror("strtol");
 
783
            exit(EXIT_FAILURE);
 
784
          }
 
785
          break;
 
786
        case 'P':
 
787
          mc.priority = optarg;
 
788
          break;
 
789
        case '?':
 
790
        default:
 
791
          /* getopt_long() has already printed a message about the
 
792
             unrcognized option, so just exit. */
 
793
          exit(EXIT_FAILURE);
 
794
        }
 
795
      }
 
796
      /* Set the global debug flag from the temporary int */
 
797
      debug = debug_int ? true : false;
 
798
    }
 
799
    
 
800
    pubkeyfile = combinepath(keydir, pubkeyfile);
 
801
    if (pubkeyfile == NULL){
 
802
      perror("combinepath");
 
803
      exitcode = EXIT_FAILURE;
 
804
      goto end;
 
805
    }
 
806
    
 
807
    seckeyfile = combinepath(keydir, seckeyfile);
 
808
    if (seckeyfile == NULL){
 
809
      perror("combinepath");
 
810
      goto end;
 
811
    }
 
812
 
 
813
    ret = init_gnutls_global(&mc);
 
814
    if (ret == -1){
 
815
      fprintf(stderr, "init_gnutls_global\n");
 
816
      goto end;
 
817
    }
 
818
 
 
819
    uid = getuid();
 
820
    gid = getgid();
 
821
 
 
822
    ret = setuid(uid);
 
823
    if (ret == -1){
 
824
      perror("setuid");
 
825
    }
 
826
    
 
827
    setgid(gid);
 
828
    if (ret == -1){
 
829
      perror("setgid");
 
830
    }
 
831
    
 
832
    if_index = (AvahiIfIndex) if_nametoindex(interface);
 
833
    if(if_index == 0){
 
834
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
 
835
      exit(EXIT_FAILURE);
 
836
    }
 
837
    
 
838
    if(connect_to != NULL){
 
839
      /* Connect directly, do not use Zeroconf */
 
840
      /* (Mainly meant for debugging) */
 
841
      char *address = strrchr(connect_to, ':');
 
842
      if(address == NULL){
 
843
        fprintf(stderr, "No colon in address\n");
 
844
        exitcode = EXIT_FAILURE;
 
845
        goto end;
 
846
      }
 
847
      errno = 0;
 
848
      uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
 
849
      if(errno){
 
850
        perror("Bad port number");
 
851
        exitcode = EXIT_FAILURE;
 
852
        goto end;
 
853
      }
 
854
      *address = '\0';
 
855
      address = connect_to;
 
856
      ret = start_mandos_communication(address, port, if_index, &mc);
 
857
      if(ret < 0){
 
858
        exitcode = EXIT_FAILURE;
 
859
      } else {
 
860
        exitcode = EXIT_SUCCESS;
 
861
      }
 
862
      goto end;
 
863
    }
 
864
    
 
865
    /* If the interface is down, bring it up */
 
866
    {
 
867
      sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
 
868
      if(sd < 0) {
 
869
        perror("socket");
 
870
        exitcode = EXIT_FAILURE;
 
871
        goto end;
 
872
      }
 
873
      strcpy(network.ifr_name, interface); /* Spurious warning */
 
874
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
 
875
      if(ret == -1){
 
876
        perror("ioctl SIOCGIFFLAGS");
 
877
        exitcode = EXIT_FAILURE;
 
878
        goto end;
 
879
      }
 
880
      if((network.ifr_flags & IFF_UP) == 0){
 
881
        network.ifr_flags |= IFF_UP;
 
882
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
 
883
        if(ret == -1){
 
884
          perror("ioctl SIOCSIFFLAGS");
 
885
          exitcode = EXIT_FAILURE;
 
886
          goto end;
 
887
        }
 
888
      }
 
889
      close(sd);
 
890
    }
 
891
    
 
892
    if (not debug){
 
893
      avahi_set_log_function(empty_log);
 
894
    }
 
895
    
 
896
    /* Initialize the pseudo-RNG for Avahi */
 
897
    srand((unsigned int) time(NULL));
 
898
    
 
899
    /* Allocate main Avahi loop object */
 
900
    mc.simple_poll = avahi_simple_poll_new();
 
901
    if (mc.simple_poll == NULL) {
 
902
        fprintf(stderr, "Avahi: Failed to create simple poll"
 
903
                " object.\n");
 
904
        exitcode = EXIT_FAILURE;
 
905
        goto end;
 
906
    }
 
907
 
 
908
    {
 
909
      AvahiServerConfig config;
 
910
      /* Do not publish any local Zeroconf records */
 
911
      avahi_server_config_init(&config);
 
912
      config.publish_hinfo = 0;
 
913
      config.publish_addresses = 0;
 
914
      config.publish_workstation = 0;
 
915
      config.publish_domain = 0;
 
916
 
 
917
      /* Allocate a new server */
 
918
      mc.server = avahi_server_new(avahi_simple_poll_get
 
919
                                   (mc.simple_poll), &config, NULL,
 
920
                                   NULL, &error);
 
921
    
 
922
      /* Free the Avahi configuration data */
 
923
      avahi_server_config_free(&config);
 
924
    }
 
925
    
 
926
    /* Check if creating the Avahi server object succeeded */
 
927
    if (mc.server == NULL) {
 
928
        fprintf(stderr, "Failed to create Avahi server: %s\n",
 
929
                avahi_strerror(error));
 
930
        exitcode = EXIT_FAILURE;
 
931
        goto end;
 
932
    }
 
933
    
 
934
    /* Create the Avahi service browser */
 
935
    sb = avahi_s_service_browser_new(mc.server, if_index,
 
936
                                     AVAHI_PROTO_INET6,
 
937
                                     "_mandos._tcp", NULL, 0,
 
938
                                     browse_callback, &mc);
 
939
    if (sb == NULL) {
 
940
        fprintf(stderr, "Failed to create service browser: %s\n",
 
941
                avahi_strerror(avahi_server_errno(mc.server)));
 
942
        exitcode = EXIT_FAILURE;
 
943
        goto end;
551
944
    }
552
945
    
553
946
    /* Run the main loop */
554
 
    avahi_simple_poll_loop(simple_poll);
555
 
    
556
 
    ret = 0;
557
 
    
558
 
fail:
 
947
 
 
948
    if (debug){
 
949
      fprintf(stderr, "Starting Avahi loop search\n");
 
950
    }
 
951
    
 
952
    avahi_simple_poll_loop(mc.simple_poll);
 
953
    
 
954
 end:
 
955
 
 
956
    if (debug){
 
957
      fprintf(stderr, "%s exiting\n", argv[0]);
 
958
    }
559
959
    
560
960
    /* Cleanup things */
561
 
    if (sb)
 
961
    if (sb != NULL)
562
962
        avahi_s_service_browser_free(sb);
563
963
    
564
 
    if (server)
565
 
        avahi_server_free(server);
566
 
 
567
 
    if (simple_poll)
568
 
        avahi_simple_poll_free(simple_poll);
569
 
 
570
 
    return ret;
 
964
    if (mc.server != NULL)
 
965
        avahi_server_free(mc.server);
 
966
 
 
967
    if (mc.simple_poll != NULL)
 
968
        avahi_simple_poll_free(mc.simple_poll);
 
969
    free(pubkeyfile);
 
970
    free(seckeyfile);
 
971
    
 
972
    return exitcode;
571
973
}