32
32
#define _LARGEFILE_SOURCE
33
33
#define _FILE_OFFSET_BITS 64
35
#define _GNU_SOURCE /* TEMP_FAILURE_RETRY() */
36
38
#include <assert.h>
37
39
#include <stdlib.h>
39
41
#include <net/if.h> /* if_nametoindex */
40
#include <sys/ioctl.h> // ioctl, ifreq, SIOCGIFFLAGS, IFF_UP, SIOCSIFFLAGS
41
#include <net/if.h> // ioctl, ifreq, SIOCGIFFLAGS, IFF_UP, SIOCSIFFLAGS
42
#include <sys/ioctl.h> /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
44
#include <net/if.h> /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
43
47
#include <avahi-core/core.h>
44
48
#include <avahi-core/lookup.h>
77
82
bool debug = false;
84
const char mandos_protocol_version[] = "1";
79
86
/* Used for passing in values through all the callback functions */
81
88
AvahiSimplePoll *simple_poll;
82
89
AvahiServer *server;
83
90
gnutls_certificate_credentials_t cred;
84
91
unsigned int dh_bits;
92
gnutls_dh_params_t dh_params;
85
93
const char *priority;
88
static ssize_t pgp_packet_decrypt (char *packet, size_t packet_size,
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);
103
buffer_capacity += BUFFER_SIZE;
105
return buffer_capacity;
109
* Decrypt OpenPGP data using keyrings in HOMEDIR.
110
* Returns -1 on error
112
static ssize_t pgp_packet_decrypt (const char *cryptotext,
90
115
const char *homedir){
91
116
gpgme_data_t dh_crypto, dh_plain;
95
ssize_t new_packet_capacity = 0;
96
ssize_t new_packet_length = 0;
120
size_t plaintext_capacity = 0;
121
ssize_t plaintext_length = 0;
97
122
gpgme_engine_info_t engine_info;
100
fprintf(stderr, "Trying to decrypt OpenPGP packet\n");
125
fprintf(stderr, "Trying to decrypt OpenPGP data\n");
125
150
engine_info = engine_info->next;
127
152
if(engine_info == NULL){
128
fprintf(stderr, "Could not set home dir to %s\n", homedir);
153
fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
132
/* Create new GPGME data buffer from packet buffer */
133
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,
134
160
if (rc != GPG_ERR_NO_ERROR){
135
161
fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
136
162
gpgme_strsource(rc), gpgme_strerror(rc));
150
177
if (rc != GPG_ERR_NO_ERROR){
151
178
fprintf(stderr, "bad gpgme_new: %s: %s\n",
152
179
gpgme_strsource(rc), gpgme_strerror(rc));
180
plaintext_length = -1;
156
/* Decrypt data from the FILE pointer to the plaintext data
184
/* Decrypt data from the cryptotext data buffer to the plaintext
158
186
rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
159
187
if (rc != GPG_ERR_NO_ERROR){
160
188
fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
161
189
gpgme_strsource(rc), gpgme_strerror(rc));
190
plaintext_length = -1;
166
fprintf(stderr, "Decryption of OpenPGP packet succeeded\n");
195
fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
170
199
gpgme_decrypt_result_t result;
171
200
result = gpgme_op_decrypt_result(ctx);
198
/* Delete the GPGME FILE pointer cryptotext data buffer */
199
gpgme_data_release(dh_crypto);
201
227
/* Seek back to the beginning of the GPGME plaintext data buffer */
202
228
if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
203
229
perror("pgpme_data_seek");
230
plaintext_length = -1;
208
if (new_packet_length + BUFFER_SIZE > new_packet_capacity){
209
*new_packet = realloc(*new_packet,
210
(unsigned int)new_packet_capacity
212
if (*new_packet == NULL){
216
new_packet_capacity += BUFFER_SIZE;
236
plaintext_capacity = adjustbuffer(plaintext, (size_t)plaintext_length,
238
if (plaintext_capacity == 0){
239
perror("adjustbuffer");
240
plaintext_length = -1;
219
ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length,
244
ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
221
246
/* Print the data, if any */
226
252
perror("gpgme_data_read");
253
plaintext_length = -1;
229
new_packet_length += ret;
256
plaintext_length += ret;
232
/* FIXME: check characters before printing to screen so to not print
233
terminal control characters */
235
/* fprintf(stderr, "decrypted password is: "); */
236
/* fwrite(*new_packet, 1, new_packet_length, stderr); */
237
/* fprintf(stderr, "\n"); */
260
fprintf(stderr, "Decrypted password is: ");
261
for(ssize_t i = 0; i < plaintext_length; i++){
262
fprintf(stderr, "%02hhX ", (*plaintext)[i]);
264
fprintf(stderr, "\n");
269
/* Delete the GPGME cryptotext data buffer */
270
gpgme_data_release(dh_crypto);
240
272
/* Delete the GPGME plaintext data buffer */
241
273
gpgme_data_release(dh_plain);
242
return new_packet_length;
274
return plaintext_length;
245
277
static const char * safer_gnutls_strerror (int value) {
266
297
if ((ret = gnutls_global_init ())
267
298
!= GNUTLS_E_SUCCESS) {
268
fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
299
fprintf (stderr, "GnuTLS global_init: %s\n",
300
safer_gnutls_strerror(ret));
305
/* "Use a log level over 10 to enable all debugging options."
273
308
gnutls_global_set_log_level(11);
274
309
gnutls_global_set_log_function(debuggnutls);
277
/* openpgp credentials */
312
/* OpenPGP credentials */
278
313
if ((ret = gnutls_certificate_allocate_credentials (&mc->cred))
279
314
!= GNUTLS_E_SUCCESS) {
280
fprintf (stderr, "memory error: %s\n",
315
fprintf (stderr, "GnuTLS memory error: %s\n",
281
316
safer_gnutls_strerror(ret));
291
326
ret = gnutls_certificate_set_openpgp_key_file
292
327
(mc->cred, pubkeyfile, seckeyfile, GNUTLS_OPENPGP_FMT_BASE64);
293
328
if (ret != GNUTLS_E_SUCCESS) {
295
(stderr, "Error[%d] while reading the OpenPGP key pair ('%s',"
297
ret, pubkeyfile, seckeyfile);
298
fprintf(stdout, "The Error is: %s\n",
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",
299
333
safer_gnutls_strerror(ret));
303
//GnuTLS server initialization
304
if ((ret = gnutls_dh_params_init(dh_params))
305
!= GNUTLS_E_SUCCESS) {
306
fprintf (stderr, "Error in dh parameter initialization: %s\n",
307
safer_gnutls_strerror(ret));
311
if ((ret = gnutls_dh_params_generate2(*dh_params, mc->dh_bits))
312
!= GNUTLS_E_SUCCESS) {
313
fprintf (stderr, "Error in prime generation: %s\n",
314
safer_gnutls_strerror(ret));
318
gnutls_certificate_set_dh_params(mc->cred, *dh_params);
320
// GnuTLS session creation
321
if ((ret = gnutls_init(session, GNUTLS_SERVER))
322
!= GNUTLS_E_SUCCESS){
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));
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));
351
gnutls_certificate_set_dh_params(mc->cred, mc->dh_params);
356
static int init_gnutls_session(mandos_context *mc, gnutls_session_t *session){
358
/* GnuTLS session creation */
359
ret = gnutls_init(session, GNUTLS_SERVER);
360
if (ret != GNUTLS_E_SUCCESS){
323
361
fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
324
362
safer_gnutls_strerror(ret));
327
if ((ret = gnutls_priority_set_direct(*session, mc->priority, &err))
328
!= GNUTLS_E_SUCCESS) {
329
fprintf(stderr, "Syntax error at: %s\n", err);
330
fprintf(stderr, "GnuTLS error: %s\n",
331
safer_gnutls_strerror(ret));
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));
335
if ((ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
337
!= GNUTLS_E_SUCCESS) {
338
fprintf(stderr, "Error setting a credentials set: %s\n",
376
ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
378
if (ret != GNUTLS_E_SUCCESS) {
379
fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
339
380
safer_gnutls_strerror(ret));
420
470
perror("connect");
424
ret = initgnutls (mc, &session, &dh_params);
474
const char *out = mandos_protocol_version;
477
size_t out_size = strlen(out);
478
ret = TEMP_FAILURE_RETRY(write(tcp_sd, out + written,
479
out_size - written));
485
written += (size_t)ret;
486
if(written < out_size){
489
if (out == mandos_protocol_version){
499
fprintf(stderr, "Establishing TLS session with %s\n", ip);
430
502
gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
433
fprintf(stderr, "Establishing TLS session with %s\n", ip);
436
504
ret = gnutls_handshake (session);
438
506
if (ret != GNUTLS_E_SUCCESS){
440
fprintf(stderr, "\n*** Handshake failed ***\n");
508
fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
441
509
gnutls_perror (ret);
447
//Retrieve OpenPGP packet that contains the wanted password
515
/* Read OpenPGP packet that contains the wanted password */
450
518
fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
474
540
case GNUTLS_E_REHANDSHAKE:
475
541
ret = gnutls_handshake (session);
477
fprintf(stderr, "\n*** Handshake failed ***\n");
543
fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
478
544
gnutls_perror (ret);
484
550
fprintf(stderr, "Unknown error while reading data from"
485
" encrypted session with mandos server\n");
551
" encrypted session with Mandos server\n");
487
553
gnutls_bye (session, GNUTLS_SHUT_RDWR);
491
557
buffer_length += (size_t) ret;
562
fprintf(stderr, "Closing TLS session\n");
565
gnutls_bye (session, GNUTLS_SHUT_RDWR);
495
567
if (buffer_length > 0){
496
568
decrypted_buffer_size = pgp_packet_decrypt(buffer,
498
570
&decrypted_buffer,
500
572
if (decrypted_buffer_size >= 0){
501
574
while(written < (size_t) decrypted_buffer_size){
502
575
ret = (int)fwrite (decrypted_buffer + written, 1,
503
576
(size_t)decrypted_buffer_size - written,
537
static void resolve_callback( AvahiSServiceResolver *r,
538
AvahiIfIndex interface,
539
AVAHI_GCC_UNUSED AvahiProtocol protocol,
540
AvahiResolverEvent event,
544
const char *host_name,
545
const AvahiAddress *address,
547
AVAHI_GCC_UNUSED AvahiStringList *txt,
548
AVAHI_GCC_UNUSED AvahiLookupResultFlags flags,
605
static void resolve_callback(AvahiSServiceResolver *r,
606
AvahiIfIndex interface,
607
AVAHI_GCC_UNUSED AvahiProtocol protocol,
608
AvahiResolverEvent event,
612
const char *host_name,
613
const AvahiAddress *address,
615
AVAHI_GCC_UNUSED AvahiStringList *txt,
616
AVAHI_GCC_UNUSED AvahiLookupResultFlags
550
619
mandos_context *mc = userdata;
551
620
assert(r); /* Spurious warning */
598
668
case AVAHI_BROWSER_FAILURE:
600
fprintf(stderr, "(Browser) %s\n",
670
fprintf(stderr, "(Avahi browser) %s\n",
601
671
avahi_strerror(avahi_server_errno(mc->server)));
602
672
avahi_simple_poll_quit(mc->simple_poll);
605
675
case AVAHI_BROWSER_NEW:
606
/* We ignore the returned resolver object. In the callback
607
function we free it. If the server is terminated before
608
the callback function is called the server will free
609
the resolver for us. */
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
611
if (!(avahi_s_service_resolver_new(mc->server, interface, protocol, name,
681
if (!(avahi_s_service_resolver_new(mc->server, interface,
682
protocol, name, type, domain,
613
683
AVAHI_PROTO_INET6, 0,
614
684
resolve_callback, mc)))
615
fprintf(stderr, "Failed to resolve service '%s': %s\n", name,
616
avahi_strerror(avahi_server_errno(mc->server)));
685
fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
686
name, avahi_strerror(avahi_server_errno(mc->server)));
619
689
case AVAHI_BROWSER_REMOVE:
649
int main(AVAHI_GCC_UNUSED int argc, AVAHI_GCC_UNUSED char*argv[]) {
650
AvahiServerConfig config;
722
int main(int argc, char *argv[]){
651
723
AvahiSServiceBrowser *sb = NULL;
655
int returncode = EXIT_SUCCESS;
726
int exitcode = EXIT_SUCCESS;
656
727
const char *interface = "eth0";
657
728
struct ifreq network;
659
732
char *connect_to = NULL;
660
733
AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
661
734
mandos_context mc = { .simple_poll = NULL, .server = NULL,
662
735
.dh_bits = 1024, .priority = "SECURE256"};
664
debug_int = debug ? 1 : 0;
666
struct option long_options[] = {
667
{"debug", no_argument, &debug_int, 1},
668
{"connect", required_argument, NULL, 'c'},
669
{"interface", required_argument, NULL, 'i'},
670
{"keydir", required_argument, NULL, 'd'},
671
{"seckey", required_argument, NULL, 's'},
672
{"pubkey", required_argument, NULL, 'p'},
673
{"dh-bits", required_argument, NULL, 'D'},
674
{"priority", required_argument, NULL, 'P'},
677
int option_index = 0;
678
ret = getopt_long (argc, argv, "i:", long_options,
705
mc.dh_bits = (unsigned int) strtol(optarg, NULL, 10);
738
/* Temporary int to get the address of for getopt_long */
739
int debug_int = debug ? 1 : 0;
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'},
752
int option_index = 0;
753
ret = getopt_long (argc, argv, "i:", long_options,
780
mc.dh_bits = (unsigned int) strtol(optarg, NULL, 10);
787
mc.priority = optarg;
791
/* getopt_long() has already printed a message about the
792
unrcognized option, so just exit. */
708
793
exit(EXIT_FAILURE);
712
mc.priority = optarg;
796
/* Set the global debug flag from the temporary int */
797
debug = debug_int ? true : false;
719
debug = debug_int ? true : false;
721
800
pubkeyfile = combinepath(keydir, pubkeyfile);
722
801
if (pubkeyfile == NULL){
723
802
perror("combinepath");
724
returncode = EXIT_FAILURE;
803
exitcode = EXIT_FAILURE;
728
807
seckeyfile = combinepath(keydir, seckeyfile);
729
808
if (seckeyfile == NULL){
730
809
perror("combinepath");
813
ret = init_gnutls_global(&mc);
815
fprintf(stderr, "init_gnutls_global\n");
734
832
if_index = (AvahiIfIndex) if_nametoindex(interface);
743
841
char *address = strrchr(connect_to, ':');
744
842
if(address == NULL){
745
843
fprintf(stderr, "No colon in address\n");
844
exitcode = EXIT_FAILURE;
749
848
uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
751
850
perror("Bad port number");
851
exitcode = EXIT_FAILURE;
755
855
address = connect_to;
756
856
ret = start_mandos_communication(address, port, if_index, &mc);
858
exitcode = EXIT_FAILURE;
860
exitcode = EXIT_SUCCESS;
764
sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
767
returncode = EXIT_FAILURE;
770
strcpy(network.ifr_name, interface); /* Spurious warning */
771
ret = ioctl(sd, SIOCGIFFLAGS, &network);
774
perror("ioctl SIOCGIFFLAGS");
775
returncode = EXIT_FAILURE;
778
if((network.ifr_flags & IFF_UP) == 0){
779
network.ifr_flags |= IFF_UP;
780
ret = ioctl(sd, SIOCSIFFLAGS, &network);
865
/* If the interface is down, bring it up */
867
sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
870
exitcode = EXIT_FAILURE;
873
strcpy(network.ifr_name, interface); /* Spurious warning */
874
ret = ioctl(sd, SIOCGIFFLAGS, &network);
782
perror("ioctl SIOCSIFFLAGS");
783
returncode = EXIT_FAILURE;
876
perror("ioctl SIOCGIFFLAGS");
877
exitcode = EXIT_FAILURE;
880
if((network.ifr_flags & IFF_UP) == 0){
881
network.ifr_flags |= IFF_UP;
882
ret = ioctl(sd, SIOCSIFFLAGS, &network);
884
perror("ioctl SIOCSIFFLAGS");
885
exitcode = EXIT_FAILURE;
790
893
avahi_set_log_function(empty_log);
793
/* Initialize the psuedo-RNG */
896
/* Initialize the pseudo-RNG for Avahi */
794
897
srand((unsigned int) time(NULL));
796
/* Allocate main loop object */
797
if (!(mc.simple_poll = avahi_simple_poll_new())) {
798
fprintf(stderr, "Failed to create simple poll object.\n");
799
returncode = EXIT_FAILURE;
803
/* Do not publish any local records */
804
avahi_server_config_init(&config);
805
config.publish_hinfo = 0;
806
config.publish_addresses = 0;
807
config.publish_workstation = 0;
808
config.publish_domain = 0;
810
/* Allocate a new server */
811
mc.server=avahi_server_new(avahi_simple_poll_get(mc.simple_poll),
812
&config, NULL, NULL, &error);
814
/* Free the configuration data */
815
avahi_server_config_free(&config);
817
/* Check if creating the server object succeeded */
819
fprintf(stderr, "Failed to create server: %s\n",
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"
904
exitcode = EXIT_FAILURE;
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;
917
/* Allocate a new server */
918
mc.server = avahi_server_new(avahi_simple_poll_get
919
(mc.simple_poll), &config, NULL,
922
/* Free the Avahi configuration data */
923
avahi_server_config_free(&config);
926
/* Check if creating the Avahi server object succeeded */
927
if (mc.server == NULL) {
928
fprintf(stderr, "Failed to create Avahi server: %s\n",
820
929
avahi_strerror(error));
821
returncode = EXIT_FAILURE;
930
exitcode = EXIT_FAILURE;
825
/* Create the service browser */
934
/* Create the Avahi service browser */
826
935
sb = avahi_s_service_browser_new(mc.server, if_index,
827
936
AVAHI_PROTO_INET6,
828
937
"_mandos._tcp", NULL, 0,
829
938
browse_callback, &mc);
831
940
fprintf(stderr, "Failed to create service browser: %s\n",
832
941
avahi_strerror(avahi_server_errno(mc.server)));
833
returncode = EXIT_FAILURE;
942
exitcode = EXIT_FAILURE;
837
946
/* Run the main loop */
840
fprintf(stderr, "Starting avahi loop search\n");
949
fprintf(stderr, "Starting Avahi loop search\n");
843
952
avahi_simple_poll_loop(mc.simple_poll);
848
957
fprintf(stderr, "%s exiting\n", argv[0]);
851
960
/* Cleanup things */
853
962
avahi_s_service_browser_free(sb);
964
if (mc.server != NULL)
856
965
avahi_server_free(mc.server);
967
if (mc.simple_poll != NULL)
859
968
avahi_simple_poll_free(mc.simple_poll);
860
969
free(pubkeyfile);
861
970
free(seckeyfile);