42
42
#include <stddef.h> /* NULL, size_t, ssize_t */
43
43
#include <stdlib.h> /* free(), EXIT_SUCCESS, EXIT_FAILURE,
45
#include <stdbool.h> /* bool, false, true */
45
#include <stdbool.h> /* bool, true */
46
46
#include <string.h> /* memset(), strcmp(), strlen(),
47
47
strerror(), asprintf(), strcpy() */
48
#include <sys/ioctl.h> /* ioctl */
48
#include <sys/ioctl.h> /* ioctl */
49
49
#include <sys/types.h> /* socket(), inet_pton(), sockaddr,
50
50
sockaddr_in6, PF_INET6,
51
SOCK_STREAM, uid_t, gid_t, open(),
51
SOCK_STREAM, INET6_ADDRSTRLEN,
52
uid_t, gid_t, open(), opendir(),
53
54
#include <sys/stat.h> /* open() */
54
55
#include <sys/socket.h> /* socket(), struct sockaddr_in6,
55
inet_pton(), connect() */
56
struct in6_addr, inet_pton(),
56
58
#include <fcntl.h> /* open() */
57
59
#include <dirent.h> /* opendir(), struct dirent, readdir()
63
65
#include <net/if.h> /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
64
66
SIOCSIFFLAGS, if_indextoname(),
65
67
if_nametoindex(), IF_NAMESIZE */
66
#include <netinet/in.h> /* IN6_IS_ADDR_LINKLOCAL,
67
INET_ADDRSTRLEN, INET6_ADDRSTRLEN
68
#include <netinet/in.h>
69
69
#include <unistd.h> /* close(), SEEK_SET, off_t, write(),
70
70
getuid(), getgid(), setuid(),
72
72
#include <arpa/inet.h> /* inet_pton(), htons */
73
#include <iso646.h> /* not, or, and */
73
#include <iso646.h> /* not, and, or */
74
74
#include <argp.h> /* struct argp_option, error_t, struct
75
75
argp_state, struct argp,
76
76
argp_parse(), ARGP_KEY_ARG,
77
77
ARGP_KEY_END, ARGP_ERR_UNKNOWN */
78
#include <signal.h> /* sigemptyset(), sigaddset(), sigaction(), SIGTERM, sigaction */
80
79
#include <sys/klog.h> /* klogctl() */
131
130
} mandos_context;
133
/* global context so signal handler can reach it*/
137
* Make additional room in "buffer" for at least BUFFER_SIZE
138
* additional bytes. "buffer_capacity" is how much is currently
139
* allocated, "buffer_length" is how much is already used.
133
* Make room in "buffer" for at least BUFFER_SIZE additional bytes.
134
* "buffer_capacity" is how much is currently allocated,
135
* "buffer_length" is how much is already used.
141
size_t incbuffer(char **buffer, size_t buffer_length,
137
size_t adjustbuffer(char **buffer, size_t buffer_length,
142
138
size_t buffer_capacity){
143
139
if(buffer_length + BUFFER_SIZE > buffer_capacity){
144
140
*buffer = realloc(*buffer, buffer_capacity + BUFFER_SIZE);
154
150
* Initialize GPGME.
156
static bool init_gpgme(const char *seckey,
152
static bool init_gpgme(mandos_context *mc, const char *seckey,
157
153
const char *pubkey, const char *tempdir){
159
155
gpgme_error_t rc;
183
rc = gpgme_op_import(mc.ctx, pgp_data);
179
rc = gpgme_op_import(mc->ctx, pgp_data);
184
180
if(rc != GPG_ERR_NO_ERROR){
185
181
fprintf(stderr, "bad gpgme_op_import: %s: %s\n",
186
182
gpgme_strsource(rc), gpgme_strerror(rc));
231
227
/* Create new GPGME "context" */
232
rc = gpgme_new(&(mc.ctx));
228
rc = gpgme_new(&(mc->ctx));
233
229
if(rc != GPG_ERR_NO_ERROR){
234
230
fprintf(stderr, "bad gpgme_new: %s: %s\n",
235
231
gpgme_strsource(rc), gpgme_strerror(rc));
247
243
* Decrypt OpenPGP data.
248
244
* Returns -1 on error
250
static ssize_t pgp_packet_decrypt(const char *cryptotext,
246
static ssize_t pgp_packet_decrypt(const mandos_context *mc,
247
const char *cryptotext,
251
248
size_t crypto_size,
252
249
char **plaintext){
253
250
gpgme_data_t dh_crypto, dh_plain;
281
278
/* Decrypt data from the cryptotext data buffer to the plaintext
283
rc = gpgme_op_decrypt(mc.ctx, dh_crypto, dh_plain);
280
rc = gpgme_op_decrypt(mc->ctx, dh_crypto, dh_plain);
284
281
if(rc != GPG_ERR_NO_ERROR){
285
282
fprintf(stderr, "bad gpgme_op_decrypt: %s: %s\n",
286
283
gpgme_strsource(rc), gpgme_strerror(rc));
287
284
plaintext_length = -1;
289
286
gpgme_decrypt_result_t result;
290
result = gpgme_op_decrypt_result(mc.ctx);
287
result = gpgme_op_decrypt_result(mc->ctx);
291
288
if(result == NULL){
292
289
fprintf(stderr, "gpgme_op_decrypt_result failed\n");
330
327
*plaintext = NULL;
332
plaintext_capacity = incbuffer(plaintext,
329
plaintext_capacity = adjustbuffer(plaintext,
333
330
(size_t)plaintext_length,
334
331
plaintext_capacity);
335
332
if(plaintext_capacity == 0){
333
perror("adjustbuffer");
337
334
plaintext_length = -1;
338
335
goto decrypt_end;
385
382
fprintf(stderr, "GnuTLS: %s", string);
388
static int init_gnutls_global(const char *pubkeyfilename,
385
static int init_gnutls_global(mandos_context *mc,
386
const char *pubkeyfilename,
389
387
const char *seckeyfilename){
411
409
/* OpenPGP credentials */
412
gnutls_certificate_allocate_credentials(&mc.cred);
410
gnutls_certificate_allocate_credentials(&mc->cred);
413
411
if(ret != GNUTLS_E_SUCCESS){
414
412
fprintf(stderr, "GnuTLS memory error: %s\n", /* Spurious warning
418
416
safer_gnutls_strerror(ret));
419
417
gnutls_global_deinit();
429
427
ret = gnutls_certificate_set_openpgp_key_file
430
(mc.cred, pubkeyfilename, seckeyfilename,
428
(mc->cred, pubkeyfilename, seckeyfilename,
431
429
GNUTLS_OPENPGP_FMT_BASE64);
432
430
if(ret != GNUTLS_E_SUCCESS){
441
439
/* GnuTLS server initialization */
442
ret = gnutls_dh_params_init(&mc.dh_params);
440
ret = gnutls_dh_params_init(&mc->dh_params);
443
441
if(ret != GNUTLS_E_SUCCESS){
444
442
fprintf(stderr, "Error in GnuTLS DH parameter initialization:"
445
443
" %s\n", safer_gnutls_strerror(ret));
448
ret = gnutls_dh_params_generate2(mc.dh_params, mc.dh_bits);
446
ret = gnutls_dh_params_generate2(mc->dh_params, mc->dh_bits);
449
447
if(ret != GNUTLS_E_SUCCESS){
450
448
fprintf(stderr, "Error in GnuTLS prime generation: %s\n",
451
449
safer_gnutls_strerror(ret));
455
gnutls_certificate_set_dh_params(mc.cred, mc.dh_params);
453
gnutls_certificate_set_dh_params(mc->cred, mc->dh_params);
461
gnutls_certificate_free_credentials(mc.cred);
459
gnutls_certificate_free_credentials(mc->cred);
462
460
gnutls_global_deinit();
463
gnutls_dh_params_deinit(mc.dh_params);
461
gnutls_dh_params_deinit(mc->dh_params);
467
static int init_gnutls_session(gnutls_session_t *session){
465
static int init_gnutls_session(mandos_context *mc,
466
gnutls_session_t *session){
469
468
/* GnuTLS session creation */
470
469
ret = gnutls_init(session, GNUTLS_SERVER);
478
ret = gnutls_priority_set_direct(*session, mc.priority, &err);
477
ret = gnutls_priority_set_direct(*session, mc->priority, &err);
479
478
if(ret != GNUTLS_E_SUCCESS){
480
479
fprintf(stderr, "Syntax error at: %s\n", err);
481
480
fprintf(stderr, "GnuTLS error: %s\n",
488
487
ret = gnutls_credentials_set(*session, GNUTLS_CRD_CERTIFICATE,
490
489
if(ret != GNUTLS_E_SUCCESS){
491
490
fprintf(stderr, "Error setting GnuTLS credentials: %s\n",
492
491
safer_gnutls_strerror(ret));
498
497
gnutls_certificate_server_set_request(*session,
499
498
GNUTLS_CERT_IGNORE);
501
gnutls_dh_set_prime_bits(*session, mc.dh_bits);
500
gnutls_dh_set_prime_bits(*session, mc->dh_bits);
510
509
/* Called when a Mandos server is found */
511
510
static int start_mandos_communication(const char *ip, uint16_t port,
512
511
AvahiIfIndex if_index,
517
struct sockaddr_in in;
518
struct sockaddr_in6 in6;
515
union { struct sockaddr in; struct sockaddr_in6 in6; } to;
520
516
char *buffer = NULL;
521
517
char *decrypted_buffer;
522
518
size_t buffer_length = 0;
524
520
ssize_t decrypted_buffer_size;
523
char interface[IF_NAMESIZE];
527
524
gnutls_session_t session;
528
int pf; /* Protocol family */
538
fprintf(stderr, "Bad address family: %d\n", af);
542
ret = init_gnutls_session(&session);
526
ret = init_gnutls_session(mc, &session);
548
fprintf(stderr, "Setting up a TCP connection to %s, port %" PRIu16
532
fprintf(stderr, "Setting up a tcp connection to %s, port %" PRIu16
552
tcp_sd = socket(pf, SOCK_STREAM, 0);
536
tcp_sd = socket(PF_INET6, SOCK_STREAM, 0);
554
538
perror("socket");
543
if(if_indextoname((unsigned int)if_index, interface) == NULL){
544
perror("if_indextoname");
547
fprintf(stderr, "Binding to interface %s\n", interface);
558
550
memset(&to, 0, sizeof(to));
560
to.in6.sin6_family = (uint16_t)af;
561
ret = inet_pton(af, ip, &to.in6.sin6_addr);
563
to.in.sin_family = (sa_family_t)af;
564
ret = inet_pton(af, ip, &to.in.sin_addr);
551
to.in6.sin6_family = AF_INET6;
552
/* It would be nice to have a way to detect if we were passed an
553
IPv4 address here. Now we assume an IPv6 address. */
554
ret = inet_pton(AF_INET6, ip, &to.in6.sin6_addr);
567
556
perror("inet_pton");
571
560
fprintf(stderr, "Bad address: %s\n", ip);
575
to.in6.sin6_port = htons(port); /* Spurious warnings from
577
-Wunreachable-code */
579
if(IN6_IS_ADDR_LINKLOCAL /* Spurious warnings from */
580
(&to.in6.sin6_addr)){ /* -Wstrict-aliasing=2 or lower and
582
if(if_index == AVAHI_IF_UNSPEC){
583
fprintf(stderr, "An IPv6 link-local address is incomplete"
584
" without a network interface\n");
587
/* Set the network interface number as scope */
588
to.in6.sin6_scope_id = (uint32_t)if_index;
591
to.in.sin_port = htons(port); /* Spurious warnings from
563
to.in6.sin6_port = htons(port); /* Spurious warnings from
593
565
-Wunreachable-code */
567
to.in6.sin6_scope_id = (uint32_t)if_index;
597
if(af == AF_INET6 and if_index != AVAHI_IF_UNSPEC){
598
char interface[IF_NAMESIZE];
599
if(if_indextoname((unsigned int)if_index, interface) == NULL){
600
perror("if_indextoname");
602
fprintf(stderr, "Connection to: %s%%%s, port %" PRIu16 "\n",
603
ip, interface, port);
606
fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
609
char addrstr[(INET_ADDRSTRLEN > INET6_ADDRSTRLEN) ?
610
INET_ADDRSTRLEN : INET6_ADDRSTRLEN] = "";
613
pcret = inet_ntop(af, &(to.in6.sin6_addr), addrstr,
616
pcret = inet_ntop(af, &(to.in.sin_addr), addrstr,
570
fprintf(stderr, "Connection to: %s, port %" PRIu16 "\n", ip,
572
char addrstr[INET6_ADDRSTRLEN] = "";
573
if(inet_ntop(to.in6.sin6_family, &(to.in6.sin6_addr), addrstr,
574
sizeof(addrstr)) == NULL){
620
575
perror("inet_ntop");
622
577
if(strcmp(addrstr, ip) != 0){
629
ret = connect(tcp_sd, &to.in6, sizeof(to));
631
ret = connect(tcp_sd, &to.in, sizeof(to)); /* IPv4 */
583
ret = connect(tcp_sd, &to.in, sizeof(to));
634
585
perror("connect");
681
632
/* Read OpenPGP packet that contains the wanted password */
684
fprintf(stderr, "Retrieving OpenPGP encrypted password from %s\n",
635
fprintf(stderr, "Retrieving pgp encrypted password from %s\n",
689
buffer_capacity = incbuffer(&buffer, buffer_length,
640
buffer_capacity = adjustbuffer(&buffer, buffer_length,
690
641
buffer_capacity);
691
642
if(buffer_capacity == 0){
643
perror("adjustbuffer");
734
685
gnutls_bye(session, GNUTLS_SHUT_RDWR);
736
687
if(buffer_length > 0){
737
decrypted_buffer_size = pgp_packet_decrypt(buffer,
688
decrypted_buffer_size = pgp_packet_decrypt(mc, buffer,
739
690
&decrypted_buffer);
740
691
if(decrypted_buffer_size >= 0){
786
737
AVAHI_GCC_UNUSED AvahiStringList *txt,
787
738
AVAHI_GCC_UNUSED AvahiLookupResultFlags
789
__attribute__((unused)) void* userdata){
741
mandos_context *mc = userdata;
792
744
/* Called whenever a service has been resolved successfully or
797
749
case AVAHI_RESOLVER_FAILURE:
798
750
fprintf(stderr, "(Avahi Resolver) Failed to resolve service '%s'"
799
751
" of type '%s' in domain '%s': %s\n", name, type, domain,
800
avahi_strerror(avahi_server_errno(mc.server)));
752
avahi_strerror(avahi_server_errno(mc->server)));
803
755
case AVAHI_RESOLVER_FOUND:
809
761
PRIdMAX ") on port %" PRIu16 "\n", name, host_name,
810
762
ip, (intmax_t)interface, port);
812
int ret = start_mandos_communication(ip, port, interface,
813
avahi_proto_to_af(proto));
764
int ret = start_mandos_communication(ip, port, interface, mc);
815
avahi_simple_poll_quit(mc.simple_poll);
766
avahi_simple_poll_quit(mc->simple_poll);
839
791
case AVAHI_BROWSER_FAILURE:
841
793
fprintf(stderr, "(Avahi browser) %s\n",
842
avahi_strerror(avahi_server_errno(mc.server)));
843
avahi_simple_poll_quit(mc.simple_poll);
794
avahi_strerror(avahi_server_errno(mc->server)));
795
avahi_simple_poll_quit(mc->simple_poll);
846
798
case AVAHI_BROWSER_NEW:
849
801
the callback function is called the Avahi server will free the
850
802
resolver for us. */
852
if(!(avahi_s_service_resolver_new(mc.server, interface,
804
if(!(avahi_s_service_resolver_new(mc->server, interface,
853
805
protocol, name, type, domain,
854
806
AVAHI_PROTO_INET6, 0,
855
resolve_callback, NULL)))
807
resolve_callback, mc)))
856
808
fprintf(stderr, "Avahi: Failed to resolve service '%s': %s\n",
857
name, avahi_strerror(avahi_server_errno(mc.server)));
809
name, avahi_strerror(avahi_server_errno(mc->server)));
860
812
case AVAHI_BROWSER_REMOVE:
872
static void handle_sigterm(__attribute__((unused)) int sig){
873
int old_errno = errno;
874
avahi_simple_poll_quit(mc.simple_poll);
878
824
int main(int argc, char *argv[]){
879
825
AvahiSServiceBrowser *sb = NULL;
894
840
const char *seckey = PATHDIR "/" SECKEY;
895
841
const char *pubkey = PATHDIR "/" PUBKEY;
843
mandos_context mc = { .simple_poll = NULL, .server = NULL,
844
.dh_bits = 1024, .priority = "SECURE256"
845
":!CTYPE-X.509:+CTYPE-OPENPGP" };
897
846
bool gnutls_initialized = false;
898
847
bool gpgme_initialized = false;
899
848
double delay = 2.5;
901
struct sigaction old_sigterm_action;
902
struct sigaction sigterm_action = { .sa_handler = handle_sigterm };
904
/* Initialize mandos context */
905
mc = (mandos_context){ .simple_poll = NULL, .server = NULL,
906
.dh_bits = 1024, .priority = "SECURE256"
907
":!CTYPE-X.509:+CTYPE-OPENPGP" };
910
851
struct argp_option options[] = {
917
858
{ .name = "interface", .key = 'i',
919
.doc = "Network interface that will be used to search for"
860
.doc = "Interface that will be used to search for Mandos"
922
863
{ .name = "seckey", .key = 's',
1005
946
/* If the interface is down, bring it up */
1006
if(interface[0] != '\0'){
1007
948
#ifdef __linux__
1008
949
/* Lower kernel loglevel to KERN_NOTICE to avoid KERN_INFO
1009
950
messages to mess up the prompt */
1010
951
ret = klogctl(8, NULL, 5);
1011
bool restore_loglevel = true;
1013
restore_loglevel = false;
1014
953
perror("klogctl");
1035
972
perror("ioctl SIOCGIFFLAGS");
1036
973
#ifdef __linux__
1037
if(restore_loglevel){
1038
ret = klogctl(7, NULL, 0);
974
ret = klogctl(7, NULL, 0);
1044
979
exitcode = EXIT_FAILURE;
1051
986
perror("ioctl SIOCSIFFLAGS");
1052
987
exitcode = EXIT_FAILURE;
1053
988
#ifdef __linux__
1054
if(restore_loglevel){
1055
ret = klogctl(7, NULL, 0);
989
ret = klogctl(7, NULL, 0);
1080
1013
perror("close");
1082
1015
#ifdef __linux__
1083
if(restore_loglevel){
1084
/* Restores kernel loglevel to default */
1085
ret = klogctl(7, NULL, 0);
1016
/* Restores kernel loglevel to default */
1017
ret = klogctl(7, NULL, 0);
1104
1034
perror("setuid");
1107
ret = init_gnutls_global(pubkey, seckey);
1037
ret = init_gnutls_global(&mc, pubkey, seckey);
1109
1039
fprintf(stderr, "init_gnutls_global failed\n");
1110
1040
exitcode = EXIT_FAILURE;
1120
1050
tempdir_created = true;
1122
if(not init_gpgme(pubkey, seckey, tempdir)){
1052
if(not init_gpgme(&mc, pubkey, seckey, tempdir)){
1123
1053
fprintf(stderr, "init_gpgme failed\n");
1124
1054
exitcode = EXIT_FAILURE;
1127
1057
gpgme_initialized = true;
1130
if(interface[0] != '\0'){
1131
if_index = (AvahiIfIndex) if_nametoindex(interface);
1133
fprintf(stderr, "No such interface: \"%s\"\n", interface);
1134
exitcode = EXIT_FAILURE;
1060
if_index = (AvahiIfIndex) if_nametoindex(interface);
1062
fprintf(stderr, "No such interface: \"%s\"\n", interface);
1063
exitcode = EXIT_FAILURE;
1139
1067
if(connect_to != NULL){
1156
1084
port = (uint16_t)tmpmax;
1157
1085
*address = '\0';
1158
1086
address = connect_to;
1159
/* Colon in address indicates IPv6 */
1161
if(strchr(address, ':') != NULL){
1166
ret = start_mandos_communication(address, port, if_index,
1087
ret = start_mandos_communication(address, port, if_index, &mc);
1169
1089
exitcode = EXIT_FAILURE;
1217
1137
/* Create the Avahi service browser */
1218
1138
sb = avahi_s_service_browser_new(mc.server, if_index,
1219
1139
AVAHI_PROTO_INET6, "_mandos._tcp",
1220
NULL, 0, browse_callback, NULL);
1140
NULL, 0, browse_callback, &mc);
1221
1141
if(sb == NULL){
1222
1142
fprintf(stderr, "Failed to create service browser: %s\n",
1223
1143
avahi_strerror(avahi_server_errno(mc.server)));
1224
1144
exitcode = EXIT_FAILURE;
1228
sigemptyset(&sigterm_action.sa_mask);
1229
ret = sigaddset(&sigterm_action.sa_mask, SIGTERM);
1231
perror("sigaddset");
1232
exitcode = EXIT_FAILURE;
1235
ret = sigaction(SIGTERM, &sigterm_action, &old_sigterm_action);
1237
perror("sigaction");
1238
exitcode = EXIT_FAILURE;
1242
1148
/* Run the main loop */