/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-07-21 02:33:00 UTC
  • Revision ID: teddy@fukt.bsnet.se-20080721023300-c4t0cq7sxit973py
* plugins.d/Makefile: Removed

* plugins.d/mandosclient.c (start_mandos_communcation): Bug fix: write
                                                        server IP
                                                        address to
                                                        "to" struct.

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
4
 
 *
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 © 2008-2010 Teddy Hogeborn
13
 
 * Copyright © 2008-2010 Björn Påhlsson
14
 
 * 
15
 
 * This program is free software: you can redistribute it and/or
16
 
 * modify it under the terms of the GNU General Public License as
17
 
 * published by the Free Software Foundation, either version 3 of the
18
 
 * License, or (at your option) any later version.
19
 
 * 
20
 
 * This program is distributed in the hope that it will be useful, but
21
 
 * WITHOUT ANY WARRANTY; without even the implied warranty of
22
 
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
23
 
 * General Public License for more details.
24
 
 * 
25
 
 * You should have received a copy of the GNU General Public License
26
 
 * along with this program.  If not, see
27
 
 * <http://www.gnu.org/licenses/>.
28
 
 * 
29
 
 * Contact the authors at <mandos@fukt.bsnet.se>.
30
 
 */
 
1
/***
 
2
  This file is part of avahi.
 
3
 
 
4
  avahi is free software; you can redistribute it and/or modify it
 
5
  under the terms of the GNU Lesser General Public License as
 
6
  published by the Free Software Foundation; either version 2.1 of the
 
7
  License, or (at your option) any later version.
 
8
 
 
9
  avahi is distributed in the hope that it will be useful, but WITHOUT
 
10
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 
11
  or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General
 
12
  Public License for more details.
 
13
 
 
14
  You should have received a copy of the GNU Lesser General Public
 
15
  License along with avahi; if not, write to the Free Software
 
16
  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
 
17
  USA.
 
18
***/
31
19
 
32
 
/* Needed by GPGME, specifically gpgme_data_seek() */
33
 
#ifndef _LARGEFILE_SOURCE
34
20
#define _LARGEFILE_SOURCE
35
 
#endif
36
 
#ifndef _FILE_OFFSET_BITS
37
21
#define _FILE_OFFSET_BITS 64
38
 
#endif
39
 
 
40
 
#define _GNU_SOURCE             /* TEMP_FAILURE_RETRY(), asprintf() */
41
 
 
42
 
#include <stdio.h>              /* fprintf(), stderr, fwrite(),
43
 
                                   stdout, ferror(), remove() */
44
 
#include <stdint.h>             /* uint16_t, uint32_t */
45
 
#include <stddef.h>             /* NULL, size_t, ssize_t */
46
 
#include <stdlib.h>             /* free(), EXIT_SUCCESS, srand(),
47
 
                                   strtof(), abort() */
48
 
#include <stdbool.h>            /* bool, false, true */
49
 
#include <string.h>             /* memset(), strcmp(), strlen(),
50
 
                                   strerror(), asprintf(), strcpy() */
51
 
#include <sys/ioctl.h>          /* ioctl */
52
 
#include <sys/types.h>          /* socket(), inet_pton(), sockaddr,
53
 
                                   sockaddr_in6, PF_INET6,
54
 
                                   SOCK_STREAM, uid_t, gid_t, open(),
55
 
                                   opendir(), DIR */
56
 
#include <sys/stat.h>           /* open() */
57
 
#include <sys/socket.h>         /* socket(), struct sockaddr_in6,
58
 
                                   inet_pton(), connect() */
59
 
#include <fcntl.h>              /* open() */
60
 
#include <dirent.h>             /* opendir(), struct dirent, readdir()
61
 
                                 */
62
 
#include <inttypes.h>           /* PRIu16, PRIdMAX, intmax_t,
63
 
                                   strtoimax() */
64
 
#include <assert.h>             /* assert() */
65
 
#include <errno.h>              /* perror(), errno */
66
 
#include <time.h>               /* nanosleep(), time(), sleep() */
67
 
#include <net/if.h>             /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
68
 
                                   SIOCSIFFLAGS, if_indextoname(),
69
 
                                   if_nametoindex(), IF_NAMESIZE */
70
 
#include <netinet/in.h>         /* IN6_IS_ADDR_LINKLOCAL,
71
 
                                   INET_ADDRSTRLEN, INET6_ADDRSTRLEN
72
 
                                */
73
 
#include <unistd.h>             /* close(), SEEK_SET, off_t, write(),
74
 
                                   getuid(), getgid(), seteuid(),
75
 
                                   setgid(), pause() */
76
 
#include <arpa/inet.h>          /* inet_pton(), htons */
77
 
#include <iso646.h>             /* not, or, and */
78
 
#include <argp.h>               /* struct argp_option, error_t, struct
79
 
                                   argp_state, struct argp,
80
 
                                   argp_parse(), ARGP_KEY_ARG,
81
 
                                   ARGP_KEY_END, ARGP_ERR_UNKNOWN */
82
 
#include <signal.h>             /* sigemptyset(), sigaddset(),
83
 
                                   sigaction(), SIGTERM, sig_atomic_t,
84
 
                                   raise() */
85
 
#include <sysexits.h>           /* EX_OSERR, EX_USAGE, EX_UNAVAILABLE,
86
 
                                   EX_NOHOST, EX_IOERR, EX_PROTOCOL */
87
 
 
88
 
#ifdef __linux__
89
 
#include <sys/klog.h>           /* klogctl() */
90
 
#endif  /* __linux__ */
91
 
 
92
 
/* Avahi */
93
 
/* All Avahi types, constants and functions
94
 
 Avahi*, avahi_*,
95
 
 AVAHI_* */
 
22
 
 
23
#include <stdio.h>
 
24
#include <assert.h>
 
25
#include <stdlib.h>
 
26
#include <time.h>
 
27
#include <net/if.h>             /* if_nametoindex */
 
28
 
96
29
#include <avahi-core/core.h>
97
30
#include <avahi-core/lookup.h>
98
31
#include <avahi-core/log.h>
100
33
#include <avahi-common/malloc.h>
101
34
#include <avahi-common/error.h>
102
35
 
103
 
/* GnuTLS */
104
 
#include <gnutls/gnutls.h>      /* All GnuTLS types, constants and
105
 
                                   functions:
106
 
                                   gnutls_*
107
 
                                   init_gnutls_session(),
108
 
                                   GNUTLS_* */
109
 
#include <gnutls/openpgp.h>
110
 
                          /* gnutls_certificate_set_openpgp_key_file(),
111
 
                                   GNUTLS_OPENPGP_FMT_BASE64 */
112
 
 
113
 
/* GPGME */
114
 
#include <gpgme.h>              /* All GPGME types, constants and
115
 
                                   functions:
116
 
                                   gpgme_*
117
 
                                   GPGME_PROTOCOL_OpenPGP,
118
 
                                   GPG_ERR_NO_* */
119
 
 
 
36
//mandos client part
 
37
#include <sys/types.h>          /* socket(), setsockopt(), inet_pton() */
 
38
#include <sys/socket.h>         /* socket(), setsockopt(), struct sockaddr_in6, struct in6_addr, inet_pton() */
 
39
#include <gnutls/gnutls.h>      /* ALL GNUTLS STUFF */
 
40
#include <gnutls/openpgp.h>     /* gnutls with openpgp stuff */
 
41
 
 
42
#include <unistd.h>             /* close() */
 
43
#include <netinet/in.h>
 
44
#include <stdbool.h>            /* true */
 
45
#include <string.h>             /* memset */
 
46
#include <arpa/inet.h>          /* inet_pton() */
 
47
#include <iso646.h>             /* not */
 
48
 
 
49
// gpgme
 
50
#include <errno.h>              /* perror() */
 
51
#include <gpgme.h>
 
52
 
 
53
 
 
54
#ifndef CERT_ROOT
 
55
#define CERT_ROOT "/conf/conf.d/cryptkeyreq/"
 
56
#endif
 
57
#define CERTFILE CERT_ROOT "openpgp-client.txt"
 
58
#define KEYFILE CERT_ROOT "openpgp-client-key.txt"
120
59
#define BUFFER_SIZE 256
121
 
 
122
 
#define PATHDIR "/conf/conf.d/mandos"
123
 
#define SECKEY "seckey.txt"
124
 
#define PUBKEY "pubkey.txt"
 
60
#define DH_BITS 1024
125
61
 
126
62
bool debug = false;
127
 
static const char mandos_protocol_version[] = "1";
128
 
const char *argp_program_version = "mandos-client " VERSION;
129
 
const char *argp_program_bug_address = "<mandos@fukt.bsnet.se>";
130
 
static const char sys_class_net[] = "/sys/class/net";
131
 
char *connect_to = NULL;
132
63
 
133
 
/* Used for passing in values through the Avahi callback functions */
134
64
typedef struct {
135
 
  AvahiSimplePoll *simple_poll;
136
 
  AvahiServer *server;
 
65
  gnutls_session_t session;
137
66
  gnutls_certificate_credentials_t cred;
138
 
  unsigned int dh_bits;
139
67
  gnutls_dh_params_t dh_params;
140
 
  const char *priority;
 
68
} encrypted_session;
 
69
 
 
70
 
 
71
ssize_t gpg_packet_decrypt (char *packet, size_t packet_size, char **new_packet, char *homedir){
 
72
  gpgme_data_t dh_crypto, dh_plain;
141
73
  gpgme_ctx_t ctx;
142
 
} mandos_context;
143
 
 
144
 
/* global context so signal handler can reach it*/
145
 
mandos_context mc = { .simple_poll = NULL, .server = NULL,
146
 
                      .dh_bits = 1024, .priority = "SECURE256"
147
 
                      ":!CTYPE-X.509:+CTYPE-OPENPGP" };
148
 
 
149
 
sig_atomic_t quit_now = 0;
150
 
int signal_received = 0;
151
 
 
152
 
/*
153
 
 * Make additional room in "buffer" for at least BUFFER_SIZE more
154
 
 * bytes. "buffer_capacity" is how much is currently allocated,
155
 
 * "buffer_length" is how much is already used.
156
 
 */
157
 
size_t incbuffer(char **buffer, size_t buffer_length,
158
 
                  size_t buffer_capacity){
159
 
  if(buffer_length + BUFFER_SIZE > buffer_capacity){
160
 
    *buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
161
 
    if(buffer == NULL){
162
 
      return 0;
163
 
    }
164
 
    buffer_capacity += BUFFER_SIZE;
165
 
  }
166
 
  return buffer_capacity;
167
 
}
168
 
 
169
 
/* 
170
 
 * Initialize GPGME.
171
 
 */
172
 
static bool init_gpgme(const char *seckey,
173
 
                       const char *pubkey, const char *tempdir){
174
74
  gpgme_error_t rc;
 
75
  ssize_t ret;
 
76
  size_t new_packet_capacity = 0;
 
77
  size_t new_packet_length = 0;
175
78
  gpgme_engine_info_t engine_info;
176
 
  
177
 
  
178
 
  /*
179
 
   * Helper function to insert pub and seckey to the engine keyring.
180
 
   */
181
 
  bool import_key(const char *filename){
182
 
    int ret;
183
 
    int fd;
184
 
    gpgme_data_t pgp_data;
185
 
    
186
 
    fd = (int)TEMP_FAILURE_RETRY(open(filename, O_RDONLY));
187
 
    if(fd == -1){
188
 
      perror("open");
189
 
      return false;
190
 
    }
191
 
    
192
 
    rc = gpgme_data_new_from_fd(&pgp_data, fd);
193
 
    if(rc != GPG_ERR_NO_ERROR){
194
 
      fprintf(stderr, "bad gpgme_data_new_from_fd: %s: %s\n",
195
 
              gpgme_strsource(rc), gpgme_strerror(rc));
196
 
      return false;
197
 
    }
198
 
    
199
 
    rc = gpgme_op_import(mc.ctx, pgp_data);
200
 
    if(rc != GPG_ERR_NO_ERROR){
201
 
      fprintf(stderr, "bad gpgme_op_import: %s: %s\n",
202
 
              gpgme_strsource(rc), gpgme_strerror(rc));
203
 
      return false;
204
 
    }
205
 
    
206
 
    ret = (int)TEMP_FAILURE_RETRY(close(fd));
207
 
    if(ret == -1){
208
 
      perror("close");
209
 
    }
210
 
    gpgme_data_release(pgp_data);
211
 
    return true;
212
 
  }
213
 
  
214
 
  if(debug){
215
 
    fprintf(stderr, "Initializing GPGME\n");
 
79
 
 
80
  if (debug){
 
81
    fprintf(stderr, "Attempting to decrypt password from gpg packet\n");
216
82
  }
217
83
  
218
84
  /* Init GPGME */
219
85
  gpgme_check_version(NULL);
220
 
  rc = gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
221
 
  if(rc != GPG_ERR_NO_ERROR){
222
 
    fprintf(stderr, "bad gpgme_engine_check_version: %s: %s\n",
223
 
            gpgme_strsource(rc), gpgme_strerror(rc));
224
 
    return false;
225
 
  }
 
86
  gpgme_engine_check_version(GPGME_PROTOCOL_OpenPGP);
226
87
  
227
 
    /* Set GPGME home directory for the OpenPGP engine only */
228
 
  rc = gpgme_get_engine_info(&engine_info);
229
 
  if(rc != GPG_ERR_NO_ERROR){
 
88
  /* Set GPGME home directory */
 
89
  rc = gpgme_get_engine_info (&engine_info);
 
90
  if (rc != GPG_ERR_NO_ERROR){
230
91
    fprintf(stderr, "bad gpgme_get_engine_info: %s: %s\n",
231
92
            gpgme_strsource(rc), gpgme_strerror(rc));
232
 
    return false;
 
93
    return -1;
233
94
  }
234
95
  while(engine_info != NULL){
235
96
    if(engine_info->protocol == GPGME_PROTOCOL_OpenPGP){
236
97
      gpgme_set_engine_info(GPGME_PROTOCOL_OpenPGP,
237
 
                            engine_info->file_name, tempdir);
 
98
                            engine_info->file_name, homedir);
238
99
      break;
239
100
    }
240
101
    engine_info = engine_info->next;
241
102
  }
242
103
  if(engine_info == NULL){
243
 
    fprintf(stderr, "Could not set GPGME home dir to %s\n", tempdir);
244
 
    return false;
245
 
  }
246
 
  
247
 
  /* Create new GPGME "context" */
248
 
  rc = gpgme_new(&(mc.ctx));
249
 
  if(rc != GPG_ERR_NO_ERROR){
250
 
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
251
 
            gpgme_strsource(rc), gpgme_strerror(rc));
252
 
    return false;
253
 
  }
254
 
  
255
 
  if(not import_key(pubkey) or not import_key(seckey)){
256
 
    return false;
257
 
  }
258
 
  
259
 
  return true;
260
 
}
261
 
 
262
 
/* 
263
 
 * Decrypt OpenPGP data.
264
 
 * Returns -1 on error
265
 
 */
266
 
static ssize_t pgp_packet_decrypt(const char *cryptotext,
267
 
                                  size_t crypto_size,
268
 
                                  char **plaintext){
269
 
  gpgme_data_t dh_crypto, dh_plain;
270
 
  gpgme_error_t rc;
271
 
  ssize_t ret;
272
 
  size_t plaintext_capacity = 0;
273
 
  ssize_t plaintext_length = 0;
274
 
  
275
 
  if(debug){
276
 
    fprintf(stderr, "Trying to decrypt OpenPGP data\n");
277
 
  }
278
 
  
279
 
  /* Create new GPGME data buffer from memory cryptotext */
280
 
  rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
281
 
                               0);
282
 
  if(rc != GPG_ERR_NO_ERROR){
 
104
    fprintf(stderr, "Could not set home dir to %s\n", homedir);
 
105
    return -1;
 
106
  }
 
107
  
 
108
  /* Create new GPGME data buffer from packet buffer */
 
109
  rc = gpgme_data_new_from_mem(&dh_crypto, packet, packet_size, 0);
 
110
  if (rc != GPG_ERR_NO_ERROR){
283
111
    fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
284
112
            gpgme_strsource(rc), gpgme_strerror(rc));
285
113
    return -1;
287
115
  
288
116
  /* Create new empty GPGME data buffer for the plaintext */
289
117
  rc = gpgme_data_new(&dh_plain);
290
 
  if(rc != GPG_ERR_NO_ERROR){
 
118
  if (rc != GPG_ERR_NO_ERROR){
291
119
    fprintf(stderr, "bad gpgme_data_new: %s: %s\n",
292
120
            gpgme_strsource(rc), gpgme_strerror(rc));
293
 
    gpgme_data_release(dh_crypto);
294
 
    return -1;
295
 
  }
296
 
  
297
 
  /* Decrypt data from the cryptotext data buffer to the plaintext
298
 
     data buffer */
299
 
  rc = gpgme_op_decrypt(mc.ctx, dh_crypto, dh_plain);
300
 
  if(rc != GPG_ERR_NO_ERROR){
 
121
    return -1;
 
122
  }
 
123
  
 
124
  /* Create new GPGME "context" */
 
125
  rc = gpgme_new(&ctx);
 
126
  if (rc != GPG_ERR_NO_ERROR){
 
127
    fprintf(stderr, "bad gpgme_new: %s: %s\n",
 
128
            gpgme_strsource(rc), gpgme_strerror(rc));
 
129
    return -1;
 
130
  }
 
131
  
 
132
  /* Decrypt data from the FILE pointer to the plaintext data buffer */
 
133
  rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
 
134
  if (rc != GPG_ERR_NO_ERROR){
301
135
    fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
302
136
            gpgme_strsource(rc), gpgme_strerror(rc));
303
 
    plaintext_length = -1;
304
 
    if(debug){
305
 
      gpgme_decrypt_result_t result;
306
 
      result = gpgme_op_decrypt_result(mc.ctx);
307
 
      if(result == NULL){
308
 
        fprintf(stderr, "gpgme_op_decrypt_result failed\n");
309
 
      } else {
310
 
        fprintf(stderr, "Unsupported algorithm: %s\n",
311
 
                result->unsupported_algorithm);
312
 
        fprintf(stderr, "Wrong key usage: %u\n",
313
 
                result->wrong_key_usage);
314
 
        if(result->file_name != NULL){
315
 
          fprintf(stderr, "File name: %s\n", result->file_name);
316
 
        }
317
 
        gpgme_recipient_t recipient;
318
 
        recipient = result->recipients;
 
137
    return -1;
 
138
  }
 
139
 
 
140
  if(debug){
 
141
    fprintf(stderr, "decryption of gpg packet succeeded\n");
 
142
  }
 
143
 
 
144
  if (debug){
 
145
    gpgme_decrypt_result_t result;
 
146
    result = gpgme_op_decrypt_result(ctx);
 
147
    if (result == NULL){
 
148
      fprintf(stderr, "gpgme_op_decrypt_result failed\n");
 
149
    } else {
 
150
      fprintf(stderr, "Unsupported algorithm: %s\n", result->unsupported_algorithm);
 
151
      fprintf(stderr, "Wrong key usage: %d\n", result->wrong_key_usage);
 
152
      if(result->file_name != NULL){
 
153
        fprintf(stderr, "File name: %s\n", result->file_name);
 
154
      }
 
155
      gpgme_recipient_t recipient;
 
156
      recipient = result->recipients;
 
157
      if(recipient){
319
158
        while(recipient != NULL){
320
159
          fprintf(stderr, "Public key algorithm: %s\n",
321
160
                  gpgme_pubkey_algo_name(recipient->pubkey_algo));
322
161
          fprintf(stderr, "Key ID: %s\n", recipient->keyid);
323
162
          fprintf(stderr, "Secret key available: %s\n",
324
 
                  recipient->status == GPG_ERR_NO_SECKEY
325
 
                  ? "No" : "Yes");
 
163
                  recipient->status == GPG_ERR_NO_SECKEY ? "No" : "Yes");
326
164
          recipient = recipient->next;
327
165
        }
328
166
      }
329
167
    }
330
 
    goto decrypt_end;
331
168
  }
332
169
  
333
 
  if(debug){
334
 
    fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
335
 
  }
 
170
  /* Delete the GPGME FILE pointer cryptotext data buffer */
 
171
  gpgme_data_release(dh_crypto);
336
172
  
337
173
  /* Seek back to the beginning of the GPGME plaintext data buffer */
338
 
  if(gpgme_data_seek(dh_plain, (off_t)0, SEEK_SET) == -1){
339
 
    perror("gpgme_data_seek");
340
 
    plaintext_length = -1;
341
 
    goto decrypt_end;
342
 
  }
343
 
  
344
 
  *plaintext = NULL;
 
174
  gpgme_data_seek(dh_plain, 0, SEEK_SET);
 
175
 
 
176
  *new_packet = 0;
345
177
  while(true){
346
 
    plaintext_capacity = incbuffer(plaintext,
347
 
                                      (size_t)plaintext_length,
348
 
                                      plaintext_capacity);
349
 
    if(plaintext_capacity == 0){
350
 
        perror("incbuffer");
351
 
        plaintext_length = -1;
352
 
        goto decrypt_end;
 
178
    if (new_packet_length + BUFFER_SIZE > new_packet_capacity){
 
179
      *new_packet = realloc(*new_packet, new_packet_capacity + BUFFER_SIZE);
 
180
      if (*new_packet == NULL){
 
181
        perror("realloc");
 
182
        return -1;
 
183
      }
 
184
      new_packet_capacity += BUFFER_SIZE;
353
185
    }
354
186
    
355
 
    ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
356
 
                          BUFFER_SIZE);
 
187
    ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length, BUFFER_SIZE);
357
188
    /* Print the data, if any */
358
 
    if(ret == 0){
359
 
      /* EOF */
 
189
    if (ret == 0){
 
190
      /* If password is empty, then a incorrect error will be printed */
360
191
      break;
361
192
    }
362
193
    if(ret < 0){
363
194
      perror("gpgme_data_read");
364
 
      plaintext_length = -1;
365
 
      goto decrypt_end;
 
195
      return -1;
366
196
    }
367
 
    plaintext_length += ret;
 
197
    new_packet_length += ret;
368
198
  }
369
 
  
 
199
 
370
200
  if(debug){
371
 
    fprintf(stderr, "Decrypted password is: ");
372
 
    for(ssize_t i = 0; i < plaintext_length; i++){
373
 
      fprintf(stderr, "%02hhX ", (*plaintext)[i]);
374
 
    }
375
 
    fprintf(stderr, "\n");
 
201
    fprintf(stderr, "decrypted password is: %s\n", *new_packet);
376
202
  }
377
 
  
378
 
 decrypt_end:
379
 
  
380
 
  /* Delete the GPGME cryptotext data buffer */
381
 
  gpgme_data_release(dh_crypto);
382
 
  
383
 
  /* Delete the GPGME plaintext data buffer */
 
203
 
 
204
   /* Delete the GPGME plaintext data buffer */
384
205
  gpgme_data_release(dh_plain);
385
 
  return plaintext_length;
 
206
  return new_packet_length;
386
207
}
387
208
 
388
 
static const char * safer_gnutls_strerror(int value){
389
 
  const char *ret = gnutls_strerror(value); /* Spurious warning from
390
 
                                               -Wunreachable-code */
391
 
  if(ret == NULL)
 
209
static const char * safer_gnutls_strerror (int value) {
 
210
  const char *ret = gnutls_strerror (value);
 
211
  if (ret == NULL)
392
212
    ret = "(unknown)";
393
213
  return ret;
394
214
}
395
215
 
396
 
/* GnuTLS log function callback */
397
 
static void debuggnutls(__attribute__((unused)) int level,
398
 
                        const char* string){
399
 
  fprintf(stderr, "GnuTLS: %s", string);
 
216
void debuggnutls(int level, const char* string){
 
217
  fprintf(stderr, "%s", string);
400
218
}
401
219
 
402
 
static int init_gnutls_global(const char *pubkeyfilename,
403
 
                              const char *seckeyfilename){
 
220
int initgnutls(encrypted_session *es){
 
221
  const char *err;
404
222
  int ret;
405
 
  
 
223
 
406
224
  if(debug){
407
 
    fprintf(stderr, "Initializing GnuTLS\n");
 
225
    fprintf(stderr, "Initializing gnutls\n");
408
226
  }
 
227
 
409
228
  
410
 
  ret = gnutls_global_init();
411
 
  if(ret != GNUTLS_E_SUCCESS){
412
 
    fprintf(stderr, "GnuTLS global_init: %s\n",
413
 
            safer_gnutls_strerror(ret));
 
229
  if ((ret = gnutls_global_init ())
 
230
      != GNUTLS_E_SUCCESS) {
 
231
    fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
414
232
    return -1;
415
233
  }
416
 
  
417
 
  if(debug){
418
 
    /* "Use a log level over 10 to enable all debugging options."
419
 
     * - GnuTLS manual
420
 
     */
 
234
 
 
235
  if (debug){
421
236
    gnutls_global_set_log_level(11);
422
237
    gnutls_global_set_log_function(debuggnutls);
423
238
  }
424
239
  
425
 
  /* OpenPGP credentials */
426
 
  gnutls_certificate_allocate_credentials(&mc.cred);
427
 
  if(ret != GNUTLS_E_SUCCESS){
428
 
    fprintf(stderr, "GnuTLS memory error: %s\n", /* Spurious warning
429
 
                                                    from
430
 
                                                    -Wunreachable-code
431
 
                                                 */
432
 
            safer_gnutls_strerror(ret));
433
 
    gnutls_global_deinit();
 
240
 
 
241
  /* openpgp credentials */
 
242
  if ((ret = gnutls_certificate_allocate_credentials (&es->cred))
 
243
      != GNUTLS_E_SUCCESS) {
 
244
    fprintf (stderr, "memory error: %s\n", safer_gnutls_strerror(ret));
434
245
    return -1;
435
246
  }
436
 
  
 
247
 
437
248
  if(debug){
438
 
    fprintf(stderr, "Attempting to use OpenPGP public key %s and"
439
 
            " secret key %s as GnuTLS credentials\n", pubkeyfilename,
440
 
            seckeyfilename);
 
249
    fprintf(stderr, "Attempting to use openpgp certificate %s"
 
250
            " and keyfile %s as gnutls credentials\n", CERTFILE, KEYFILE);
441
251
  }
442
 
  
 
252
 
443
253
  ret = gnutls_certificate_set_openpgp_key_file
444
 
    (mc.cred, pubkeyfilename, seckeyfilename,
445
 
     GNUTLS_OPENPGP_FMT_BASE64);
446
 
  if(ret != GNUTLS_E_SUCCESS){
447
 
    fprintf(stderr,
448
 
            "Error[%d] while reading the OpenPGP key pair ('%s',"
449
 
            " '%s')\n", ret, pubkeyfilename, seckeyfilename);
450
 
    fprintf(stderr, "The GnuTLS error is: %s\n",
451
 
            safer_gnutls_strerror(ret));
452
 
    goto globalfail;
453
 
  }
454
 
  
455
 
  /* GnuTLS server initialization */
456
 
  ret = gnutls_dh_params_init(&mc.dh_params);
457
 
  if(ret != GNUTLS_E_SUCCESS){
458
 
    fprintf(stderr, "Error in GnuTLS DH parameter initialization:"
459
 
            " %s\n", safer_gnutls_strerror(ret));
460
 
    goto globalfail;
461
 
  }
462
 
  ret = gnutls_dh_params_generate2(mc.dh_params, mc.dh_bits);
463
 
  if(ret != GNUTLS_E_SUCCESS){
464
 
    fprintf(stderr, "Error in GnuTLS prime generation: %s\n",
465
 
            safer_gnutls_strerror(ret));
466
 
    goto globalfail;
467
 
  }
468
 
  
469
 
  gnutls_certificate_set_dh_params(mc.cred, mc.dh_params);
470
 
  
471
 
  return 0;
472
 
  
473
 
 globalfail:
474
 
  
475
 
  gnutls_certificate_free_credentials(mc.cred);
476
 
  gnutls_global_deinit();
477
 
  gnutls_dh_params_deinit(mc.dh_params);
478
 
  return -1;
479
 
}
480
 
 
481
 
static int init_gnutls_session(gnutls_session_t *session){
482
 
  int ret;
483
 
  /* GnuTLS session creation */
484
 
  do {
485
 
    ret = gnutls_init(session, GNUTLS_SERVER);
486
 
    if(quit_now){
487
 
      return -1;
488
 
    }
489
 
  } while(ret == GNUTLS_E_INTERRUPTED or ret == GNUTLS_E_AGAIN);
490
 
  if(ret != GNUTLS_E_SUCCESS){
491
 
    fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
492
 
            safer_gnutls_strerror(ret));
493
 
  }
494
 
  
495
 
  {
496
 
    const char *err;
497
 
    do {
498
 
      ret = gnutls_priority_set_direct(*session, mc.priority, &err);
499
 
      if(quit_now){
500
 
        gnutls_deinit(*session);
501
 
        return -1;
502
 
      }
503
 
    } while(ret == GNUTLS_E_INTERRUPTED or ret == GNUTLS_E_AGAIN);
504
 
    if(ret != GNUTLS_E_SUCCESS){
505
 
      fprintf(stderr, "Syntax error at: %s\n", err);
506
 
      fprintf(stderr, "GnuTLS error: %s\n",
507
 
              safer_gnutls_strerror(ret));
508
 
      gnutls_deinit(*session);
509
 
      return -1;
510
 
    }
511
 
  }
512
 
  
513
 
  do {
514
 
    ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
515
 
                                 mc.cred);
516
 
    if(quit_now){
517
 
      gnutls_deinit(*session);
518
 
      return -1;
519
 
    }
520
 
  } while(ret == GNUTLS_E_INTERRUPTED or ret == GNUTLS_E_AGAIN);
521
 
  if(ret != GNUTLS_E_SUCCESS){
522
 
    fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
523
 
            safer_gnutls_strerror(ret));
524
 
    gnutls_deinit(*session);
525
 
    return -1;
526
 
  }
527
 
  
 
254
    (es->cred, CERTFILE, KEYFILE, GNUTLS_OPENPGP_FMT_BASE64);
 
255
  if (ret != GNUTLS_E_SUCCESS) {
 
256
    fprintf
 
257
      (stderr, "Error[%d] while reading the OpenPGP key pair ('%s', '%s')\n",
 
258
       ret, CERTFILE, KEYFILE);
 
259
    fprintf(stdout, "The Error is: %s\n",
 
260
            safer_gnutls_strerror(ret));
 
261
    return -1;
 
262
  }
 
263
 
 
264
  //Gnutls server initialization
 
265
  if ((ret = gnutls_dh_params_init (&es->dh_params))
 
266
      != GNUTLS_E_SUCCESS) {
 
267
    fprintf (stderr, "Error in dh parameter initialization: %s\n",
 
268
             safer_gnutls_strerror(ret));
 
269
    return -1;
 
270
  }
 
271
 
 
272
  if ((ret = gnutls_dh_params_generate2 (es->dh_params, DH_BITS))
 
273
      != GNUTLS_E_SUCCESS) {
 
274
    fprintf (stderr, "Error in prime generation: %s\n",
 
275
             safer_gnutls_strerror(ret));
 
276
    return -1;
 
277
  }
 
278
 
 
279
  gnutls_certificate_set_dh_params (es->cred, es->dh_params);
 
280
 
 
281
  // Gnutls session creation
 
282
  if ((ret = gnutls_init (&es->session, GNUTLS_SERVER))
 
283
      != GNUTLS_E_SUCCESS){
 
284
    fprintf(stderr, "Error in gnutls session initialization: %s\n",
 
285
            safer_gnutls_strerror(ret));
 
286
  }
 
287
 
 
288
  if ((ret = gnutls_priority_set_direct (es->session, "NORMAL", &err))
 
289
      != GNUTLS_E_SUCCESS) {
 
290
    fprintf(stderr, "Syntax error at: %s\n", err);
 
291
    fprintf(stderr, "Gnutls error: %s\n",
 
292
            safer_gnutls_strerror(ret));
 
293
    return -1;
 
294
  }
 
295
 
 
296
  if ((ret = gnutls_credentials_set
 
297
       (es->session, GNUTLS_CRD_CERTIFICATE, es->cred))
 
298
      != GNUTLS_E_SUCCESS) {
 
299
    fprintf(stderr, "Error setting a credentials set: %s\n",
 
300
            safer_gnutls_strerror(ret));
 
301
    return -1;
 
302
  }
 
303
 
528
304
  /* ignore client certificate if any. */
529
 
  gnutls_certificate_server_set_request(*session, GNUTLS_CERT_IGNORE);
 
305
  gnutls_certificate_server_set_request (es->session, GNUTLS_CERT_IGNORE);
530
306
  
531
 
  gnutls_dh_set_prime_bits(*session, mc.dh_bits);
 
307
  gnutls_dh_set_prime_bits (es->session, DH_BITS);
532
308
  
533
309
  return 0;
534
310
}
535
311
 
536
 
/* Avahi log function callback */
537
 
static void empty_log(__attribute__((unused)) AvahiLogLevel level,
538
 
                      __attribute__((unused)) const char *txt){}
 
312
void empty_log(AvahiLogLevel level, const char *txt){}
539
313
 
540
 
/* Called when a Mandos server is found */
541
 
static int start_mandos_communication(const char *ip, uint16_t port,
542
 
                                      AvahiIfIndex if_index,
543
 
                                      int af){
544
 
  int ret, tcp_sd = -1;
545
 
  ssize_t sret;
546
 
  union {
547
 
    struct sockaddr_in in;
548
 
    struct sockaddr_in6 in6;
549
 
  } to;
 
314
int start_mandos_communcation(char *ip, uint16_t port){
 
315
  int ret, tcp_sd;
 
316
  struct sockaddr_in6 to;
 
317
  encrypted_session es;
550
318
  char *buffer = NULL;
551
 
  char *decrypted_buffer = NULL;
 
319
  char *decrypted_buffer;
552
320
  size_t buffer_length = 0;
553
321
  size_t buffer_capacity = 0;
554
 
  size_t written;
555
 
  int retval = -1;
556
 
  gnutls_session_t session;
557
 
  int pf;                       /* Protocol family */
558
 
  
559
 
  errno = 0;
560
 
  
561
 
  if(quit_now){
562
 
    errno = EINTR;
563
 
    return -1;
564
 
  }
565
 
  
566
 
  switch(af){
567
 
  case AF_INET6:
568
 
    pf = PF_INET6;
569
 
    break;
570
 
  case AF_INET:
571
 
    pf = PF_INET;
572
 
    break;
573
 
  default:
574
 
    fprintf(stderr, "Bad address family: %d\n", af);
575
 
    errno = EINVAL;
576
 
    return -1;
577
 
  }
578
 
  
579
 
  ret = init_gnutls_session(&session);
580
 
  if(ret != 0){
581
 
    return -1;
582
 
  }
583
 
  
 
322
  ssize_t decrypted_buffer_size;
 
323
  int retval = 0;
 
324
  const char interface[] = "eth0";
 
325
 
584
326
  if(debug){
585
 
    fprintf(stderr, "Setting up a TCP connection to %s, port %" PRIu16
586
 
            "\n", ip, port);
 
327
    fprintf(stderr, "Setting up a tcp connection to %s\n", ip);
587
328
  }
588
329
  
589
 
  tcp_sd = socket(pf, SOCK_STREAM, 0);
590
 
  if(tcp_sd < 0){
591
 
    int e = errno;
 
330
  tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
 
331
  if(tcp_sd < 0) {
592
332
    perror("socket");
593
 
    errno = e;
594
 
    goto mandos_end;
595
 
  }
596
 
  
597
 
  if(quit_now){
598
 
    errno = EINTR;
599
 
    goto mandos_end;
600
 
  }
601
 
  
602
 
  memset(&to, 0, sizeof(to));
603
 
  if(af == AF_INET6){
604
 
    to.in6.sin6_family = (sa_family_t)af;
605
 
    ret = inet_pton(af, ip, &to.in6.sin6_addr);
606
 
  } else {                      /* IPv4 */
607
 
    to.in.sin_family = (sa_family_t)af;
608
 
    ret = inet_pton(af, ip, &to.in.sin_addr);
609
 
  }
610
 
  if(ret < 0 ){
611
 
    int e = errno;
 
333
    return -1;
 
334
  }
 
335
 
 
336
  if(debug){
 
337
    fprintf(stderr, "Binding to interface %s\n", interface);
 
338
  }
 
339
 
 
340
  ret = setsockopt(tcp_sd, SOL_SOCKET, SO_BINDTODEVICE, interface, 5);
 
341
  if(tcp_sd < 0) {
 
342
    perror("setsockopt bindtodevice");
 
343
    return -1;
 
344
  }
 
345
  
 
346
  memset(&to,0,sizeof(to));
 
347
  to.sin6_family = AF_INET6;
 
348
  ret = inet_pton(AF_INET6, ip, &to.sin6_addr);
 
349
  if (ret < 0 ){
612
350
    perror("inet_pton");
613
 
    errno = e;
614
 
    goto mandos_end;
615
 
  }
 
351
    return -1;
 
352
  }  
616
353
  if(ret == 0){
617
 
    int e = errno;
618
354
    fprintf(stderr, "Bad address: %s\n", ip);
619
 
    errno = e;
620
 
    goto mandos_end;
621
 
  }
622
 
  if(af == AF_INET6){
623
 
    to.in6.sin6_port = htons(port); /* Spurious warnings from
624
 
                                       -Wconversion and
625
 
                                       -Wunreachable-code */
626
 
    
627
 
    if(IN6_IS_ADDR_LINKLOCAL /* Spurious warnings from */
628
 
       (&to.in6.sin6_addr)){ /* -Wstrict-aliasing=2 or lower and
629
 
                              -Wunreachable-code*/
630
 
      if(if_index == AVAHI_IF_UNSPEC){
631
 
        fprintf(stderr, "An IPv6 link-local address is incomplete"
632
 
                " without a network interface\n");
633
 
        errno = EINVAL;
634
 
        goto mandos_end;
635
 
      }
636
 
      /* Set the network interface number as scope */
637
 
      to.in6.sin6_scope_id = (uint32_t)if_index;
638
 
    }
639
 
  } else {
640
 
    to.in.sin_port = htons(port); /* Spurious warnings from
641
 
                                     -Wconversion and
642
 
                                     -Wunreachable-code */
643
 
  }
644
 
  
645
 
  if(quit_now){
646
 
    errno = EINTR;
647
 
    goto mandos_end;
648
 
  }
649
 
  
650
 
  if(debug){
651
 
    if(af == AF_INET6 and if_index != AVAHI_IF_UNSPEC){
652
 
      char interface[IF_NAMESIZE];
653
 
      if(if_indextoname((unsigned int)if_index, interface) == NULL){
654
 
        perror("if_indextoname");
655
 
      } else {
656
 
        fprintf(stderr, "Connection to: %s%%%s, port %" PRIu16 "\n",
657
 
                ip, interface, port);
658
 
      }
659
 
    } else {
660
 
      fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
661
 
              port);
662
 
    }
663
 
    char addrstr[(INET_ADDRSTRLEN > INET6_ADDRSTRLEN) ?
664
 
                 INET_ADDRSTRLEN : INET6_ADDRSTRLEN] = "";
665
 
    const char *pcret;
666
 
    if(af == AF_INET6){
667
 
      pcret = inet_ntop(af, &(to.in6.sin6_addr), addrstr,
668
 
                        sizeof(addrstr));
669
 
    } else {
670
 
      pcret = inet_ntop(af, &(to.in.sin_addr), addrstr,
671
 
                        sizeof(addrstr));
672
 
    }
673
 
    if(pcret == NULL){
674
 
      perror("inet_ntop");
675
 
    } else {
676
 
      if(strcmp(addrstr, ip) != 0){
677
 
        fprintf(stderr, "Canonical address form: %s\n", addrstr);
678
 
      }
679
 
    }
680
 
  }
681
 
  
682
 
  if(quit_now){
683
 
    errno = EINTR;
684
 
    goto mandos_end;
685
 
  }
686
 
  
687
 
  if(af == AF_INET6){
688
 
    ret = connect(tcp_sd, &to.in6, sizeof(to));
689
 
  } else {
690
 
    ret = connect(tcp_sd, &to.in, sizeof(to)); /* IPv4 */
691
 
  }
692
 
  if(ret < 0){
693
 
    if ((errno != ECONNREFUSED and errno != ENETUNREACH) or debug){
694
 
      int e = errno;
695
 
      perror("connect");
696
 
      errno = e;
697
 
    }
698
 
    goto mandos_end;
699
 
  }
700
 
  
701
 
  if(quit_now){
702
 
    errno = EINTR;
703
 
    goto mandos_end;
704
 
  }
705
 
  
706
 
  const char *out = mandos_protocol_version;
707
 
  written = 0;
708
 
  while(true){
709
 
    size_t out_size = strlen(out);
710
 
    ret = (int)TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
711
 
                                   out_size - written));
712
 
    if(ret == -1){
713
 
      int e = errno;
714
 
      perror("write");
715
 
      errno = e;
716
 
      goto mandos_end;
717
 
    }
718
 
    written += (size_t)ret;
719
 
    if(written < out_size){
720
 
      continue;
721
 
    } else {
722
 
      if(out == mandos_protocol_version){
723
 
        written = 0;
724
 
        out = "\r\n";
725
 
      } else {
726
 
        break;
727
 
      }
728
 
    }
729
 
  
730
 
    if(quit_now){
731
 
      errno = EINTR;
732
 
      goto mandos_end;
733
 
    }
734
 
  }
735
 
  
736
 
  if(debug){
737
 
    fprintf(stderr, "Establishing TLS session with %s\n", ip);
738
 
  }
739
 
  
740
 
  if(quit_now){
741
 
    errno = EINTR;
742
 
    goto mandos_end;
743
 
  }
744
 
  
745
 
  gnutls_transport_set_ptr(session, (gnutls_transport_ptr_t) tcp_sd);
746
 
  
747
 
  if(quit_now){
748
 
    errno = EINTR;
749
 
    goto mandos_end;
750
 
  }
751
 
  
752
 
  do {
753
 
    ret = gnutls_handshake(session);
754
 
    if(quit_now){
755
 
      errno = EINTR;
756
 
      goto mandos_end;
757
 
    }
758
 
  } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
759
 
  
760
 
  if(ret != GNUTLS_E_SUCCESS){
761
 
    if(debug){
762
 
      fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
763
 
      gnutls_perror(ret);
764
 
    }
765
 
    errno = EPROTO;
766
 
    goto mandos_end;
767
 
  }
768
 
  
769
 
  /* Read OpenPGP packet that contains the wanted password */
770
 
  
771
 
  if(debug){
772
 
    fprintf(stderr, "Retrieving OpenPGP encrypted password from %s\n",
773
 
            ip);
774
 
  }
775
 
  
776
 
  while(true){
777
 
    
778
 
    if(quit_now){
779
 
      errno = EINTR;
780
 
      goto mandos_end;
781
 
    }
782
 
    
783
 
    buffer_capacity = incbuffer(&buffer, buffer_length,
784
 
                                   buffer_capacity);
785
 
    if(buffer_capacity == 0){
786
 
      int e = errno;
787
 
      perror("incbuffer");
788
 
      errno = e;
789
 
      goto mandos_end;
790
 
    }
791
 
    
792
 
    if(quit_now){
793
 
      errno = EINTR;
794
 
      goto mandos_end;
795
 
    }
796
 
    
797
 
    sret = gnutls_record_recv(session, buffer+buffer_length,
798
 
                              BUFFER_SIZE);
799
 
    if(sret == 0){
 
355
    return -1;
 
356
  }
 
357
  to.sin6_port = htons(port);
 
358
  to.sin6_scope_id = if_nametoindex(interface);
 
359
 
 
360
  if(debug){
 
361
    fprintf(stderr, "Connection to: %s\n", ip);
 
362
  }
 
363
  
 
364
  ret = connect(tcp_sd, (struct sockaddr *) &to, sizeof(to));
 
365
  if (ret < 0){
 
366
    perror("connect");
 
367
    return -1;
 
368
  }
 
369
  
 
370
  ret = initgnutls (&es);
 
371
  if (ret != 0){
 
372
    retval = -1;
 
373
    return -1;
 
374
  }
 
375
    
 
376
  
 
377
  gnutls_transport_set_ptr (es.session, (gnutls_transport_ptr_t) tcp_sd);
 
378
 
 
379
  if(debug){
 
380
    fprintf(stderr, "Establishing tls session with %s\n", ip);
 
381
  }
 
382
 
 
383
  
 
384
  ret = gnutls_handshake (es.session);
 
385
  
 
386
  if (ret != GNUTLS_E_SUCCESS){
 
387
    fprintf(stderr, "\n*** Handshake failed ***\n");
 
388
    gnutls_perror (ret);
 
389
    retval = -1;
 
390
    goto exit;
 
391
  }
 
392
 
 
393
  //Retrieve gpg packet that contains the wanted password
 
394
 
 
395
  if(debug){
 
396
    fprintf(stderr, "Retrieving pgp encrypted password from %s\n", ip);
 
397
  }
 
398
 
 
399
  while(true){
 
400
    if (buffer_length + BUFFER_SIZE > buffer_capacity){
 
401
      buffer = realloc(buffer, buffer_capacity + BUFFER_SIZE);
 
402
      if (buffer == NULL){
 
403
        perror("realloc");
 
404
        goto exit;
 
405
      }
 
406
      buffer_capacity += BUFFER_SIZE;
 
407
    }
 
408
    
 
409
    ret = gnutls_record_recv
 
410
      (es.session, buffer+buffer_length, BUFFER_SIZE);
 
411
    if (ret == 0){
800
412
      break;
801
413
    }
802
 
    if(sret < 0){
803
 
      switch(sret){
 
414
    if (ret < 0){
 
415
      switch(ret){
804
416
      case GNUTLS_E_INTERRUPTED:
805
417
      case GNUTLS_E_AGAIN:
806
418
        break;
807
419
      case GNUTLS_E_REHANDSHAKE:
808
 
        do {
809
 
          ret = gnutls_handshake(session);
810
 
          
811
 
          if(quit_now){
812
 
            errno = EINTR;
813
 
            goto mandos_end;
814
 
          }
815
 
        } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
816
 
        if(ret < 0){
817
 
          fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
818
 
          gnutls_perror(ret);
819
 
          errno = EPROTO;
820
 
          goto mandos_end;
 
420
        ret = gnutls_handshake (es.session);
 
421
        if (ret < 0){
 
422
          fprintf(stderr, "\n*** Handshake failed ***\n");
 
423
          gnutls_perror (ret);
 
424
          retval = -1;
 
425
          goto exit;
821
426
        }
822
427
        break;
823
428
      default:
824
 
        fprintf(stderr, "Unknown error while reading data from"
825
 
                " encrypted session with Mandos server\n");
826
 
        gnutls_bye(session, GNUTLS_SHUT_RDWR);
827
 
        errno = EIO;
828
 
        goto mandos_end;
829
 
      }
830
 
    } else {
831
 
      buffer_length += (size_t) sret;
832
 
    }
833
 
  }
834
 
  
835
 
  if(debug){
836
 
    fprintf(stderr, "Closing TLS session\n");
837
 
  }
838
 
  
839
 
  if(quit_now){
840
 
    errno = EINTR;
841
 
    goto mandos_end;
842
 
  }
843
 
  
844
 
  do {
845
 
    ret = gnutls_bye(session, GNUTLS_SHUT_RDWR);
846
 
    if(quit_now){
847
 
      errno = EINTR;
848
 
      goto mandos_end;
849
 
    }
850
 
  } while(ret == GNUTLS_E_AGAIN or ret == GNUTLS_E_INTERRUPTED);
851
 
  
852
 
  if(buffer_length > 0){
853
 
    ssize_t decrypted_buffer_size;
854
 
    decrypted_buffer_size = pgp_packet_decrypt(buffer,
855
 
                                               buffer_length,
856
 
                                               &decrypted_buffer);
857
 
    if(decrypted_buffer_size >= 0){
858
 
      
859
 
      written = 0;
860
 
      while(written < (size_t) decrypted_buffer_size){
861
 
        if(quit_now){
862
 
          errno = EINTR;
863
 
          goto mandos_end;
864
 
        }
865
 
        
866
 
        ret = (int)fwrite(decrypted_buffer + written, 1,
867
 
                          (size_t)decrypted_buffer_size - written,
868
 
                          stdout);
869
 
        if(ret == 0 and ferror(stdout)){
870
 
          int e = errno;
871
 
          if(debug){
872
 
            fprintf(stderr, "Error writing encrypted data: %s\n",
873
 
                    strerror(errno));
874
 
          }
875
 
          errno = e;
876
 
          goto mandos_end;
877
 
        }
878
 
        written += (size_t)ret;
879
 
      }
880
 
      retval = 0;
881
 
    }
882
 
  }
883
 
  
884
 
  /* Shutdown procedure */
885
 
  
886
 
 mandos_end:
887
 
  {
888
 
    int e = errno;
889
 
    free(decrypted_buffer);
890
 
    free(buffer);
891
 
    if(tcp_sd >= 0){
892
 
      ret = (int)TEMP_FAILURE_RETRY(close(tcp_sd));
893
 
    }
894
 
    if(ret == -1){
895
 
      if(e == 0){
896
 
        e = errno;
897
 
      }
898
 
      perror("close");
899
 
    }
900
 
    gnutls_deinit(session);
901
 
    if(quit_now){
902
 
      e = EINTR;
 
429
        fprintf(stderr, "Unknown error while reading data from encrypted session with mandos server\n");
 
430
        retval = -1;
 
431
        gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
 
432
        goto exit;
 
433
      }
 
434
    } else {
 
435
      buffer_length += ret;
 
436
    }
 
437
  }
 
438
  
 
439
  if (buffer_length > 0){
 
440
    if ((decrypted_buffer_size = gpg_packet_decrypt(buffer, buffer_length, &decrypted_buffer, CERT_ROOT)) >= 0){
 
441
      fwrite (decrypted_buffer, 1, decrypted_buffer_size, stdout);
 
442
      free(decrypted_buffer);
 
443
    } else {
903
444
      retval = -1;
904
445
    }
905
 
    errno = e;
906
 
  }
 
446
  }
 
447
 
 
448
  //shutdown procedure
 
449
 
 
450
  if(debug){
 
451
    fprintf(stderr, "Closing tls session\n");
 
452
  }
 
453
 
 
454
  free(buffer);
 
455
  gnutls_bye (es.session, GNUTLS_SHUT_RDWR);
 
456
 exit:
 
457
  close(tcp_sd);
 
458
  gnutls_deinit (es.session);
 
459
  gnutls_certificate_free_credentials (es.cred);
 
460
  gnutls_global_deinit ();
907
461
  return retval;
908
462
}
909
463
 
910
 
static void resolve_callback(AvahiSServiceResolver *r,
911
 
                             AvahiIfIndex interface,
912
 
                             AvahiProtocol proto,
913
 
                             AvahiResolverEvent event,
914
 
                             const char *name,
915
 
                             const char *type,
916
 
                             const char *domain,
917
 
                             const char *host_name,
918
 
                             const AvahiAddress *address,
919
 
                             uint16_t port,
920
 
                             AVAHI_GCC_UNUSED AvahiStringList *txt,
921
 
                             AVAHI_GCC_UNUSED AvahiLookupResultFlags
922
 
                             flags,
923
 
                             AVAHI_GCC_UNUSED void* userdata){
924
 
  assert(r);
925
 
  
926
 
  /* Called whenever a service has been resolved successfully or
927
 
     timed out */
928
 
  
929
 
  if(quit_now){
930
 
    return;
931
 
  }
932
 
  
933
 
  switch(event){
934
 
  default:
935
 
  case AVAHI_RESOLVER_FAILURE:
936
 
    fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
937
 
            " of type '%s' in domain '%s': %s\n", name, type, domain,
938
 
            avahi_strerror(avahi_server_errno(mc.server)));
939
 
    break;
940
 
    
941
 
  case AVAHI_RESOLVER_FOUND:
942
 
    {
943
 
      char ip[AVAHI_ADDRESS_STR_MAX];
944
 
      avahi_address_snprint(ip, sizeof(ip), address);
945
 
      if(debug){
946
 
        fprintf(stderr, "Mandos server \"%s\" found on %s (%s, %"
947
 
                PRIdMAX ") on port %" PRIu16 "\n", name, host_name,
948
 
                ip, (intmax_t)interface, port);
949
 
      }
950
 
      int ret = start_mandos_communication(ip, port, interface,
951
 
                                           avahi_proto_to_af(proto));
952
 
      if(ret == 0){
953
 
        avahi_simple_poll_quit(mc.simple_poll);
954
 
      }
955
 
    }
956
 
  }
957
 
  avahi_s_service_resolver_free(r);
958
 
}
959
 
 
960
 
static void browse_callback(AvahiSServiceBrowser *b,
961
 
                            AvahiIfIndex interface,
962
 
                            AvahiProtocol protocol,
963
 
                            AvahiBrowserEvent event,
964
 
                            const char *name,
965
 
                            const char *type,
966
 
                            const char *domain,
967
 
                            AVAHI_GCC_UNUSED AvahiLookupResultFlags
968
 
                            flags,
969
 
                            AVAHI_GCC_UNUSED void* userdata){
970
 
  assert(b);
971
 
  
972
 
  /* Called whenever a new services becomes available on the LAN or
973
 
     is removed from the LAN */
974
 
  
975
 
  if(quit_now){
976
 
    return;
977
 
  }
978
 
  
979
 
  switch(event){
980
 
  default:
981
 
  case AVAHI_BROWSER_FAILURE:
982
 
    
983
 
    fprintf(stderr, "(Avahi browser) %s\n",
984
 
            avahi_strerror(avahi_server_errno(mc.server)));
985
 
    avahi_simple_poll_quit(mc.simple_poll);
986
 
    return;
987
 
    
988
 
  case AVAHI_BROWSER_NEW:
989
 
    /* We ignore the returned Avahi resolver object. In the callback
990
 
       function we free it. If the Avahi server is terminated before
991
 
       the callback function is called the Avahi server will free the
992
 
       resolver for us. */
993
 
    
994
 
    if(avahi_s_service_resolver_new(mc.server, interface, protocol,
995
 
                                    name, type, domain, protocol, 0,
996
 
                                    resolve_callback, NULL) == NULL)
997
 
      fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
998
 
              name, avahi_strerror(avahi_server_errno(mc.server)));
999
 
    break;
1000
 
    
1001
 
  case AVAHI_BROWSER_REMOVE:
1002
 
    break;
1003
 
    
1004
 
  case AVAHI_BROWSER_ALL_FOR_NOW:
1005
 
  case AVAHI_BROWSER_CACHE_EXHAUSTED:
1006
 
    if(debug){
1007
 
      fprintf(stderr, "No Mandos server found, still searching...\n");
1008
 
    }
1009
 
    break;
1010
 
  }
1011
 
}
1012
 
 
1013
 
/* stop main loop after sigterm has been called */
1014
 
static void handle_sigterm(int sig){
1015
 
  if(quit_now){
1016
 
    return;
1017
 
  }
1018
 
  quit_now = 1;
1019
 
  signal_received = sig;
1020
 
  int old_errno = errno;
1021
 
  if(mc.simple_poll != NULL){
1022
 
    avahi_simple_poll_quit(mc.simple_poll);
1023
 
  }
1024
 
  errno = old_errno;
1025
 
}
1026
 
 
1027
 
/* 
1028
 
 * This function determines if a directory entry in /sys/class/net
1029
 
 * corresponds to an acceptable network device.
1030
 
 * (This function is passed to scandir(3) as a filter function.)
1031
 
 */
1032
 
int good_interface(const struct dirent *if_entry){
1033
 
  ssize_t ssret;
1034
 
  char *flagname = NULL;
1035
 
  int ret = asprintf(&flagname, "%s/%s/flags", sys_class_net,
1036
 
                     if_entry->d_name);
1037
 
  if(ret < 0){
1038
 
    perror("asprintf");
1039
 
    return 0;
1040
 
  }
1041
 
  if(if_entry->d_name[0] == '.'){
1042
 
    return 0;
1043
 
  }
1044
 
  int flags_fd = (int)TEMP_FAILURE_RETRY(open(flagname, O_RDONLY));
1045
 
  if(flags_fd == -1){
1046
 
    perror("open");
1047
 
    return 0;
1048
 
  }
1049
 
  typedef short ifreq_flags;    /* ifreq.ifr_flags in netdevice(7) */
1050
 
  /* read line from flags_fd */
1051
 
  ssize_t to_read = (sizeof(ifreq_flags)*2)+3; /* "0x1003\n" */
1052
 
  char *flagstring = malloc((size_t)to_read+1); /* +1 for final \0 */
1053
 
  flagstring[(size_t)to_read] = '\0';
1054
 
  if(flagstring == NULL){
1055
 
    perror("malloc");
1056
 
    close(flags_fd);
1057
 
    return 0;
1058
 
  }
1059
 
  while(to_read > 0){
1060
 
    ssret = (ssize_t)TEMP_FAILURE_RETRY(read(flags_fd, flagstring,
1061
 
                                             (size_t)to_read));
1062
 
    if(ssret == -1){
1063
 
      perror("read");
1064
 
      free(flagstring);
1065
 
      close(flags_fd);
1066
 
      return 0;
1067
 
    }
1068
 
    to_read -= ssret;
1069
 
    if(ssret == 0){
1070
 
      break;
1071
 
    }
1072
 
  }
1073
 
  close(flags_fd);
1074
 
  intmax_t tmpmax;
1075
 
  char *tmp;
1076
 
  errno = 0;
1077
 
  tmpmax = strtoimax(flagstring, &tmp, 0);
1078
 
  if(errno != 0 or tmp == flagstring or (*tmp != '\0'
1079
 
                                         and not (isspace(*tmp)))
1080
 
     or tmpmax != (ifreq_flags)tmpmax){
1081
 
    if(debug){
1082
 
      fprintf(stderr, "Invalid flags \"%s\" for interface \"%s\"\n",
1083
 
              flagstring, if_entry->d_name);
1084
 
    }
1085
 
    free(flagstring);
1086
 
    return 0;
1087
 
  }
1088
 
  free(flagstring);
1089
 
  ifreq_flags flags = (ifreq_flags)tmpmax;
1090
 
  /* Reject the loopback device */
1091
 
  if(flags & IFF_LOOPBACK){
1092
 
    if(debug){
1093
 
      fprintf(stderr, "Rejecting loopback interface \"%s\"\n",
1094
 
              if_entry->d_name);
1095
 
    }
1096
 
    return 0;
1097
 
  }
1098
 
  /* Accept point-to-point devices only if connect_to is specified */
1099
 
  if(connect_to != NULL and (flags & IFF_POINTOPOINT)){
1100
 
    if(debug){
1101
 
      fprintf(stderr, "Accepting point-to-point interface \"%s\"\n",
1102
 
              if_entry->d_name);
1103
 
    }
1104
 
    return 1;
1105
 
  }
1106
 
  /* Otherwise, reject non-broadcast-capable devices */
1107
 
  if(not (flags & IFF_BROADCAST)){
1108
 
    if(debug){
1109
 
      fprintf(stderr, "Rejecting non-broadcast interface \"%s\"\n",
1110
 
              if_entry->d_name);
1111
 
    }
1112
 
    return 0;
1113
 
  }
1114
 
  /* Accept this device */
1115
 
  if(debug){
1116
 
    fprintf(stderr, "Interface \"%s\" is acceptable\n",
1117
 
            if_entry->d_name);
1118
 
  }
1119
 
  return 1;
1120
 
}
1121
 
 
1122
 
int main(int argc, char *argv[]){
1123
 
  AvahiSServiceBrowser *sb = NULL;
1124
 
  int error;
1125
 
  int ret;
1126
 
  intmax_t tmpmax;
1127
 
  char *tmp;
1128
 
  int exitcode = EXIT_SUCCESS;
1129
 
  const char *interface = "";
1130
 
  struct ifreq network;
1131
 
  int sd = -1;
1132
 
  bool take_down_interface = false;
1133
 
  uid_t uid;
1134
 
  gid_t gid;
1135
 
  char tempdir[] = "/tmp/mandosXXXXXX";
1136
 
  bool tempdir_created = false;
1137
 
  AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
1138
 
  const char *seckey = PATHDIR "/" SECKEY;
1139
 
  const char *pubkey = PATHDIR "/" PUBKEY;
1140
 
  
1141
 
  bool gnutls_initialized = false;
1142
 
  bool gpgme_initialized = false;
1143
 
  float delay = 2.5f;
1144
 
  
1145
 
  struct sigaction old_sigterm_action = { .sa_handler = SIG_DFL };
1146
 
  struct sigaction sigterm_action = { .sa_handler = handle_sigterm };
1147
 
  
1148
 
  uid = getuid();
1149
 
  gid = getgid();
1150
 
  
1151
 
  /* Lower any group privileges we might have, just to be safe */
1152
 
  errno = 0;
1153
 
  ret = setgid(gid);
1154
 
  if(ret == -1){
1155
 
    perror("setgid");
1156
 
  }
1157
 
  
1158
 
  /* Lower user privileges (temporarily) */
1159
 
  errno = 0;
1160
 
  ret = seteuid(uid);
1161
 
  if(ret == -1){
1162
 
    perror("seteuid");
1163
 
  }
1164
 
  
1165
 
  if(quit_now){
1166
 
    goto end;
1167
 
  }
1168
 
  
1169
 
  {
1170
 
    struct argp_option options[] = {
1171
 
      { .name = "debug", .key = 128,
1172
 
        .doc = "Debug mode", .group = 3 },
1173
 
      { .name = "connect", .key = 'c',
1174
 
        .arg = "ADDRESS:PORT",
1175
 
        .doc = "Connect directly to a specific Mandos server",
1176
 
        .group = 1 },
1177
 
      { .name = "interface", .key = 'i',
1178
 
        .arg = "NAME",
1179
 
        .doc = "Network interface that will be used to search for"
1180
 
        " Mandos servers",
1181
 
        .group = 1 },
1182
 
      { .name = "seckey", .key = 's',
1183
 
        .arg = "FILE",
1184
 
        .doc = "OpenPGP secret key file base name",
1185
 
        .group = 1 },
1186
 
      { .name = "pubkey", .key = 'p',
1187
 
        .arg = "FILE",
1188
 
        .doc = "OpenPGP public key file base name",
1189
 
        .group = 2 },
1190
 
      { .name = "dh-bits", .key = 129,
1191
 
        .arg = "BITS",
1192
 
        .doc = "Bit length of the prime number used in the"
1193
 
        " Diffie-Hellman key exchange",
1194
 
        .group = 2 },
1195
 
      { .name = "priority", .key = 130,
1196
 
        .arg = "STRING",
1197
 
        .doc = "GnuTLS priority string for the TLS handshake",
1198
 
        .group = 1 },
1199
 
      { .name = "delay", .key = 131,
1200
 
        .arg = "SECONDS",
1201
 
        .doc = "Maximum delay to wait for interface startup",
1202
 
        .group = 2 },
1203
 
      /*
1204
 
       * These reproduce what we would get without ARGP_NO_HELP
1205
 
       */
1206
 
      { .name = "help", .key = '?',
1207
 
        .doc = "Give this help list", .group = -1 },
1208
 
      { .name = "usage", .key = -3,
1209
 
        .doc = "Give a short usage message", .group = -1 },
1210
 
      { .name = "version", .key = 'V',
1211
 
        .doc = "Print program version", .group = -1 },
1212
 
      { .name = NULL }
1213
 
    };
1214
 
    
1215
 
    error_t parse_opt(int key, char *arg,
1216
 
                      struct argp_state *state){
1217
 
      errno = 0;
1218
 
      switch(key){
1219
 
      case 128:                 /* --debug */
1220
 
        debug = true;
1221
 
        break;
1222
 
      case 'c':                 /* --connect */
1223
 
        connect_to = arg;
1224
 
        break;
1225
 
      case 'i':                 /* --interface */
1226
 
        interface = arg;
1227
 
        break;
1228
 
      case 's':                 /* --seckey */
1229
 
        seckey = arg;
1230
 
        break;
1231
 
      case 'p':                 /* --pubkey */
1232
 
        pubkey = arg;
1233
 
        break;
1234
 
      case 129:                 /* --dh-bits */
1235
 
        errno = 0;
1236
 
        tmpmax = strtoimax(arg, &tmp, 10);
1237
 
        if(errno != 0 or tmp == arg or *tmp != '\0'
1238
 
           or tmpmax != (typeof(mc.dh_bits))tmpmax){
1239
 
          argp_error(state, "Bad number of DH bits");
1240
 
        }
1241
 
        mc.dh_bits = (typeof(mc.dh_bits))tmpmax;
1242
 
        break;
1243
 
      case 130:                 /* --priority */
1244
 
        mc.priority = arg;
1245
 
        break;
1246
 
      case 131:                 /* --delay */
1247
 
        errno = 0;
1248
 
        delay = strtof(arg, &tmp);
1249
 
        if(errno != 0 or tmp == arg or *tmp != '\0'){
1250
 
          argp_error(state, "Bad delay");
1251
 
        }
1252
 
        break;
1253
 
        /*
1254
 
         * These reproduce what we would get without ARGP_NO_HELP
1255
 
         */
1256
 
      case '?':                 /* --help */
1257
 
        argp_state_help(state, state->out_stream,
1258
 
                        (ARGP_HELP_STD_HELP | ARGP_HELP_EXIT_ERR)
1259
 
                        & ~(unsigned int)ARGP_HELP_EXIT_OK);
1260
 
      case -3:                  /* --usage */
1261
 
        argp_state_help(state, state->out_stream,
1262
 
                        ARGP_HELP_USAGE | ARGP_HELP_EXIT_ERR);
1263
 
      case 'V':                 /* --version */
1264
 
        fprintf(state->out_stream, "%s\n", argp_program_version);
1265
 
        exit(argp_err_exit_status);
1266
 
        break;
1267
 
      default:
1268
 
        return ARGP_ERR_UNKNOWN;
1269
 
      }
1270
 
      return errno;
1271
 
    }
1272
 
    
1273
 
    struct argp argp = { .options = options, .parser = parse_opt,
1274
 
                         .args_doc = "",
1275
 
                         .doc = "Mandos client -- Get and decrypt"
1276
 
                         " passwords from a Mandos server" };
1277
 
    ret = argp_parse(&argp, argc, argv,
1278
 
                     ARGP_IN_ORDER | ARGP_NO_HELP, 0, NULL);
1279
 
    switch(ret){
1280
 
    case 0:
1281
 
      break;
1282
 
    case ENOMEM:
1283
 
    default:
1284
 
      errno = ret;
1285
 
      perror("argp_parse");
1286
 
      exitcode = EX_OSERR;
1287
 
      goto end;
1288
 
    case EINVAL:
1289
 
      exitcode = EX_USAGE;
1290
 
      goto end;
1291
 
    }
1292
 
  }
1293
 
  
1294
 
  if(not debug){
1295
 
    avahi_set_log_function(empty_log);
1296
 
  }
1297
 
 
1298
 
  if(interface[0] == '\0'){
1299
 
    struct dirent **direntries;
1300
 
    ret = scandir(sys_class_net, &direntries, good_interface,
1301
 
                  alphasort);
1302
 
    if(ret >= 1){
1303
 
      /* Pick the first good interface */
1304
 
      interface = strdup(direntries[0]->d_name);
1305
 
      if(debug){
1306
 
        fprintf(stderr, "Using interface \"%s\"\n", interface);
1307
 
      }
1308
 
      if(interface == NULL){
1309
 
        perror("malloc");
1310
 
        free(direntries);
1311
 
        exitcode = EXIT_FAILURE;
1312
 
        goto end;
1313
 
      }
1314
 
      free(direntries);
1315
 
    } else {
1316
 
      free(direntries);
1317
 
      fprintf(stderr, "Could not find a network interface\n");
1318
 
      exitcode = EXIT_FAILURE;
1319
 
      goto end;
1320
 
    }
1321
 
  }
1322
 
  
1323
 
  /* Initialize Avahi early so avahi_simple_poll_quit() can be called
1324
 
     from the signal handler */
1325
 
  /* Initialize the pseudo-RNG for Avahi */
1326
 
  srand((unsigned int) time(NULL));
1327
 
  mc.simple_poll = avahi_simple_poll_new();
1328
 
  if(mc.simple_poll == NULL){
1329
 
    fprintf(stderr, "Avahi: Failed to create simple poll object.\n");
1330
 
    exitcode = EX_UNAVAILABLE;
1331
 
    goto end;
1332
 
  }
1333
 
  
1334
 
  sigemptyset(&sigterm_action.sa_mask);
1335
 
  ret = sigaddset(&sigterm_action.sa_mask, SIGINT);
1336
 
  if(ret == -1){
1337
 
    perror("sigaddset");
1338
 
    exitcode = EX_OSERR;
1339
 
    goto end;
1340
 
  }
1341
 
  ret = sigaddset(&sigterm_action.sa_mask, SIGHUP);
1342
 
  if(ret == -1){
1343
 
    perror("sigaddset");
1344
 
    exitcode = EX_OSERR;
1345
 
    goto end;
1346
 
  }
1347
 
  ret = sigaddset(&sigterm_action.sa_mask, SIGTERM);
1348
 
  if(ret == -1){
1349
 
    perror("sigaddset");
1350
 
    exitcode = EX_OSERR;
1351
 
    goto end;
1352
 
  }
1353
 
  /* Need to check if the handler is SIG_IGN before handling:
1354
 
     | [[info:libc:Initial Signal Actions]] |
1355
 
     | [[info:libc:Basic Signal Handling]]  |
1356
 
  */
1357
 
  ret = sigaction(SIGINT, NULL, &old_sigterm_action);
1358
 
  if(ret == -1){
1359
 
    perror("sigaction");
1360
 
    return EX_OSERR;
1361
 
  }
1362
 
  if(old_sigterm_action.sa_handler != SIG_IGN){
1363
 
    ret = sigaction(SIGINT, &sigterm_action, NULL);
1364
 
    if(ret == -1){
1365
 
      perror("sigaction");
1366
 
      exitcode = EX_OSERR;
1367
 
      goto end;
1368
 
    }
1369
 
  }
1370
 
  ret = sigaction(SIGHUP, NULL, &old_sigterm_action);
1371
 
  if(ret == -1){
1372
 
    perror("sigaction");
1373
 
    return EX_OSERR;
1374
 
  }
1375
 
  if(old_sigterm_action.sa_handler != SIG_IGN){
1376
 
    ret = sigaction(SIGHUP, &sigterm_action, NULL);
1377
 
    if(ret == -1){
1378
 
      perror("sigaction");
1379
 
      exitcode = EX_OSERR;
1380
 
      goto end;
1381
 
    }
1382
 
  }
1383
 
  ret = sigaction(SIGTERM, NULL, &old_sigterm_action);
1384
 
  if(ret == -1){
1385
 
    perror("sigaction");
1386
 
    return EX_OSERR;
1387
 
  }
1388
 
  if(old_sigterm_action.sa_handler != SIG_IGN){
1389
 
    ret = sigaction(SIGTERM, &sigterm_action, NULL);
1390
 
    if(ret == -1){
1391
 
      perror("sigaction");
1392
 
      exitcode = EX_OSERR;
1393
 
      goto end;
1394
 
    }
1395
 
  }
1396
 
  
1397
 
  /* If the interface is down, bring it up */
1398
 
  if(strcmp(interface, "none") != 0){
1399
 
    if_index = (AvahiIfIndex) if_nametoindex(interface);
1400
 
    if(if_index == 0){
1401
 
      fprintf(stderr, "No such interface: \"%s\"\n", interface);
1402
 
      exitcode = EX_UNAVAILABLE;
1403
 
      goto end;
1404
 
    }
1405
 
    
1406
 
    if(quit_now){
1407
 
      goto end;
1408
 
    }
1409
 
    
1410
 
    /* Re-raise priviliges */
1411
 
    errno = 0;
1412
 
    ret = seteuid(0);
1413
 
    if(ret == -1){
1414
 
      perror("seteuid");
1415
 
    }
1416
 
    
1417
 
#ifdef __linux__
1418
 
    /* Lower kernel loglevel to KERN_NOTICE to avoid KERN_INFO
1419
 
       messages about the network interface to mess up the prompt */
1420
 
    ret = klogctl(8, NULL, 5);
1421
 
    bool restore_loglevel = true;
1422
 
    if(ret == -1){
1423
 
      restore_loglevel = false;
1424
 
      perror("klogctl");
1425
 
    }
1426
 
#endif  /* __linux__ */
1427
 
    
1428
 
    sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
1429
 
    if(sd < 0){
1430
 
      perror("socket");
1431
 
      exitcode = EX_OSERR;
1432
 
#ifdef __linux__
1433
 
      if(restore_loglevel){
1434
 
        ret = klogctl(7, NULL, 0);
1435
 
        if(ret == -1){
1436
 
          perror("klogctl");
1437
 
        }
1438
 
      }
1439
 
#endif  /* __linux__ */
1440
 
      /* Lower privileges */
1441
 
      errno = 0;
1442
 
      ret = seteuid(uid);
1443
 
      if(ret == -1){
1444
 
        perror("seteuid");
1445
 
      }
1446
 
      goto end;
1447
 
    }
1448
 
    strcpy(network.ifr_name, interface);
1449
 
    ret = ioctl(sd, SIOCGIFFLAGS, &network);
1450
 
    if(ret == -1){
1451
 
      perror("ioctl SIOCGIFFLAGS");
1452
 
#ifdef __linux__
1453
 
      if(restore_loglevel){
1454
 
        ret = klogctl(7, NULL, 0);
1455
 
        if(ret == -1){
1456
 
          perror("klogctl");
1457
 
        }
1458
 
      }
1459
 
#endif  /* __linux__ */
1460
 
      exitcode = EX_OSERR;
1461
 
      /* Lower privileges */
1462
 
      errno = 0;
1463
 
      ret = seteuid(uid);
1464
 
      if(ret == -1){
1465
 
        perror("seteuid");
1466
 
      }
1467
 
      goto end;
1468
 
    }
1469
 
    if((network.ifr_flags & IFF_UP) == 0){
1470
 
      network.ifr_flags |= IFF_UP;
1471
 
      take_down_interface = true;
1472
 
      ret = ioctl(sd, SIOCSIFFLAGS, &network);
1473
 
      if(ret == -1){
1474
 
        take_down_interface = false;
1475
 
        perror("ioctl SIOCSIFFLAGS +IFF_UP");
1476
 
        exitcode = EX_OSERR;
1477
 
#ifdef __linux__
1478
 
        if(restore_loglevel){
1479
 
          ret = klogctl(7, NULL, 0);
1480
 
          if(ret == -1){
1481
 
            perror("klogctl");
1482
 
          }
1483
 
        }
1484
 
#endif  /* __linux__ */
1485
 
        /* Lower privileges */
1486
 
        errno = 0;
1487
 
        ret = seteuid(uid);
1488
 
        if(ret == -1){
1489
 
          perror("seteuid");
1490
 
        }
1491
 
        goto end;
1492
 
      }
1493
 
    }
1494
 
    /* sleep checking until interface is running */
1495
 
    for(int i=0; i < delay * 4; i++){
1496
 
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
1497
 
      if(ret == -1){
1498
 
        perror("ioctl SIOCGIFFLAGS");
1499
 
      } else if(network.ifr_flags & IFF_RUNNING){
1500
 
        break;
1501
 
      }
1502
 
      struct timespec sleeptime = { .tv_nsec = 250000000 };
1503
 
      ret = nanosleep(&sleeptime, NULL);
1504
 
      if(ret == -1 and errno != EINTR){
1505
 
        perror("nanosleep");
1506
 
      }
1507
 
    }
1508
 
    if(not take_down_interface){
1509
 
      /* We won't need the socket anymore */
1510
 
      ret = (int)TEMP_FAILURE_RETRY(close(sd));
1511
 
      if(ret == -1){
1512
 
        perror("close");
1513
 
      }
1514
 
    }
1515
 
#ifdef __linux__
1516
 
    if(restore_loglevel){
1517
 
      /* Restores kernel loglevel to default */
1518
 
      ret = klogctl(7, NULL, 0);
1519
 
      if(ret == -1){
1520
 
        perror("klogctl");
1521
 
      }
1522
 
    }
1523
 
#endif  /* __linux__ */
1524
 
    /* Lower privileges */
1525
 
    errno = 0;
1526
 
    if(take_down_interface){
1527
 
      /* Lower privileges */
1528
 
      ret = seteuid(uid);
1529
 
      if(ret == -1){
1530
 
        perror("seteuid");
1531
 
      }
1532
 
    } else {
1533
 
      /* Lower privileges permanently */
1534
 
      ret = setuid(uid);
1535
 
      if(ret == -1){
1536
 
        perror("setuid");
1537
 
      }
1538
 
    }
1539
 
  }
1540
 
  
1541
 
  if(quit_now){
1542
 
    goto end;
1543
 
  }
1544
 
  
1545
 
  ret = init_gnutls_global(pubkey, seckey);
1546
 
  if(ret == -1){
1547
 
    fprintf(stderr, "init_gnutls_global failed\n");
1548
 
    exitcode = EX_UNAVAILABLE;
1549
 
    goto end;
1550
 
  } else {
1551
 
    gnutls_initialized = true;
1552
 
  }
1553
 
  
1554
 
  if(quit_now){
1555
 
    goto end;
1556
 
  }
1557
 
  
1558
 
  tempdir_created = true;
1559
 
  if(mkdtemp(tempdir) == NULL){
1560
 
    tempdir_created = false;
1561
 
    perror("mkdtemp");
1562
 
    goto end;
1563
 
  }
1564
 
  
1565
 
  if(quit_now){
1566
 
    goto end;
1567
 
  }
1568
 
  
1569
 
  if(not init_gpgme(pubkey, seckey, tempdir)){
1570
 
    fprintf(stderr, "init_gpgme failed\n");
1571
 
    exitcode = EX_UNAVAILABLE;
1572
 
    goto end;
1573
 
  } else {
1574
 
    gpgme_initialized = true;
1575
 
  }
1576
 
  
1577
 
  if(quit_now){
1578
 
    goto end;
1579
 
  }
1580
 
  
1581
 
  if(connect_to != NULL){
1582
 
    /* Connect directly, do not use Zeroconf */
1583
 
    /* (Mainly meant for debugging) */
1584
 
    char *address = strrchr(connect_to, ':');
1585
 
    if(address == NULL){
1586
 
      fprintf(stderr, "No colon in address\n");
1587
 
      exitcode = EX_USAGE;
1588
 
      goto end;
1589
 
    }
1590
 
    
1591
 
    if(quit_now){
1592
 
      goto end;
1593
 
    }
1594
 
    
1595
 
    uint16_t port;
1596
 
    errno = 0;
1597
 
    tmpmax = strtoimax(address+1, &tmp, 10);
1598
 
    if(errno != 0 or tmp == address+1 or *tmp != '\0'
1599
 
       or tmpmax != (uint16_t)tmpmax){
1600
 
      fprintf(stderr, "Bad port number\n");
1601
 
      exitcode = EX_USAGE;
1602
 
      goto end;
1603
 
    }
1604
 
  
1605
 
    if(quit_now){
1606
 
      goto end;
1607
 
    }
1608
 
    
1609
 
    port = (uint16_t)tmpmax;
1610
 
    *address = '\0';
1611
 
    address = connect_to;
1612
 
    /* Colon in address indicates IPv6 */
1613
 
    int af;
1614
 
    if(strchr(address, ':') != NULL){
1615
 
      af = AF_INET6;
1616
 
    } else {
1617
 
      af = AF_INET;
1618
 
    }
1619
 
    
1620
 
    if(quit_now){
1621
 
      goto end;
1622
 
    }
1623
 
 
1624
 
    while(not quit_now){
1625
 
      ret = start_mandos_communication(address, port, if_index, af);
1626
 
      if(quit_now or ret == 0){
1627
 
        break;
1628
 
      }
1629
 
      sleep(15);
1630
 
    };
1631
 
 
1632
 
    if (not quit_now){
1633
 
      exitcode = EXIT_SUCCESS;
1634
 
    }
1635
 
 
1636
 
    goto end;
1637
 
  }
1638
 
  
1639
 
  if(quit_now){
1640
 
    goto end;
1641
 
  }
1642
 
  
1643
 
  {
 
464
static AvahiSimplePoll *simple_poll = NULL;
 
465
static AvahiServer *server = NULL;
 
466
 
 
467
static void resolve_callback(
 
468
    AvahiSServiceResolver *r,
 
469
    AVAHI_GCC_UNUSED AvahiIfIndex interface,
 
470
    AVAHI_GCC_UNUSED AvahiProtocol protocol,
 
471
    AvahiResolverEvent event,
 
472
    const char *name,
 
473
    const char *type,
 
474
    const char *domain,
 
475
    const char *host_name,
 
476
    const AvahiAddress *address,
 
477
    uint16_t port,
 
478
    AvahiStringList *txt,
 
479
    AvahiLookupResultFlags flags,
 
480
    AVAHI_GCC_UNUSED void* userdata) {
 
481
    
 
482
    assert(r);
 
483
 
 
484
    /* Called whenever a service has been resolved successfully or timed out */
 
485
 
 
486
    switch (event) {
 
487
        case AVAHI_RESOLVER_FAILURE:
 
488
            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)));
 
489
            break;
 
490
 
 
491
        case AVAHI_RESOLVER_FOUND: {
 
492
          char ip[AVAHI_ADDRESS_STR_MAX];
 
493
            avahi_address_snprint(ip, sizeof(ip), address);
 
494
            if(debug){
 
495
              fprintf(stderr, "Mandos server found at %s on port %d\n", ip, port);
 
496
            }
 
497
            int ret = start_mandos_communcation(ip, port);
 
498
            if (ret == 0){
 
499
              exit(EXIT_SUCCESS);
 
500
            } else {
 
501
              exit(EXIT_FAILURE);
 
502
            }
 
503
        }
 
504
    }
 
505
    avahi_s_service_resolver_free(r);
 
506
}
 
507
 
 
508
static void browse_callback(
 
509
    AvahiSServiceBrowser *b,
 
510
    AvahiIfIndex interface,
 
511
    AvahiProtocol protocol,
 
512
    AvahiBrowserEvent event,
 
513
    const char *name,
 
514
    const char *type,
 
515
    const char *domain,
 
516
    AVAHI_GCC_UNUSED AvahiLookupResultFlags flags,
 
517
    void* userdata) {
 
518
    
 
519
    AvahiServer *s = userdata;
 
520
    assert(b);
 
521
 
 
522
    /* Called whenever a new services becomes available on the LAN or is removed from the LAN */
 
523
 
 
524
    switch (event) {
 
525
 
 
526
        case AVAHI_BROWSER_FAILURE:
 
527
            
 
528
            fprintf(stderr, "(Browser) %s\n", avahi_strerror(avahi_server_errno(server)));
 
529
            avahi_simple_poll_quit(simple_poll);
 
530
            return;
 
531
 
 
532
        case AVAHI_BROWSER_NEW:
 
533
            /* We ignore the returned resolver object. In the callback
 
534
               function we free it. If the server is terminated before
 
535
               the callback function is called the server will free
 
536
               the resolver for us. */
 
537
            
 
538
            if (!(avahi_s_service_resolver_new(s, interface, protocol, name, type, domain, AVAHI_PROTO_INET6, 0, resolve_callback, s)))
 
539
                fprintf(stderr, "Failed to resolve service '%s': %s\n", name, avahi_strerror(avahi_server_errno(s)));
 
540
            
 
541
            break;
 
542
 
 
543
        case AVAHI_BROWSER_REMOVE:
 
544
            break;
 
545
 
 
546
        case AVAHI_BROWSER_ALL_FOR_NOW:
 
547
        case AVAHI_BROWSER_CACHE_EXHAUSTED:
 
548
            break;
 
549
    }
 
550
}
 
551
 
 
552
int main(AVAHI_GCC_UNUSED int argc, AVAHI_GCC_UNUSED char*argv[]) {
1644
553
    AvahiServerConfig config;
1645
 
    /* Do not publish any local Zeroconf records */
 
554
    AvahiSServiceBrowser *sb = NULL;
 
555
    const char db[] = "--debug";
 
556
    int error;
 
557
    int ret = 1;
 
558
    int returncode = EXIT_SUCCESS;
 
559
    char *basename = rindex(argv[0], '/');
 
560
    if(basename == NULL){
 
561
      basename = argv[0];
 
562
    } else {
 
563
      basename++;
 
564
    }
 
565
    
 
566
    char *program_name = malloc(strlen(basename) + sizeof(db));
 
567
 
 
568
    if (program_name == NULL){
 
569
      perror("argv[0]");
 
570
      return EXIT_FAILURE;
 
571
    }
 
572
    
 
573
    program_name[0] = '\0';
 
574
    
 
575
    for (int i = 1; i < argc; i++){
 
576
      if (not strncmp(argv[i], db, 5)){
 
577
          strcat(strcat(strcat(program_name, db ), "="), basename);
 
578
          if(not strcmp(argv[i], db) or not strcmp(argv[i], program_name)){
 
579
            debug = true;
 
580
          }
 
581
        }
 
582
    }
 
583
    free(program_name);
 
584
 
 
585
    if (not debug){
 
586
      avahi_set_log_function(empty_log);
 
587
    }
 
588
    
 
589
    /* Initialize the psuedo-RNG */
 
590
    srand(time(NULL));
 
591
 
 
592
    /* Allocate main loop object */
 
593
    if (!(simple_poll = avahi_simple_poll_new())) {
 
594
        fprintf(stderr, "Failed to create simple poll object.\n");
 
595
        
 
596
        goto exit;
 
597
    }
 
598
 
 
599
    /* Do not publish any local records */
1646
600
    avahi_server_config_init(&config);
1647
601
    config.publish_hinfo = 0;
1648
602
    config.publish_addresses = 0;
1649
603
    config.publish_workstation = 0;
1650
604
    config.publish_domain = 0;
1651
 
    
 
605
 
1652
606
    /* Allocate a new server */
1653
 
    mc.server = avahi_server_new(avahi_simple_poll_get
1654
 
                                 (mc.simple_poll), &config, NULL,
1655
 
                                 NULL, &error);
1656
 
    
1657
 
    /* Free the Avahi configuration data */
 
607
    server = avahi_server_new(avahi_simple_poll_get(simple_poll), &config, NULL, NULL, &error);
 
608
 
 
609
    /* Free the configuration data */
1658
610
    avahi_server_config_free(&config);
1659
 
  }
1660
 
  
1661
 
  /* Check if creating the Avahi server object succeeded */
1662
 
  if(mc.server == NULL){
1663
 
    fprintf(stderr, "Failed to create Avahi server: %s\n",
1664
 
            avahi_strerror(error));
1665
 
    exitcode = EX_UNAVAILABLE;
1666
 
    goto end;
1667
 
  }
1668
 
  
1669
 
  if(quit_now){
1670
 
    goto end;
1671
 
  }
1672
 
  
1673
 
  /* Create the Avahi service browser */
1674
 
  sb = avahi_s_service_browser_new(mc.server, if_index,
1675
 
                                   AVAHI_PROTO_UNSPEC, "_mandos._tcp",
1676
 
                                   NULL, 0, browse_callback, NULL);
1677
 
  if(sb == NULL){
1678
 
    fprintf(stderr, "Failed to create service browser: %s\n",
1679
 
            avahi_strerror(avahi_server_errno(mc.server)));
1680
 
    exitcode = EX_UNAVAILABLE;
1681
 
    goto end;
1682
 
  }
1683
 
  
1684
 
  if(quit_now){
1685
 
    goto end;
1686
 
  }
1687
 
  
1688
 
  /* Run the main loop */
1689
 
  
1690
 
  if(debug){
1691
 
    fprintf(stderr, "Starting Avahi loop search\n");
1692
 
  }
1693
 
  
1694
 
  avahi_simple_poll_loop(mc.simple_poll);
1695
 
  
1696
 
 end:
1697
 
  
1698
 
  if(debug){
1699
 
    fprintf(stderr, "%s exiting\n", argv[0]);
1700
 
  }
1701
 
  
1702
 
  /* Cleanup things */
1703
 
  if(sb != NULL)
1704
 
    avahi_s_service_browser_free(sb);
1705
 
  
1706
 
  if(mc.server != NULL)
1707
 
    avahi_server_free(mc.server);
1708
 
  
1709
 
  if(mc.simple_poll != NULL)
1710
 
    avahi_simple_poll_free(mc.simple_poll);
1711
 
  
1712
 
  if(gnutls_initialized){
1713
 
    gnutls_certificate_free_credentials(mc.cred);
1714
 
    gnutls_global_deinit();
1715
 
    gnutls_dh_params_deinit(mc.dh_params);
1716
 
  }
1717
 
  
1718
 
  if(gpgme_initialized){
1719
 
    gpgme_release(mc.ctx);
1720
 
  }
1721
 
  
1722
 
  /* Take down the network interface */
1723
 
  if(take_down_interface){
1724
 
    /* Re-raise priviliges */
1725
 
    errno = 0;
1726
 
    ret = seteuid(0);
1727
 
    if(ret == -1){
1728
 
      perror("seteuid");
1729
 
    }
1730
 
    if(geteuid() == 0){
1731
 
      ret = ioctl(sd, SIOCGIFFLAGS, &network);
1732
 
      if(ret == -1){
1733
 
        perror("ioctl SIOCGIFFLAGS");
1734
 
      } else if(network.ifr_flags & IFF_UP) {
1735
 
        network.ifr_flags &= ~(short)IFF_UP; /* clear flag */
1736
 
        ret = ioctl(sd, SIOCSIFFLAGS, &network);
1737
 
        if(ret == -1){
1738
 
          perror("ioctl SIOCSIFFLAGS -IFF_UP");
1739
 
        }
1740
 
      }
1741
 
      ret = (int)TEMP_FAILURE_RETRY(close(sd));
1742
 
      if(ret == -1){
1743
 
        perror("close");
1744
 
      }
1745
 
      /* Lower privileges permanently */
1746
 
      errno = 0;
1747
 
      ret = setuid(uid);
1748
 
      if(ret == -1){
1749
 
        perror("setuid");
1750
 
      }
1751
 
    }
1752
 
  }
1753
 
  
1754
 
  /* Removes the temp directory used by GPGME */
1755
 
  if(tempdir_created){
1756
 
    DIR *d;
1757
 
    struct dirent *direntry;
1758
 
    d = opendir(tempdir);
1759
 
    if(d == NULL){
1760
 
      if(errno != ENOENT){
1761
 
        perror("opendir");
1762
 
      }
1763
 
    } else {
1764
 
      while(true){
1765
 
        direntry = readdir(d);
1766
 
        if(direntry == NULL){
1767
 
          break;
1768
 
        }
1769
 
        /* Skip "." and ".." */
1770
 
        if(direntry->d_name[0] == '.'
1771
 
           and (direntry->d_name[1] == '\0'
1772
 
                or (direntry->d_name[1] == '.'
1773
 
                    and direntry->d_name[2] == '\0'))){
1774
 
          continue;
1775
 
        }
1776
 
        char *fullname = NULL;
1777
 
        ret = asprintf(&fullname, "%s/%s", tempdir,
1778
 
                       direntry->d_name);
1779
 
        if(ret < 0){
1780
 
          perror("asprintf");
1781
 
          continue;
1782
 
        }
1783
 
        ret = remove(fullname);
1784
 
        if(ret == -1){
1785
 
          fprintf(stderr, "remove(\"%s\"): %s\n", fullname,
1786
 
                  strerror(errno));
1787
 
        }
1788
 
        free(fullname);
1789
 
      }
1790
 
      closedir(d);
1791
 
    }
1792
 
    ret = rmdir(tempdir);
1793
 
    if(ret == -1 and errno != ENOENT){
1794
 
      perror("rmdir");
1795
 
    }
1796
 
  }
1797
 
  
1798
 
  if(quit_now){
1799
 
    sigemptyset(&old_sigterm_action.sa_mask);
1800
 
    old_sigterm_action.sa_handler = SIG_DFL;
1801
 
    ret = (int)TEMP_FAILURE_RETRY(sigaction(signal_received,
1802
 
                                            &old_sigterm_action,
1803
 
                                            NULL));
1804
 
    if(ret == -1){
1805
 
      perror("sigaction");
1806
 
    }
1807
 
    do {
1808
 
      ret = raise(signal_received);
1809
 
    } while(ret != 0 and errno == EINTR);
1810
 
    if(ret != 0){
1811
 
      perror("raise");
1812
 
      abort();
1813
 
    }
1814
 
    TEMP_FAILURE_RETRY(pause());
1815
 
  }
1816
 
  
1817
 
  return exitcode;
 
611
 
 
612
    /* Check if creating the server object succeeded */
 
613
    if (!server) {
 
614
        fprintf(stderr, "Failed to create server: %s\n", avahi_strerror(error));
 
615
        returncode = EXIT_FAILURE;
 
616
        goto exit;
 
617
    }
 
618
    
 
619
    /* Create the service browser */
 
620
    if (!(sb = avahi_s_service_browser_new(server, if_nametoindex("eth0"), AVAHI_PROTO_INET6, "_mandos._tcp", NULL, 0, browse_callback, server))) {
 
621
        fprintf(stderr, "Failed to create service browser: %s\n", avahi_strerror(avahi_server_errno(server)));
 
622
        returncode = EXIT_FAILURE;
 
623
        goto exit;
 
624
    }
 
625
    
 
626
    /* Run the main loop */
 
627
 
 
628
    if (debug){
 
629
      fprintf(stderr, "Starting avahi loop search\n");
 
630
    }
 
631
    
 
632
    avahi_simple_poll_loop(simple_poll);
 
633
    
 
634
exit:
 
635
 
 
636
    if (debug){
 
637
      fprintf(stderr, "%s exiting\n", argv[0]);
 
638
    }
 
639
    
 
640
    /* Cleanup things */
 
641
    if (sb)
 
642
        avahi_s_service_browser_free(sb);
 
643
    
 
644
    if (server)
 
645
        avahi_server_free(server);
 
646
 
 
647
    if (simple_poll)
 
648
        avahi_simple_poll_free(simple_poll);
 
649
 
 
650
    return ret;
1818
651
}