62
62
#include <inttypes.h> /* PRIu16, PRIdMAX, intmax_t,
64
64
#include <assert.h> /* assert() */
65
#include <errno.h> /* perror(), errno, program_invocation_short_name */
65
#include <errno.h> /* perror(), errno */
66
66
#include <time.h> /* nanosleep(), time(), sleep() */
67
67
#include <net/if.h> /* ioctl, ifreq, SIOCGIFFLAGS, IFF_UP,
68
68
SIOCSIFFLAGS, if_indextoname(),
130
130
static const char sys_class_net[] = "/sys/class/net";
131
131
char *connect_to = NULL;
133
/* Doubly linked list that need to be circular linked when ever used */
134
typedef struct server{
137
AvahiIfIndex if_index;
139
struct timespec last_seen;
144
133
/* Used for passing in values through the Avahi callback functions */
146
135
AvahiSimplePoll *simple_poll;
150
139
gnutls_dh_params_t dh_params;
151
140
const char *priority;
153
server *current_server;
154
142
} mandos_context;
156
144
/* global context so signal handler can reach it*/
157
145
mandos_context mc = { .simple_poll = NULL, .server = NULL,
158
146
.dh_bits = 1024, .priority = "SECURE256"
159
":!CTYPE-X.509:+CTYPE-OPENPGP", .current_server = NULL };
147
":!CTYPE-X.509:+CTYPE-OPENPGP" };
161
149
sig_atomic_t quit_now = 0;
162
150
int signal_received = 0;
164
/* Function to use when printing errors */
165
void perror_plus(const char *print_text){
166
fprintf(stderr, "Mandos plugin %s: ", program_invocation_short_name);
171
153
* Make additional room in "buffer" for at least BUFFER_SIZE more
172
154
* bytes. "buffer_capacity" is how much is currently allocated,
184
166
return buffer_capacity;
187
int add_server(const char *ip, uint16_t port,
188
AvahiIfIndex if_index,
191
server *new_server = malloc(sizeof(server));
192
if(new_server == NULL){
193
perror_plus("malloc");
196
*new_server = (server){ .ip = strdup(ip),
198
.if_index = if_index,
200
if(new_server->ip == NULL){
201
perror_plus("strdup");
204
/* uniqe case of first server */
205
if (mc.current_server == NULL){
206
new_server->next = new_server;
207
new_server->prev = new_server;
208
mc.current_server = new_server;
209
/* Placing the new server last in the list */
211
new_server->next = mc.current_server;
212
new_server->prev = mc.current_server->prev;
213
new_server->prev->next = new_server;
214
mc.current_server->prev = new_server;
216
ret = clock_gettime(CLOCK_MONOTONIC, &mc.current_server->last_seen);
218
perror_plus("clock_gettime");
225
170
* Initialize GPGME.
392
337
/* Seek back to the beginning of the GPGME plaintext data buffer */
393
338
if(gpgme_data_seek(dh_plain, (off_t)0, SEEK_SET) == -1){
394
perror_plus("gpgme_data_seek");
339
perror("gpgme_data_seek");
395
340
plaintext_length = -1;
396
341
goto decrypt_end;
706
651
if(af == AF_INET6 and if_index != AVAHI_IF_UNSPEC){
707
652
char interface[IF_NAMESIZE];
708
653
if(if_indextoname((unsigned int)if_index, interface) == NULL){
709
perror_plus("if_indextoname");
654
perror("if_indextoname");
711
656
fprintf(stderr, "Connection to: %s%%%s, port %" PRIu16 "\n",
712
657
ip, interface, port);
1007
951
avahi_proto_to_af(proto));
1009
953
avahi_simple_poll_quit(mc.simple_poll);
1011
ret = add_server(ip, port, interface,
1012
avahi_proto_to_af(proto));
1192
int notdotentries(const struct dirent *direntry){
1193
/* Skip "." and ".." */
1194
if(direntry->d_name[0] == '.'
1195
and (direntry->d_name[1] == '\0'
1196
or (direntry->d_name[1] == '.'
1197
and direntry->d_name[2] == '\0'))){
1203
int avahi_loop_with_timeout(AvahiSimplePoll *s, int retry_interval){
1205
struct timespec now;
1206
struct timespec waited_time;
1207
intmax_t block_time;
1210
if(mc.current_server == NULL){
1212
fprintf(stderr, "Wait until first server is found. No timeout!\n");
1214
ret = avahi_simple_poll_iterate(s, -1);
1217
fprintf(stderr, "Check current_server if we should run it, or wait\n");
1219
/* the current time */
1220
ret = clock_gettime(CLOCK_MONOTONIC, &now);
1222
perror_plus("clock_gettime");
1225
/* Calculating in ms how long time between now and server
1226
who we visted longest time ago. Now - last seen. */
1227
waited_time.tv_sec = now.tv_sec - mc.current_server->last_seen.tv_sec;
1228
waited_time.tv_nsec = now.tv_nsec - mc.current_server->last_seen.tv_nsec;
1229
/* total time is 10s/10000ms. Converting to s to ms by 1000/s, and ns to ms by divind by 1000000. */
1230
block_time = (retry_interval - ((intmax_t)waited_time.tv_sec * 1000)) - ((intmax_t)waited_time.tv_nsec / 1000000);
1233
fprintf(stderr, "Blocking for %ld ms\n", block_time);
1236
if(block_time <= 0){
1237
ret = start_mandos_communication(mc.current_server->ip,
1238
mc.current_server->port,
1239
mc.current_server->if_index,
1240
mc.current_server->af);
1242
avahi_simple_poll_quit(mc.simple_poll);
1245
ret = clock_gettime(CLOCK_MONOTONIC, &mc.current_server->last_seen);
1247
perror_plus("clock_gettime");
1250
mc.current_server = mc.current_server->next;
1251
block_time = 0; /* call avahi to find new mandos servers, but dont block */
1254
ret = avahi_simple_poll_iterate(s, (int)block_time);
1257
if (ret > 0 or errno != EINTR) {
1258
return (ret != 1) ? ret : 0;
1264
1132
int main(int argc, char *argv[]){
1265
1133
AvahiSServiceBrowser *sb = NULL;
1283
1151
bool gnutls_initialized = false;
1284
1152
bool gpgme_initialized = false;
1285
1153
float delay = 2.5f;
1286
double retry_interval = 10; /* 10s between retrying a server and checking again*/
1288
1155
struct sigaction old_sigterm_action = { .sa_handler = SIG_DFL };
1289
1156
struct sigaction sigterm_action = { .sa_handler = handle_sigterm };
1343
1210
.arg = "SECONDS",
1344
1211
.doc = "Maximum delay to wait for interface startup",
1346
{ .name = "retry", .key = 132,
1348
.doc = "Retry interval used when denied by the mandos server",
1351
1214
* These reproduce what we would get without ARGP_NO_HELP
1396
1259
if(errno != 0 or tmp == arg or *tmp != '\0'){
1397
1260
argp_error(state, "Bad delay");
1399
case 132: /* --retry */
1401
retry_interval = strtod(arg, &tmp);
1402
if(errno != 0 or tmp == arg or *tmp != '\0'
1403
or (retry_interval * 1000) > INT_MAX){
1404
argp_error(state, "Bad retry interval");
1408
1264
* These reproduce what we would get without ARGP_NO_HELP
1488
1344
sigemptyset(&sigterm_action.sa_mask);
1489
1345
ret = sigaddset(&sigterm_action.sa_mask, SIGINT);
1491
perror_plus("sigaddset");
1347
perror("sigaddset");
1492
1348
exitcode = EX_OSERR;
1495
1351
ret = sigaddset(&sigterm_action.sa_mask, SIGHUP);
1497
perror_plus("sigaddset");
1353
perror("sigaddset");
1498
1354
exitcode = EX_OSERR;
1501
1357
ret = sigaddset(&sigterm_action.sa_mask, SIGTERM);
1503
perror_plus("sigaddset");
1359
perror("sigaddset");
1504
1360
exitcode = EX_OSERR;
1511
1367
ret = sigaction(SIGINT, NULL, &old_sigterm_action);
1513
perror_plus("sigaction");
1369
perror("sigaction");
1514
1370
return EX_OSERR;
1516
1372
if(old_sigterm_action.sa_handler != SIG_IGN){
1517
1373
ret = sigaction(SIGINT, &sigterm_action, NULL);
1519
perror_plus("sigaction");
1375
perror("sigaction");
1520
1376
exitcode = EX_OSERR;
1524
1380
ret = sigaction(SIGHUP, NULL, &old_sigterm_action);
1526
perror_plus("sigaction");
1382
perror("sigaction");
1527
1383
return EX_OSERR;
1529
1385
if(old_sigterm_action.sa_handler != SIG_IGN){
1530
1386
ret = sigaction(SIGHUP, &sigterm_action, NULL);
1532
perror_plus("sigaction");
1388
perror("sigaction");
1533
1389
exitcode = EX_OSERR;
1537
1393
ret = sigaction(SIGTERM, NULL, &old_sigterm_action);
1539
perror_plus("sigaction");
1395
perror("sigaction");
1540
1396
return EX_OSERR;
1542
1398
if(old_sigterm_action.sa_handler != SIG_IGN){
1543
1399
ret = sigaction(SIGTERM, &sigterm_action, NULL);
1545
perror_plus("sigaction");
1401
perror("sigaction");
1546
1402
exitcode = EX_OSERR;
1575
1431
bool restore_loglevel = true;
1577
1433
restore_loglevel = false;
1578
perror_plus("klogctl");
1580
1436
#endif /* __linux__ */
1582
1438
sd = socket(PF_INET6, SOCK_DGRAM, IPPROTO_IP);
1584
perror_plus("socket");
1585
1441
exitcode = EX_OSERR;
1586
1442
#ifdef __linux__
1587
1443
if(restore_loglevel){
1588
1444
ret = klogctl(7, NULL, 0);
1590
perror_plus("klogctl");
1593
1449
#endif /* __linux__ */
1596
1452
ret = seteuid(uid);
1598
perror_plus("seteuid");
1602
1458
strcpy(network.ifr_name, interface);
1603
1459
ret = ioctl(sd, SIOCGIFFLAGS, &network);
1605
perror_plus("ioctl SIOCGIFFLAGS");
1461
perror("ioctl SIOCGIFFLAGS");
1606
1462
#ifdef __linux__
1607
1463
if(restore_loglevel){
1608
1464
ret = klogctl(7, NULL, 0);
1610
perror_plus("klogctl");
1613
1469
#endif /* __linux__ */
1626
1482
ret = ioctl(sd, SIOCSIFFLAGS, &network);
1628
1484
take_down_interface = false;
1629
perror_plus("ioctl SIOCSIFFLAGS +IFF_UP");
1485
perror("ioctl SIOCSIFFLAGS +IFF_UP");
1630
1486
exitcode = EX_OSERR;
1631
1487
#ifdef __linux__
1632
1488
if(restore_loglevel){
1633
1489
ret = klogctl(7, NULL, 0);
1635
perror_plus("klogctl");
1638
1494
#endif /* __linux__ */
1641
1497
ret = seteuid(uid);
1643
perror_plus("seteuid");
1648
/* sleep checking until interface is running. Check every 0.25s, up to total time of delay */
1504
/* sleep checking until interface is running */
1649
1505
for(int i=0; i < delay * 4; i++){
1650
1506
ret = ioctl(sd, SIOCGIFFLAGS, &network);
1652
perror_plus("ioctl SIOCGIFFLAGS");
1508
perror("ioctl SIOCGIFFLAGS");
1653
1509
} else if(network.ifr_flags & IFF_RUNNING){
1656
1512
struct timespec sleeptime = { .tv_nsec = 250000000 };
1657
1513
ret = nanosleep(&sleeptime, NULL);
1658
1514
if(ret == -1 and errno != EINTR){
1659
perror_plus("nanosleep");
1515
perror("nanosleep");
1662
1518
if(not take_down_interface){
1663
1519
/* We won't need the socket anymore */
1664
1520
ret = (int)TEMP_FAILURE_RETRY(close(sd));
1666
perror_plus("close");
1669
1525
#ifdef __linux__
1844
1701
fprintf(stderr, "Starting Avahi loop search\n");
1847
ret = avahi_loop_with_timeout(mc.simple_poll, (int)(retry_interval * 1000));
1849
fprintf(stderr, "avahi_loop_with_timeout exited %s\n",
1850
(ret == 0) ? "successfully" : "with error");
1704
avahi_simple_poll_loop(mc.simple_poll);
1875
1728
if(gpgme_initialized){
1876
1729
gpgme_release(mc.ctx);
1879
/* cleans up the circular linked list of mandos servers the client has seen */
1880
if(mc.current_server != NULL){
1881
mc.current_server->prev->next = NULL;
1882
while(mc.current_server != NULL){
1883
server *next = mc.current_server->next;
1884
free(mc.current_server);
1885
mc.current_server = next;
1889
1732
/* Take down the network interface */
1890
1733
if(take_down_interface){
1893
1736
ret = seteuid(0);
1895
perror_plus("seteuid");
1897
1740
if(geteuid() == 0){
1898
1741
ret = ioctl(sd, SIOCGIFFLAGS, &network);
1900
perror_plus("ioctl SIOCGIFFLAGS");
1743
perror("ioctl SIOCGIFFLAGS");
1901
1744
} else if(network.ifr_flags & IFF_UP) {
1902
1745
network.ifr_flags &= ~(short)IFF_UP; /* clear flag */
1903
1746
ret = ioctl(sd, SIOCSIFFLAGS, &network);
1905
perror_plus("ioctl SIOCSIFFLAGS -IFF_UP");
1748
perror("ioctl SIOCSIFFLAGS -IFF_UP");
1908
1751
ret = (int)TEMP_FAILURE_RETRY(close(sd));
1910
perror_plus("close");
1912
1755
/* Lower privileges permanently */
1914
1757
ret = setuid(uid);
1916
perror_plus("setuid");
1921
/* Removes the GPGME temp directory and all files inside */
1764
/* Removes the temp directory used by GPGME */
1922
1765
if(tempdir_created){
1923
struct dirent **direntries = NULL;
1924
struct dirent *direntry = NULL;
1925
ret = scandir(tempdir, &direntries, notdotentries, alphasort);
1927
for(int i = 0; i < ret; i++){
1928
direntry = direntries[i];
1767
struct dirent *direntry;
1768
d = opendir(tempdir);
1770
if(errno != ENOENT){
1775
direntry = readdir(d);
1776
if(direntry == NULL){
1779
/* Skip "." and ".." */
1780
if(direntry->d_name[0] == '.'
1781
and (direntry->d_name[1] == '\0'
1782
or (direntry->d_name[1] == '.'
1783
and direntry->d_name[2] == '\0'))){
1929
1786
char *fullname = NULL;
1930
1787
ret = asprintf(&fullname, "%s/%s", tempdir,
1931
1788
direntry->d_name);
1933
perror_plus("asprintf");
1936
1793
ret = remove(fullname);