2530f15118a99336a07825b7daba21afcff66b7e
[tripe] / proxy / tripe-mitm.c
1 /* -*-c-*-
2 *
3 * An evil proxy for TrIPE
4 *
5 * (c) 2001 Straylight/Edgeware
6 */
7
8 /*----- Licensing notice --------------------------------------------------*
9 *
10 * This file is part of Trivial IP Encryption (TrIPE).
11 *
12 * TrIPE is free software: you can redistribute it and/or modify it under
13 * the terms of the GNU General Public License as published by the Free
14 * Software Foundation; either version 3 of the License, or (at your
15 * option) any later version.
16 *
17 * TrIPE is distributed in the hope that it will be useful, but WITHOUT
18 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
19 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
20 * for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with TrIPE. If not, see <https://www.gnu.org/licenses/>.
24 */
25
26 /*----- Header files ------------------------------------------------------*/
27
28 #include "config.h"
29
30 #include <assert.h>
31 #include <errno.h>
32 #include <stdio.h>
33 #include <stdlib.h>
34 #include <string.h>
35 #include <time.h>
36
37 #include <sys/types.h>
38 #include <sys/time.h>
39 #include <unistd.h>
40 #include <fcntl.h>
41
42 #include <sys/socket.h>
43 #include <netinet/in.h>
44 #include <arpa/inet.h>
45 #include <netdb.h>
46
47 #include <mLib/alloc.h>
48 #include <mLib/dstr.h>
49 #include <mLib/fdflags.h>
50 #include <mLib/mdwopt.h>
51 #include <mLib/quis.h>
52 #include <mLib/report.h>
53 #include <mLib/sel.h>
54 #include <mLib/sub.h>
55 #include <mLib/tv.h>
56
57 #include <catacomb/buf.h>
58
59 #include <catacomb/key.h>
60
61 #include <catacomb/mp.h>
62 #include <catacomb/mprand.h>
63 #include <catacomb/dh.h>
64
65 #include <catacomb/chacha20.h>
66 #include <catacomb/noise.h>
67 #include <catacomb/rand.h>
68
69 #include "util.h"
70
71 /*----- Data structures ---------------------------------------------------*/
72
73 typedef struct peer {
74 sel_file sf;
75 const char *name;
76 struct filter *f;
77 } peer;
78
79 typedef struct filter {
80 struct filter *next;
81 peer *p_from, *p_to;
82 void (*func)(struct filter */*f*/, const octet */*buf*/, size_t /*sz*/);
83 void *state;
84 } filter;
85
86 typedef struct qnode {
87 octet *buf;
88 size_t sz;
89 } qnode;
90
91 /*----- Static variables --------------------------------------------------*/
92
93 #define PKBUFSZ 65536
94
95 static sel_state sel;
96 static peer peers[2];
97 static unsigned npeer = 0;
98 static key_file keys;
99 static grand *rng;
100 static const char *delim = ":";
101
102 #define PASS(f, buf, sz) ((f) ? (f)->func((f), (buf), (sz)) : (void)0)
103 #define RND(i) (rng->ops->range(rng, (i)))
104
105 /*----- Peer management ---------------------------------------------------*/
106
107 static void dopacket(int fd, unsigned mode, void *vv)
108 {
109 octet buf[PKBUFSZ];
110 peer *p = vv;
111 int r = read(fd, buf, sizeof(buf));
112 if (r >= 0) {
113 printf("recv from `%s'\n", p->name);
114 PASS(p->f, buf, r);
115 }
116 }
117
118 static void addpeer(unsigned ac, char **av)
119 {
120 struct hostent *h;
121 struct sockaddr_in sin;
122 int len = PKBUFSZ;
123 peer *p;
124 int fd;
125
126 if (ac != 4) die(1, "syntax: peer:NAME:PORT:ADDR:PORT");
127 if (npeer >= 2) die(1, "enough peers already");
128 if (!key_bytag(&keys, av[0])) die(1, "no key named `%s'", av[0]);
129 p = &peers[npeer++];
130 p->name = xstrdup(av[0]);
131 if ((fd = socket(PF_INET, SOCK_DGRAM, 0)) < 0)
132 die(1, "socket: %s", strerror(errno));
133 fdflags(fd, O_NONBLOCK, O_NONBLOCK, FD_CLOEXEC, FD_CLOEXEC);
134 memset(&sin, 0, sizeof(sin));
135 sin.sin_family = AF_INET;
136 sin.sin_addr.s_addr = INADDR_ANY;
137 sin.sin_port = htons(atoi(av[1]));
138 if (bind(fd, (struct sockaddr *)&sin, sizeof(sin)))
139 die(1, "bind: %s", strerror(errno));
140 memset(&sin, 0, sizeof(sin));
141 sin.sin_family = AF_INET;
142 if ((h = gethostbyname(av[2])) == 0)
143 die(1, "gethostbyname `%s'", av[2]);
144 if (setsockopt(fd, SOL_SOCKET, SO_RCVBUF, &len, sizeof(len)) ||
145 setsockopt(fd, SOL_SOCKET, SO_SNDBUF, &len, sizeof(len)))
146 die(1, "setsockopt: %s", strerror(errno));
147 memcpy(&sin.sin_addr, h->h_addr, sizeof(sin.sin_addr));
148 sin.sin_port = htons(atoi(av[3]));
149 if (connect(fd, (struct sockaddr *)&sin, sizeof(sin)))
150 die(1, "connect: %s", strerror(errno));
151 sel_initfile(&sel, &p->sf, fd, SEL_READ, dopacket, p);
152 sel_addfile(&p->sf);
153 }
154
155 /*----- Fork filter -------------------------------------------------------*/
156
157 typedef struct forknode {
158 struct forknode *next;
159 filter *f;
160 } forknode;
161
162 typedef struct forkfilt {
163 const char *name;
164 forknode *fn;
165 } forkfilt;
166
167 static void dofork(filter *f, const octet *buf, size_t sz)
168 {
169 forkfilt *ff = f->state;
170 forknode *fn;
171 unsigned i = 0;
172
173 ff = f->state;
174 for (fn = ff->fn; fn; fn = fn->next) {
175 printf("fork branch %u of fork `%s'\n", i++, ff->name);
176 PASS(fn->f, buf, sz);
177 }
178 printf("fork branch %u of fork `%s'\n", i++, ff->name);
179 PASS(f->next, buf, sz);
180 }
181
182 static void addfork(filter *f, unsigned ac, char **av)
183 {
184 forkfilt *ff;
185 if (ac != 1) die(1, "syntax: filt:fork:NAME");
186 ff = CREATE(forkfilt);
187 ff->name = xstrdup(av[0]);
188 ff->fn = 0;
189 f->func = dofork;
190 f->state = ff;
191 }
192
193 static void nextfork(unsigned ac, char **av)
194 {
195 unsigned i, j;
196 filter *f;
197 forkfilt *ff;
198 forknode *fn, **ffn;
199 peer *p;
200
201 if (ac < 1) die(1, "syntax: next:NAME:...");
202 for (i = 0; i < 2; i++) {
203 p = &peers[i];
204 for (f = p->f; f; f = f->next) {
205 if (f->func != dofork) continue;
206 ff = f->state;
207 for (j = 0; j < ac; j++)
208 if (strcmp(av[j], ff->name) == 0) goto match;
209 continue;
210 match:
211 fn = CREATE(forknode);
212 for (ffn = &ff->fn; *ffn; ffn = &(*ffn)->next);
213 fn->f = f->next;
214 f->next = 0;
215 fn->next = 0;
216 *ffn = fn;
217 }
218 }
219 }
220
221 /*----- Corrupt filter ----------------------------------------------------*/
222
223 typedef struct corrupt {
224 unsigned p_corrupt;
225 } corrupt;
226
227 static void docorrupt(filter *f, const octet *buf, size_t sz)
228 {
229 corrupt *c = f->state;
230 octet b[PKBUFSZ];
231 memcpy(b, buf, sz);
232
233 while (!RND(c->p_corrupt)) {
234 puts("corrupt packet");
235 b[RND(sz)] ^= RND(256);
236 }
237 PASS(f->next, b, sz);
238 }
239
240 static void addcorrupt(filter *f, unsigned ac, char **av)
241 {
242 corrupt *c;
243 if (ac > 1) die(1, "syntax: filt:corrupt[:P-CORRUPT]");
244 c = CREATE(corrupt);
245 if (ac > 0) c->p_corrupt = atoi(av[0]);
246 else c->p_corrupt = 5;
247 f->state = c;
248 f->func = docorrupt;
249 }
250
251 /*----- Drop filter -------------------------------------------------------*/
252
253 typedef struct drop {
254 unsigned p_drop;
255 } drop;
256
257 static void dodrop(filter *f, const octet *buf, size_t sz)
258 {
259 drop *d = f->state;
260
261 if (!RND(d->p_drop)) puts("drop packet");
262 else PASS(f->next, buf, sz);
263 }
264
265 static void adddrop(filter *f, unsigned ac, char **av)
266 {
267 drop *d;
268 if (ac > 1) die(1, "syntax: filt:drop[:P-DROP]");
269 d = CREATE(drop);
270 if (ac > 0) d->p_drop = atoi(av[0]);
271 else d->p_drop = 5;
272 f->state = d;
273 f->func = dodrop;
274 }
275
276 /*----- Delay filter ------------------------------------------------------*/
277
278 typedef struct delaynode {
279 unsigned flag;
280 sel_timer tm;
281 unsigned i;
282 struct delay *d;
283 octet *buf;
284 size_t sz;
285 unsigned seq;
286 } delaynode;
287
288 typedef struct delay {
289 unsigned max, n;
290 unsigned long t;
291 unsigned p_replay;
292 filter *f;
293 delaynode *q;
294 } delay;
295
296 static void dtimer(struct timeval *tv, void *vv);
297
298 static void dinsert(delaynode *dn)
299 {
300 struct timeval tv;
301 sel_timer *ta, *tb;
302 unsigned long tdelta = RND(dn->d->t);
303 gettimeofday(&tv, 0);
304 TV_ADDL(&tv, &tv, 0, tdelta);
305 assert(!dn->flag);
306 sel_addtimer(&sel, &dn->tm, &tv, dtimer, dn);
307 dn->flag = 1;
308 for (ta = tb = sel.timers; ta; ta = ta->next) {
309 ta = ta->next; if (!ta) break; assert(ta != tb);
310 ta = ta->next; if (!ta) break; assert(ta != tb);
311 tb = tb->next;
312 }
313 printf(" delay %lu usecs", tdelta);
314 }
315
316 static void dsend(delaynode *dn, unsigned force)
317 {
318 delay *d = dn->d;
319 delaynode *ddn;
320 unsigned i;
321
322 fputs(" send...\n", stdout);
323 assert(dn->buf);
324 PASS(d->f->next, dn->buf, dn->sz);
325 fputs("delay ...", stdout);
326 if (!force)
327 dinsert(dn);
328 else {
329 xfree(dn->buf);
330 dn->buf = 0;
331 d->n--;
332 if (dn->i < d->n) {
333 ddn = &d->q[d->n];
334 sel_rmtimer(&ddn->tm);
335 sel_addtimer(&sel, &dn->tm, &ddn->tm.tv, dtimer, dn);
336 dn->flag = 1;
337 dn->buf = ddn->buf;
338 dn->sz = ddn->sz;
339 dn->seq = ddn->seq;
340 ddn->buf = 0;
341 ddn->flag = 0;
342 printf(" move id %u from slot %u to slot %u", ddn->seq, ddn->i, dn->i);
343 }
344 for (i = 0; i < d->n; i++) assert(d->q[i].buf);
345 fputs(" remove", stdout);
346 }
347 }
348
349 static void dtimer(struct timeval *tv, void *vv)
350 {
351 delaynode *dn = vv;
352 printf("delay timer peer `%s' id %u slot %u",
353 dn->d->f->p_from->name, dn->seq, dn->i);
354 dn->flag = 0;
355 dsend(dn, RND(dn->d->p_replay));
356 fputc('\n', stdout);
357 }
358
359 static void dodelay(filter *f, const octet *buf, size_t sz)
360 {
361 delay *d = f->state;
362 delaynode *dn;
363 static unsigned seq = 0;
364
365 fputs("delay", stdout);
366 if (d->n == d->max) {
367 dn = &d->q[RND(d->n)];
368 printf(" force uid %u", dn->seq);
369 sel_rmtimer(&dn->tm);
370 dn->flag = 0;
371 dsend(dn, 1);
372 fputc(';', stdout);
373 }
374 dn = &d->q[d->n++];
375 dn->seq = seq++;
376 printf(" new id %u in slot %u", dn->seq, dn->i);
377 dn->buf = xmalloc(sz);
378 dn->sz = sz;
379 memcpy(dn->buf, buf, sz);
380 dinsert(dn);
381 fputc('\n', stdout);
382 }
383
384 static void adddelay(filter *f, unsigned ac, char **av)
385 {
386 delay *d;
387 unsigned i;
388
389 if (ac < 1 || ac > 3) die(1, "syntax: filt:delay:QLEN[:MILLIS:P-REPLAY]");
390 d = CREATE(delay);
391 d->max = atoi(av[0]);
392 if (ac > 1) d->t = strtoul(av[1], 0, 10);
393 else d->t = 100;
394 d->t *= 1000;
395 if (ac > 2) d->p_replay = atoi(av[2]);
396 else d->p_replay = 20;
397 d->n = 0;
398 d->q = xmalloc(d->max * sizeof(delaynode));
399 d->f = f;
400 f->state = d;
401 f->func = dodelay;
402 for (i = 0; i < d->max; i++) {
403 d->q[i].d = d;
404 d->q[i].i = i;
405 d->q[i].buf = 0;
406 d->q[i].flag = 0;
407 }
408 }
409
410 /*----- Filters -----------------------------------------------------------*/
411
412 static void dosend(filter *f, const octet *buf, size_t sz)
413 {
414 printf("send to `%s'\n", f->p_to->name);
415 DISCARD(write(f->p_to->sf.fd, buf, sz));
416 }
417
418 static void addsend(filter *f, unsigned ac, char **av)
419 {
420 if (ac) die(1, "syntax: filt:send");
421 f->func = dosend;
422 }
423
424 const struct filtab {
425 const char *name;
426 void (*func)(filter */*f*/, unsigned /*ac*/, char **/*av*/);
427 } filtab[] = {
428 { "send", addsend },
429 { "fork", addfork },
430 { "delay", adddelay },
431 { "drop", adddrop },
432 { "corrupt", addcorrupt },
433 { 0, 0 }
434 };
435
436 static void dofilter(peer *from, peer *to, unsigned ac, char **av)
437 {
438 filter **ff, *f = CREATE(filter);
439 const struct filtab *ft;
440 if (ac < 1) die(1, "syntax: {l,r,}filt:NAME:...");
441 f->next = 0;
442 f->p_from = from;
443 f->p_to = to;
444 f->state = 0;
445 for (ff = &from->f; *ff; ff = &(*ff)->next);
446 *ff = f;
447 for (ft = filtab; ft->name; ft++)
448 if (strcmp(av[0], ft->name) == 0)
449 { ft->func(f, ac - 1, av + 1); return; }
450 die(1, "unknown filter `%s'", av[0]);
451 }
452
453 /*----- Flooding ----------------------------------------------------------*/
454
455 typedef struct flood {
456 peer *p;
457 unsigned type;
458 size_t sz;
459 unsigned long t;
460 sel_timer tm;
461 } flood;
462
463 static void setflood(flood *f);
464
465 static void floodtimer(struct timeval *tv, void *vv)
466 {
467 flood *f = vv;
468 octet buf[PKBUFSZ];
469 size_t sz;
470
471 sz = RND(f->sz);
472 sz += RND(f->sz);
473 sz += RND(f->sz);
474 sz += RND(f->sz);
475 sz /= 2;
476
477 rng->ops->fill(rng, buf, sz);
478 if (f->type < 0x100) buf[0] = f->type;
479 puts("flood packet");
480 PASS(f->p->f, buf, sz);
481 setflood(f);
482 }
483
484 static void setflood(flood *f)
485 {
486 struct timeval tv;
487 gettimeofday(&tv, 0);
488 TV_ADDL(&tv, &tv, 0, RND(f->t));
489 sel_addtimer(&sel, &f->tm, &tv, floodtimer, f);
490 }
491
492 static void doflood(peer *p, unsigned ac, char **av)
493 {
494 flood *f;
495 if (ac > 3) die(1, "syntax: flood[:TYPE:MILLIS:SIZE]");
496 f = CREATE(flood);
497 f->p = p;
498 if (ac > 0) f->type = strtoul(av[0], 0, 16);
499 else f->type = 0x100;
500 if (ac > 1) f->t = atoi(av[1]);
501 else f->t = 10;
502 if (ac > 2) f->sz = atoi(av[2]);
503 else f->sz = 128;
504 f->t *= 1000;
505 setflood(f);
506 }
507
508 /*----- Configuration commands --------------------------------------------*/
509
510 static void parse(char *p);
511
512 static void addflood(unsigned ac, char **av) {
513 doflood(&peers[0], ac, av);
514 doflood(&peers[1], ac, av);
515 }
516 static void addlflood(unsigned ac, char **av) {
517 doflood(&peers[0], ac, av);
518 }
519 static void addrflood(unsigned ac, char **av) {
520 doflood(&peers[1], ac, av);
521 }
522
523 static void addfilter(unsigned ac, char **av) {
524 dofilter(&peers[0], &peers[1], ac, av);
525 dofilter(&peers[1], &peers[0], ac, av);
526 }
527 static void addlfilter(unsigned ac, char **av) {
528 dofilter(&peers[0], &peers[1], ac, av);
529 }
530 static void addrfilter(unsigned ac, char **av) {
531 dofilter(&peers[1], &peers[0], ac, av);
532 }
533
534 static void include(unsigned ac, char **av)
535 {
536 FILE *fp;
537 dstr d = DSTR_INIT;
538 if (!ac) die(1, "syntax: include:FILE:...");
539 while (*av) {
540 if ((fp = fopen(*av, "r")) == 0)
541 die(1, "fopen `%s': %s", *av, strerror(errno));
542 while (dstr_putline(&d, fp) != EOF) { parse(d.buf); DRESET(&d); }
543 fclose(fp);
544 av++;
545 }
546 }
547
548 const struct cmdtab {
549 const char *name;
550 void (*func)(unsigned /*ac*/, char **/*av*/);
551 } cmdtab[] = {
552 { "peer", addpeer },
553 { "include", include },
554 { "filt", addfilter },
555 { "lfilt", addlfilter },
556 { "rfilt", addrfilter },
557 { "next", nextfork },
558 { "flood", addflood },
559 { "lflood", addlflood },
560 { "rflood", addrflood },
561 { 0, 0 }
562 };
563
564 #define AVMAX 16
565
566 static void parse(char *p)
567 {
568 char *v[AVMAX];
569 unsigned c = 0;
570 const struct cmdtab *ct;
571
572 p = strtok(p, delim);
573 if (!p || *p == '#') return;
574 do {
575 v[c++] = p;
576 p = strtok(0, delim);
577 } while (p && c < AVMAX - 1);
578 v[c] = 0;
579 for (ct = cmdtab; ct->name; ct++) {
580 if (strcmp(ct->name, v[0]) == 0) {
581 ct->func(c - 1, v + 1);
582 return;
583 }
584 }
585 die(1, "unknown command `%s'", v[0]);
586 }
587
588 /*----- Main driver -------------------------------------------------------*/
589
590 static void version(FILE *fp)
591 { pquis(fp, "$, TrIPE version " VERSION "\n"); }
592
593 static void usage(FILE *fp)
594 { pquis(fp, "Usage: $ [-d CHAR] [-k KEYRING] DIRECTIVE...\n"); }
595
596 static void help(FILE *fp)
597 {
598 version(fp);
599 putc('\n', fp);
600 usage(fp);
601 fputs("\n\
602 Options:\n\
603 \n\
604 -h, --help Show this help text.\n\
605 -v, --version Show the version number.\n\
606 -u, --usage Show terse usage summary.\n\
607 \n\
608 -d, --delimiter=CHAR Use CHAR rather than `:' as delimiter.\n\
609 -k, --keyring=FILE Fetch keys from FILE.\n\
610 \n\
611 Directives:\n\
612 peer:NAME:LOCAL-PORT:REMOTE-ADDR:REMOTE-PORT\n\
613 include:FILE\n\
614 {,l,r}filt:FILTER:ARGS:...\n\
615 next:TAG\n\
616 {,l,r}flood:TYPE:MILLIS:SIZE\n\
617 \n\
618 Filters:\n\
619 send\n\
620 fork:TAG\n\
621 delay:QLEN[:MILLIS:P-REPLAY]\n\
622 drop[:P-DROP]\n\
623 corrupt[:P-CORRUPT]\n",
624 fp);
625 }
626
627 int main(int argc, char *argv[])
628 {
629 const char *kfname = "keyring.pub";
630 int i;
631 unsigned f = 0;
632 char buf[32];
633 static octet zero[CHACHA_NONCESZ];
634
635 #define f_bogus 1u
636
637 ego(argv[0]);
638 for (;;) {
639 static const struct option opt[] = {
640 { "help", 0, 0, 'h' },
641 { "version", 0, 0, 'v' },
642 { "usage", 0, 0, 'u' },
643 { "delimiter", OPTF_ARGREQ, 0, 'd' },
644 { "keyring", OPTF_ARGREQ, 0, 'k' },
645 { 0, 0, 0, 0 }
646 };
647 if ((i = mdwopt(argc, argv, "hvud:k:", opt, 0, 0, 0)) < 0) break;
648 switch (i) {
649 case 'h': help(stdout); exit(0);
650 case 'v': version(stdout); exit(0);
651 case 'u': usage(stdout); exit(0);
652 case 'd':
653 if (!optarg[0] || optarg[1])
654 die(1, "delimiter must be a single character");
655 delim = optarg;
656 break;
657 case 'k': kfname = optarg; break;
658 default: f |= f_bogus; break;
659 }
660 }
661 if (f & f_bogus) { usage(stderr); exit(1); }
662
663 rand_noisesrc(RAND_GLOBAL, &noise_source);
664 rand_seed(RAND_GLOBAL, 256);
665 rand_get(RAND_GLOBAL, buf, sizeof(buf));
666 rng = chacha20_rand(buf, sizeof(buf), zero);
667 sel_init(&sel);
668 if (key_open(&keys, kfname, KOPEN_READ, key_moan, 0))
669 die(1, "couldn't open `%s': %s", kfname, strerror(errno));
670 for (i = optind; i < argc; i++) parse(argv[i]);
671 if (npeer != 2) die(1, "need two peers");
672 for (;;) {
673 if (sel_select(&sel) && errno != EINTR)
674 die(1, "select failed: %s", strerror(errno));
675 }
676
677 #undef f_bogus
678 }
679
680 /*----- That's all, folks -------------------------------------------------*/