32
32
#define _LARGEFILE_SOURCE
33
33
#define _FILE_OFFSET_BITS 64
35
#define _GNU_SOURCE /* TEMP_FAILURE_RETRY() */
38
36
#include <assert.h>
39
37
#include <stdlib.h>
41
39
#include <net/if.h> /* if_nametoindex */
42
#include <sys/ioctl.h> /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
44
#include <net/if.h> /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
40
#include <sys/ioctl.h> // ioctl, ifreq, SIOCGIFFLAGS, IFF_UP, SIOCSIFFLAGS
41
#include <net/if.h> // ioctl, ifreq, SIOCGIFFLAGS, IFF_UP, SIOCSIFFLAGS
47
43
#include <avahi-core/core.h>
48
44
#include <avahi-core/lookup.h>
82
77
bool debug = false;
84
const char mandos_protocol_version[] = "1";
86
79
/* Used for passing in values through all the callback functions */
88
81
AvahiSimplePoll *simple_poll;
89
82
AvahiServer *server;
90
83
gnutls_certificate_credentials_t cred;
91
84
unsigned int dh_bits;
92
gnutls_dh_params_t dh_params;
93
85
const char *priority;
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,
88
static ssize_t pgp_packet_decrypt (char *packet, size_t packet_size,
115
90
const char *homedir){
116
91
gpgme_data_t dh_crypto, dh_plain;
120
size_t plaintext_capacity = 0;
121
ssize_t plaintext_length = 0;
95
ssize_t new_packet_capacity = 0;
96
ssize_t new_packet_length = 0;
122
97
gpgme_engine_info_t engine_info;
125
fprintf(stderr, "Trying to decrypt OpenPGP data\n");
100
fprintf(stderr, "Trying to decrypt OpenPGP packet\n");
150
125
engine_info = engine_info->next;
152
127
if(engine_info == NULL){
153
fprintf(stderr, "Could not set GPGME home dir to %s\n", homedir);
128
fprintf(stderr, "Could not set home dir to %s\n", homedir);
157
/* Create new GPGME data buffer from memory cryptotext */
158
rc = gpgme_data_new_from_mem(&dh_crypto, cryptotext, crypto_size,
132
/* Create new GPGME data buffer from packet buffer */
133
rc = gpgme_data_new_from_mem(&dh_crypto, packet, packet_size, 0);
160
134
if (rc != GPG_ERR_NO_ERROR){
161
135
fprintf(stderr, "bad gpgme_data_new_from_mem: %s: %s\n",
162
136
gpgme_strsource(rc), gpgme_strerror(rc));
177
150
if (rc != GPG_ERR_NO_ERROR){
178
151
fprintf(stderr, "bad gpgme_new: %s: %s\n",
179
152
gpgme_strsource(rc), gpgme_strerror(rc));
180
plaintext_length = -1;
184
/* Decrypt data from the cryptotext data buffer to the plaintext
156
/* Decrypt data from the FILE pointer to the plaintext data
186
158
rc = gpgme_op_decrypt(ctx, dh_crypto, dh_plain);
187
159
if (rc != GPG_ERR_NO_ERROR){
188
160
fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
189
161
gpgme_strsource(rc), gpgme_strerror(rc));
190
plaintext_length = -1;
195
fprintf(stderr, "Decryption of OpenPGP data succeeded\n");
166
fprintf(stderr, "Decryption of OpenPGP packet succeeded\n");
199
170
gpgme_decrypt_result_t result;
200
171
result = gpgme_op_decrypt_result(ctx);
198
/* Delete the GPGME FILE pointer cryptotext data buffer */
199
gpgme_data_release(dh_crypto);
227
201
/* Seek back to the beginning of the GPGME plaintext data buffer */
228
202
if (gpgme_data_seek(dh_plain, (off_t) 0, SEEK_SET) == -1){
229
203
perror("pgpme_data_seek");
230
plaintext_length = -1;
236
plaintext_capacity = adjustbuffer(plaintext, (size_t)plaintext_length,
238
if (plaintext_capacity == 0){
239
perror("adjustbuffer");
240
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;
244
ret = gpgme_data_read(dh_plain, *plaintext + plaintext_length,
219
ret = gpgme_data_read(dh_plain, *new_packet + new_packet_length,
246
221
/* Print the data, if any */
252
226
perror("gpgme_data_read");
253
plaintext_length = -1;
256
plaintext_length += ret;
229
new_packet_length += ret;
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);
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"); */
272
240
/* Delete the GPGME plaintext data buffer */
273
241
gpgme_data_release(dh_plain);
274
return plaintext_length;
242
return new_packet_length;
277
245
static const char * safer_gnutls_strerror (int value) {
297
266
if ((ret = gnutls_global_init ())
298
267
!= GNUTLS_E_SUCCESS) {
299
fprintf (stderr, "GnuTLS global_init: %s\n",
300
safer_gnutls_strerror(ret));
268
fprintf (stderr, "global_init: %s\n", safer_gnutls_strerror(ret));
305
/* "Use a log level over 10 to enable all debugging options."
308
273
gnutls_global_set_log_level(11);
309
274
gnutls_global_set_log_function(debuggnutls);
312
/* OpenPGP credentials */
277
/* openpgp credentials */
313
278
if ((ret = gnutls_certificate_allocate_credentials (&mc->cred))
314
279
!= GNUTLS_E_SUCCESS) {
315
fprintf (stderr, "GnuTLS memory error: %s\n",
280
fprintf (stderr, "memory error: %s\n",
316
281
safer_gnutls_strerror(ret));
326
291
ret = gnutls_certificate_set_openpgp_key_file
327
292
(mc->cred, pubkeyfile, seckeyfile, GNUTLS_OPENPGP_FMT_BASE64);
328
293
if (ret != GNUTLS_E_SUCCESS) {
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",
295
(stderr, "Error[%d] while reading the OpenPGP key pair ('%s',"
297
ret, pubkeyfile, seckeyfile);
298
fprintf(stdout, "The Error is: %s\n",
333
299
safer_gnutls_strerror(ret));
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){
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){
361
323
fprintf(stderr, "Error in GnuTLS session initialization: %s\n",
362
324
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));
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));
376
ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
378
if (ret != GNUTLS_E_SUCCESS) {
379
fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
335
if ((ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
337
!= GNUTLS_E_SUCCESS) {
338
fprintf(stderr, "Error setting a credentials set: %s\n",
380
339
safer_gnutls_strerror(ret));
470
420
perror("connect");
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){
424
ret = initgnutls (mc, &session, &dh_params);
430
gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
499
433
fprintf(stderr, "Establishing TLS session with %s\n", ip);
502
gnutls_transport_set_ptr (session, (gnutls_transport_ptr_t) tcp_sd);
504
436
ret = gnutls_handshake (session);
506
438
if (ret != GNUTLS_E_SUCCESS){
508
fprintf(stderr, "*** GnuTLS Handshake failed ***\n");
440
fprintf(stderr, "\n*** Handshake failed ***\n");
509
441
gnutls_perror (ret);
515
/* Read OpenPGP packet that contains the wanted password */
447
//Retrieve OpenPGP packet that contains the wanted password
518
450
fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
540
474
case GNUTLS_E_REHANDSHAKE:
541
475
ret = gnutls_handshake (session);
543
fprintf(stderr, "*** GnuTLS Re-handshake failed ***\n");
477
fprintf(stderr, "\n*** Handshake failed ***\n");
544
478
gnutls_perror (ret);
550
484
fprintf(stderr, "Unknown error while reading data from"
551
" encrypted session with Mandos server\n");
485
" encrypted session with mandos server\n");
553
487
gnutls_bye (session, GNUTLS_SHUT_RDWR);
557
491
buffer_length += (size_t) ret;
562
fprintf(stderr, "Closing TLS session\n");
565
gnutls_bye (session, GNUTLS_SHUT_RDWR);
567
495
if (buffer_length > 0){
568
496
decrypted_buffer_size = pgp_packet_decrypt(buffer,
570
498
&decrypted_buffer,
572
500
if (decrypted_buffer_size >= 0){
574
501
while(written < (size_t) decrypted_buffer_size){
575
502
ret = (int)fwrite (decrypted_buffer + written, 1,
576
503
(size_t)decrypted_buffer_size - written,
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
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,
619
550
mandos_context *mc = userdata;
620
551
assert(r); /* Spurious warning */
668
598
case AVAHI_BROWSER_FAILURE:
670
fprintf(stderr, "(Avahi browser) %s\n",
600
fprintf(stderr, "(Browser) %s\n",
671
601
avahi_strerror(avahi_server_errno(mc->server)));
672
602
avahi_simple_poll_quit(mc->simple_poll);
675
605
case AVAHI_BROWSER_NEW:
676
/* We ignore the returned Avahi resolver object. In the callback
677
function we free it. If the Avahi server is terminated before
678
the callback function is called the Avahi server will free the
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. */
681
if (!(avahi_s_service_resolver_new(mc->server, interface,
682
protocol, name, type, domain,
611
if (!(avahi_s_service_resolver_new(mc->server, interface, protocol, name,
683
613
AVAHI_PROTO_INET6, 0,
684
614
resolve_callback, mc)))
685
fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
686
name, avahi_strerror(avahi_server_errno(mc->server)));
615
fprintf(stderr, "Failed to resolve service '%s': %s\n", name,
616
avahi_strerror(avahi_server_errno(mc->server)));
689
619
case AVAHI_BROWSER_REMOVE:
722
int main(int argc, char *argv[]){
649
int main(AVAHI_GCC_UNUSED int argc, AVAHI_GCC_UNUSED char*argv[]) {
650
AvahiServerConfig config;
723
651
AvahiSServiceBrowser *sb = NULL;
726
int exitcode = EXIT_SUCCESS;
655
int returncode = EXIT_SUCCESS;
727
656
const char *interface = "eth0";
728
657
struct ifreq network;
732
659
char *connect_to = NULL;
733
660
AvahiIfIndex if_index = AVAHI_IF_UNSPEC;
734
661
mandos_context mc = { .simple_poll = NULL, .server = NULL,
735
662
.dh_bits = 1024, .priority = "SECURE256"};
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. */
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);
793
708
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;
800
721
pubkeyfile = combinepath(keydir, pubkeyfile);
801
722
if (pubkeyfile == NULL){
802
723
perror("combinepath");
803
exitcode = EXIT_FAILURE;
724
returncode = EXIT_FAILURE;
807
728
seckeyfile = combinepath(keydir, seckeyfile);
808
729
if (seckeyfile == NULL){
809
730
perror("combinepath");
813
ret = init_gnutls_global(&mc);
815
fprintf(stderr, "init_gnutls_global\n");
832
734
if_index = (AvahiIfIndex) if_nametoindex(interface);
841
743
char *address = strrchr(connect_to, ':');
842
744
if(address == NULL){
843
745
fprintf(stderr, "No colon in address\n");
844
exitcode = EXIT_FAILURE;
848
749
uint16_t port = (uint16_t) strtol(address+1, NULL, 10);
850
751
perror("Bad port number");
851
exitcode = EXIT_FAILURE;
855
755
address = connect_to;
856
756
ret = start_mandos_communication(address, port, if_index, &mc);
858
exitcode = EXIT_FAILURE;
860
exitcode = EXIT_SUCCESS;
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);
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);
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;
782
perror("ioctl SIOCSIFFLAGS");
783
returncode = EXIT_FAILURE;
893
790
avahi_set_log_function(empty_log);
896
/* Initialize the pseudo-RNG for Avahi */
793
/* Initialize the psuedo-RNG */
897
794
srand((unsigned int) time(NULL));
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",
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",
929
820
avahi_strerror(error));
930
exitcode = EXIT_FAILURE;
821
returncode = EXIT_FAILURE;
934
/* Create the Avahi service browser */
825
/* Create the service browser */
935
826
sb = avahi_s_service_browser_new(mc.server, if_index,
936
827
AVAHI_PROTO_INET6,
937
828
"_mandos._tcp", NULL, 0,
938
829
browse_callback, &mc);
940
831
fprintf(stderr, "Failed to create service browser: %s\n",
941
832
avahi_strerror(avahi_server_errno(mc.server)));
942
exitcode = EXIT_FAILURE;
833
returncode = EXIT_FAILURE;
946
837
/* Run the main loop */
949
fprintf(stderr, "Starting Avahi loop search\n");
840
fprintf(stderr, "Starting avahi loop search\n");
952
843
avahi_simple_poll_loop(mc.simple_poll);
957
848
fprintf(stderr, "%s exiting\n", argv[0]);
960
851
/* Cleanup things */
962
853
avahi_s_service_browser_free(sb);
964
if (mc.server != NULL)
965
856
avahi_server_free(mc.server);
967
if (mc.simple_poll != NULL)
968
859
avahi_simple_poll_free(mc.simple_poll);
969
860
free(pubkeyfile);
970
861
free(seckeyfile);