1 | /* |
1 | /* |
2 | connection.C -- manage a single connection |
2 | connection.C -- manage a single connection |
|
|
3 | Copyright (C) 2003-2004 Marc Lehmann <pcg@goof.com> |
3 | |
4 | |
4 | This program is free software; you can redistribute it and/or modify |
5 | This program is free software; you can redistribute it and/or modify |
5 | it under the terms of the GNU General Public License as published by |
6 | it under the terms of the GNU General Public License as published by |
6 | the Free Software Foundation; either version 2 of the License, or |
7 | the Free Software Foundation; either version 2 of the License, or |
7 | (at your option) any later version. |
8 | (at your option) any later version. |
… | |
… | |
16 | Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
17 | Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
17 | */ |
18 | */ |
18 | |
19 | |
19 | #include "config.h" |
20 | #include "config.h" |
20 | |
21 | |
21 | extern "C" { |
22 | #include <cassert> |
22 | # include "lzf/lzf.h" |
|
|
23 | } |
|
|
24 | |
23 | |
25 | #include <list> |
24 | #include <list> |
26 | |
25 | |
27 | #include <openssl/rand.h> |
26 | #include <openssl/rand.h> |
28 | #include <openssl/evp.h> |
27 | #include <openssl/evp.h> |
… | |
… | |
35 | #include "slog.h" |
34 | #include "slog.h" |
36 | #include "device.h" |
35 | #include "device.h" |
37 | #include "vpn.h" |
36 | #include "vpn.h" |
38 | #include "connection.h" |
37 | #include "connection.h" |
39 | |
38 | |
|
|
39 | #include "netcompat.h" |
|
|
40 | |
40 | #if !HAVE_RAND_PSEUDO_BYTES |
41 | #if !HAVE_RAND_PSEUDO_BYTES |
41 | # define RAND_pseudo_bytes RAND_bytes |
42 | # define RAND_pseudo_bytes RAND_bytes |
42 | #endif |
43 | #endif |
43 | |
44 | |
44 | #define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic |
45 | #define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic |
45 | |
46 | |
|
|
47 | #define ULTRA_FAST 1 |
|
|
48 | #define HLOG 15 |
|
|
49 | #include "lzf/lzf.h" |
|
|
50 | #include "lzf/lzf_c.c" |
|
|
51 | #include "lzf/lzf_d.c" |
|
|
52 | |
46 | struct crypto_ctx |
53 | struct crypto_ctx |
47 | { |
54 | { |
48 | EVP_CIPHER_CTX cctx; |
55 | EVP_CIPHER_CTX cctx; |
49 | HMAC_CTX hctx; |
56 | HMAC_CTX hctx; |
50 | |
57 | |
… | |
… | |
53 | }; |
60 | }; |
54 | |
61 | |
55 | crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) |
62 | crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) |
56 | { |
63 | { |
57 | EVP_CIPHER_CTX_init (&cctx); |
64 | EVP_CIPHER_CTX_init (&cctx); |
58 | EVP_CipherInit_ex (&cctx, CIPHER, 0, &challenge[CHG_CIPHER_KEY], 0, enc); |
65 | require (EVP_CipherInit_ex (&cctx, CIPHER, 0, &challenge[CHG_CIPHER_KEY], 0, enc)); |
59 | HMAC_CTX_init (&hctx); |
66 | HMAC_CTX_init (&hctx); |
60 | HMAC_Init_ex (&hctx, &challenge[CHG_HMAC_KEY], HMAC_KEYLEN, DIGEST, 0); |
67 | HMAC_Init_ex (&hctx, &challenge[CHG_HMAC_KEY], HMAC_KEYLEN, DIGEST, 0); |
61 | } |
68 | } |
62 | |
69 | |
63 | crypto_ctx::~crypto_ctx () |
70 | crypto_ctx::~crypto_ctx () |
64 | { |
71 | { |
65 | EVP_CIPHER_CTX_cleanup (&cctx); |
72 | require (EVP_CIPHER_CTX_cleanup (&cctx)); |
66 | HMAC_CTX_cleanup (&hctx); |
73 | HMAC_CTX_cleanup (&hctx); |
67 | } |
74 | } |
68 | |
75 | |
69 | static void |
76 | static void |
70 | rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) |
77 | rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) |
71 | { |
78 | { |
72 | EVP_MD_CTX ctx; |
79 | EVP_MD_CTX ctx; |
73 | |
80 | |
74 | EVP_MD_CTX_init (&ctx); |
81 | EVP_MD_CTX_init (&ctx); |
75 | EVP_DigestInit (&ctx, RSA_HASH); |
82 | require (EVP_DigestInit (&ctx, RSA_HASH)); |
76 | EVP_DigestUpdate(&ctx, &chg, sizeof chg); |
83 | require (EVP_DigestUpdate(&ctx, &chg, sizeof chg)); |
77 | EVP_DigestUpdate(&ctx, &id, sizeof id); |
84 | require (EVP_DigestUpdate(&ctx, &id, sizeof id)); |
78 | EVP_DigestFinal (&ctx, (unsigned char *)&h, 0); |
85 | require (EVP_DigestFinal (&ctx, (unsigned char *)&h, 0)); |
79 | EVP_MD_CTX_cleanup (&ctx); |
86 | EVP_MD_CTX_cleanup (&ctx); |
80 | } |
87 | } |
81 | |
88 | |
82 | struct rsa_entry { |
89 | struct rsa_entry { |
83 | tstamp expire; |
90 | tstamp expire; |
… | |
… | |
131 | |
138 | |
132 | } rsa_cache; |
139 | } rsa_cache; |
133 | |
140 | |
134 | void rsa_cache::cleaner_cb (time_watcher &w) |
141 | void rsa_cache::cleaner_cb (time_watcher &w) |
135 | { |
142 | { |
136 | if (empty ()) |
143 | if (!empty ()) |
137 | w.at = TSTAMP_CANCEL; |
|
|
138 | else |
|
|
139 | { |
144 | { |
140 | w.at = NOW + RSA_TTL; |
145 | w.start (NOW + RSA_TTL); |
141 | |
146 | |
142 | for (iterator i = begin (); i != end (); ) |
147 | for (iterator i = begin (); i != end (); ) |
143 | if (i->expire <= NOW) |
148 | if (i->expire <= NOW) |
144 | i = erase (i); |
149 | i = erase (i); |
145 | else |
150 | else |
… | |
… | |
307 | } |
312 | } |
308 | |
313 | |
309 | #define MAXVPNDATA (MAX_MTU - 6 - 6) |
314 | #define MAXVPNDATA (MAX_MTU - 6 - 6) |
310 | #define DATAHDR (sizeof (u32) + RAND_SIZE) |
315 | #define DATAHDR (sizeof (u32) + RAND_SIZE) |
311 | |
316 | |
312 | struct vpndata_packet:vpn_packet |
317 | struct vpndata_packet : vpn_packet |
313 | { |
318 | { |
314 | u8 data[MAXVPNDATA + DATAHDR]; // seqno |
319 | u8 data[MAXVPNDATA + DATAHDR]; // seqno |
315 | |
320 | |
316 | void setup (connection *conn, int dst, u8 *d, u32 len, u32 seqno); |
321 | void setup (connection *conn, int dst, u8 *d, u32 len, u32 seqno); |
317 | tap_packet *unpack (connection *conn, u32 &seqno); |
322 | tap_packet *unpack (connection *conn, u32 &seqno); |
… | |
… | |
330 | int outl = 0, outl2; |
335 | int outl = 0, outl2; |
331 | ptype type = PT_DATA_UNCOMPRESSED; |
336 | ptype type = PT_DATA_UNCOMPRESSED; |
332 | |
337 | |
333 | #if ENABLE_COMPRESSION |
338 | #if ENABLE_COMPRESSION |
334 | u8 cdata[MAX_MTU]; |
339 | u8 cdata[MAX_MTU]; |
335 | u32 cl; |
|
|
336 | |
340 | |
|
|
341 | if (conn->features & ENABLE_COMPRESSION) |
|
|
342 | { |
337 | cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7); |
343 | u32 cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7); |
|
|
344 | |
338 | if (cl) |
345 | if (cl) |
339 | { |
346 | { |
340 | type = PT_DATA_COMPRESSED; |
347 | type = PT_DATA_COMPRESSED; |
341 | d = cdata; |
348 | d = cdata; |
342 | l = cl + 2; |
349 | l = cl + 2; |
343 | |
350 | |
344 | d[0] = cl >> 8; |
351 | d[0] = cl >> 8; |
345 | d[1] = cl; |
352 | d[1] = cl; |
|
|
353 | } |
346 | } |
354 | } |
347 | #endif |
355 | #endif |
348 | |
356 | |
349 | EVP_EncryptInit_ex (cctx, 0, 0, 0, 0); |
357 | require (EVP_EncryptInit_ex (cctx, 0, 0, 0, 0)); |
350 | |
358 | |
351 | struct { |
359 | struct { |
352 | #if RAND_SIZE |
360 | #if RAND_SIZE |
353 | u8 rnd[RAND_SIZE]; |
361 | u8 rnd[RAND_SIZE]; |
354 | #endif |
362 | #endif |
… | |
… | |
358 | datahdr.seqno = ntohl (seqno); |
366 | datahdr.seqno = ntohl (seqno); |
359 | #if RAND_SIZE |
367 | #if RAND_SIZE |
360 | RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE); |
368 | RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE); |
361 | #endif |
369 | #endif |
362 | |
370 | |
363 | EVP_EncryptUpdate (cctx, |
371 | require (EVP_EncryptUpdate (cctx, |
364 | (unsigned char *) data + outl, &outl2, |
372 | (unsigned char *) data + outl, &outl2, |
365 | (unsigned char *) &datahdr, DATAHDR); |
373 | (unsigned char *) &datahdr, DATAHDR)); |
366 | outl += outl2; |
374 | outl += outl2; |
367 | |
375 | |
368 | EVP_EncryptUpdate (cctx, |
376 | require (EVP_EncryptUpdate (cctx, |
369 | (unsigned char *) data + outl, &outl2, |
377 | (unsigned char *) data + outl, &outl2, |
370 | (unsigned char *) d, l); |
378 | (unsigned char *) d, l)); |
371 | outl += outl2; |
379 | outl += outl2; |
372 | |
380 | |
373 | EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2); |
381 | require (EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2)); |
374 | outl += outl2; |
382 | outl += outl2; |
375 | |
383 | |
376 | len = outl + data_hdr_size (); |
384 | len = outl + data_hdr_size (); |
377 | |
385 | |
378 | set_hdr (type, dst); |
386 | set_hdr (type, dst); |
… | |
… | |
387 | int outl = 0, outl2; |
395 | int outl = 0, outl2; |
388 | tap_packet *p = new tap_packet; |
396 | tap_packet *p = new tap_packet; |
389 | u8 *d; |
397 | u8 *d; |
390 | u32 l = len - data_hdr_size (); |
398 | u32 l = len - data_hdr_size (); |
391 | |
399 | |
392 | EVP_DecryptInit_ex (cctx, 0, 0, 0, 0); |
400 | require (EVP_DecryptInit_ex (cctx, 0, 0, 0, 0)); |
393 | |
401 | |
394 | #if ENABLE_COMPRESSION |
402 | #if ENABLE_COMPRESSION |
395 | u8 cdata[MAX_MTU]; |
403 | u8 cdata[MAX_MTU]; |
396 | |
404 | |
397 | if (type == PT_DATA_COMPRESSED) |
405 | if (type == PT_DATA_COMPRESSED) |
… | |
… | |
399 | else |
407 | else |
400 | #endif |
408 | #endif |
401 | d = &(*p)[6 + 6 - DATAHDR]; |
409 | d = &(*p)[6 + 6 - DATAHDR]; |
402 | |
410 | |
403 | /* this overwrites part of the src mac, but we fix that later */ |
411 | /* this overwrites part of the src mac, but we fix that later */ |
404 | EVP_DecryptUpdate (cctx, |
412 | require (EVP_DecryptUpdate (cctx, |
405 | d, &outl2, |
413 | d, &outl2, |
406 | (unsigned char *)&data, len - data_hdr_size ()); |
414 | (unsigned char *)&data, len - data_hdr_size ())); |
407 | outl += outl2; |
415 | outl += outl2; |
408 | |
416 | |
409 | EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2); |
417 | require (EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2)); |
410 | outl += outl2; |
418 | outl += outl2; |
411 | |
419 | |
412 | seqno = ntohl (*(u32 *)(d + RAND_SIZE)); |
420 | seqno = ntohl (*(u32 *)(d + RAND_SIZE)); |
413 | |
421 | |
414 | id2mac (dst () ? dst() : THISNODE->id, p->dst); |
422 | id2mac (dst () ? dst() : THISNODE->id, p->dst); |
… | |
… | |
443 | { |
451 | { |
444 | // actually, hmaclen cannot be checked because the hmac |
452 | // actually, hmaclen cannot be checked because the hmac |
445 | // field comes before this data, so peers with other |
453 | // field comes before this data, so peers with other |
446 | // hmacs simply will not work. |
454 | // hmacs simply will not work. |
447 | u8 prot_major, prot_minor, randsize, hmaclen; |
455 | u8 prot_major, prot_minor, randsize, hmaclen; |
448 | u8 flags, challengelen, pad2, pad3; |
456 | u8 flags, challengelen, features, pad3; |
449 | u32 cipher_nid, digest_nid, hmac_nid; |
457 | u32 cipher_nid, digest_nid, hmac_nid; |
450 | |
|
|
451 | const u8 curflags () const |
|
|
452 | { |
|
|
453 | return 0x80 |
|
|
454 | | (ENABLE_COMPRESSION ? 0x01 : 0x00); |
|
|
455 | } |
|
|
456 | |
458 | |
457 | void setup (ptype type, int dst); |
459 | void setup (ptype type, int dst); |
458 | bool chk_config () const; |
460 | bool chk_config () const; |
459 | }; |
461 | }; |
|
|
462 | |
|
|
463 | #define FEATURES ((ENABLE_COMPRESSION ? FEATURE_COMPRESSION : 0) \ |
|
|
464 | | (ENABLE_ROHC ? FEATURE_ROHC : 0)) |
460 | |
465 | |
461 | void config_packet::setup (ptype type, int dst) |
466 | void config_packet::setup (ptype type, int dst) |
462 | { |
467 | { |
463 | prot_major = PROTOCOL_MAJOR; |
468 | prot_major = PROTOCOL_MAJOR; |
464 | prot_minor = PROTOCOL_MINOR; |
469 | prot_minor = PROTOCOL_MINOR; |
465 | randsize = RAND_SIZE; |
470 | randsize = RAND_SIZE; |
466 | hmaclen = HMACLENGTH; |
471 | hmaclen = HMACLENGTH; |
467 | flags = curflags (); |
472 | flags = ENABLE_COMPRESSION ? 0x81 : 0x80; |
468 | challengelen = sizeof (rsachallenge); |
473 | challengelen = sizeof (rsachallenge); |
|
|
474 | features = FEATURES; |
469 | |
475 | |
470 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
476 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
471 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
477 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
472 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
478 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
473 | |
479 | |
… | |
… | |
476 | } |
482 | } |
477 | |
483 | |
478 | bool config_packet::chk_config () const |
484 | bool config_packet::chk_config () const |
479 | { |
485 | { |
480 | if (prot_major != PROTOCOL_MAJOR) |
486 | if (prot_major != PROTOCOL_MAJOR) |
481 | slog (L_WARN, _("major version mismatch (%d <=> %d)"), prot_major, PROTOCOL_MAJOR); |
487 | slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR); |
482 | else if (randsize != RAND_SIZE) |
488 | else if (randsize != RAND_SIZE) |
483 | slog (L_WARN, _("rand size mismatch (%d <=> %d)"), randsize, RAND_SIZE); |
489 | slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE); |
484 | else if (hmaclen != HMACLENGTH) |
490 | else if (hmaclen != HMACLENGTH) |
485 | slog (L_WARN, _("hmac length mismatch (%d <=> %d)"), hmaclen, HMACLENGTH); |
491 | slog (L_WARN, _("hmac length mismatch (remote %d <=> local %d)"), hmaclen, HMACLENGTH); |
|
|
492 | #if 0 // this implementation should handle all flag settings |
486 | else if (flags != curflags ()) |
493 | else if (flags != curflags ()) |
487 | slog (L_WARN, _("flag mismatch (%x <=> %x)"), flags, curflags ()); |
494 | slog (L_WARN, _("flag mismatch (remote %x <=> local %x)"), flags, curflags ()); |
|
|
495 | #endif |
488 | else if (challengelen != sizeof (rsachallenge)) |
496 | else if (challengelen != sizeof (rsachallenge)) |
489 | slog (L_WARN, _("challenge length mismatch (%d <=> %d)"), challengelen, sizeof (rsachallenge)); |
497 | slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge)); |
490 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
498 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
491 | slog (L_WARN, _("cipher mismatch (%x <=> %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER)); |
499 | slog (L_WARN, _("cipher mismatch (remote %x <=> local %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER)); |
492 | else if (digest_nid != htonl (EVP_MD_type (RSA_HASH))) |
500 | else if (digest_nid != htonl (EVP_MD_type (RSA_HASH))) |
493 | slog (L_WARN, _("digest mismatch (%x <=> %x)"), ntohl (digest_nid), EVP_MD_type (RSA_HASH)); |
501 | slog (L_WARN, _("digest mismatch (remote %x <=> local %x)"), ntohl (digest_nid), EVP_MD_type (RSA_HASH)); |
494 | else if (hmac_nid != htonl (EVP_MD_type (DIGEST))) |
502 | else if (hmac_nid != htonl (EVP_MD_type (DIGEST))) |
495 | slog (L_WARN, _("hmac mismatch (%x <=> %x)"), ntohl (hmac_nid), EVP_MD_type (DIGEST)); |
503 | slog (L_WARN, _("hmac mismatch (remote %x <=> local %x)"), ntohl (hmac_nid), EVP_MD_type (DIGEST)); |
496 | else |
504 | else |
497 | return true; |
505 | return true; |
498 | |
506 | |
499 | return false; |
507 | return false; |
500 | } |
508 | } |
501 | |
509 | |
502 | struct auth_req_packet : config_packet |
510 | struct auth_req_packet : config_packet |
503 | { |
511 | { |
504 | char magic[8]; |
512 | char magic[8]; |
505 | u8 initiate; // false if this is just an automatic reply |
513 | u8 initiate; // false if this is just an automatic reply |
506 | u8 protocols; // supported protocols (will get patches on forward) |
514 | u8 protocols; // supported protocols (will be patched on forward) |
507 | u8 pad2, pad3; |
515 | u8 pad2, pad3; |
508 | rsaid id; |
516 | rsaid id; |
509 | rsaencrdata encr; |
517 | rsaencrdata encr; |
510 | |
518 | |
511 | auth_req_packet (int dst, bool initiate_, u8 protocols_) |
519 | auth_req_packet (int dst, bool initiate_, u8 protocols_) |
… | |
… | |
595 | } |
603 | } |
596 | else |
604 | else |
597 | { |
605 | { |
598 | retry_cnt = 0; |
606 | retry_cnt = 0; |
599 | establish_connection.start (NOW + 5); |
607 | establish_connection.start (NOW + 5); |
600 | keepalive.reset (); |
608 | keepalive.stop (); |
601 | rekey.reset (); |
609 | rekey.stop (); |
602 | } |
610 | } |
603 | } |
611 | } |
604 | |
612 | |
605 | void |
613 | void |
606 | connection::reset_si () |
614 | connection::reset_si () |
… | |
… | |
672 | connection::send_auth_request (const sockinfo &si, bool initiate) |
680 | connection::send_auth_request (const sockinfo &si, bool initiate) |
673 | { |
681 | { |
674 | auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols); |
682 | auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols); |
675 | |
683 | |
676 | rsachallenge chg; |
684 | rsachallenge chg; |
677 | |
|
|
678 | rsa_cache.gen (pkt->id, chg); |
685 | rsa_cache.gen (pkt->id, chg); |
679 | |
686 | rsa_encrypt (conf->rsa_key, chg, pkt->encr); |
680 | if (0 > RSA_public_encrypt (sizeof chg, |
|
|
681 | (unsigned char *)&chg, (unsigned char *)&pkt->encr, |
|
|
682 | conf->rsa_key, RSA_PKCS1_OAEP_PADDING)) |
|
|
683 | fatal ("RSA_public_encrypt error"); |
|
|
684 | |
687 | |
685 | slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si); |
688 | slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si); |
686 | |
689 | |
687 | send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly |
690 | send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly |
688 | |
691 | |
… | |
… | |
722 | } |
725 | } |
723 | |
726 | |
724 | void |
727 | void |
725 | connection::establish_connection_cb (time_watcher &w) |
728 | connection::establish_connection_cb (time_watcher &w) |
726 | { |
729 | { |
727 | if (ictx || conf == THISNODE |
730 | if (!ictx |
|
|
731 | && conf != THISNODE |
728 | || connectmode == conf_node::C_NEVER |
732 | && connectmode != conf_node::C_NEVER |
729 | || connectmode == conf_node::C_DISABLED) |
733 | && connectmode != conf_node::C_DISABLED |
730 | w.at = TSTAMP_CANCEL; |
734 | && NOW > w.at) |
731 | else if (w.at <= NOW) |
|
|
732 | { |
735 | { |
733 | double retry_int = double (retry_cnt & 3 ? (retry_cnt & 3) : 1 << (retry_cnt >> 2)) * 0.6; |
736 | double retry_int = double (retry_cnt & 3 ? (retry_cnt & 3) : 1 << (retry_cnt >> 2)) * 0.6; |
734 | |
737 | |
735 | if (retry_int < 3600 * 8) |
738 | if (retry_int < 3600 * 8) |
736 | retry_cnt++; |
739 | retry_cnt++; |
737 | |
740 | |
738 | w.at = NOW + retry_int; |
741 | w.start (NOW + retry_int); |
739 | |
742 | |
740 | reset_si (); |
743 | reset_si (); |
741 | |
744 | |
742 | if (si.prot && !si.host) |
745 | if (si.prot && !si.host) |
743 | vpn->send_connect_request (conf->id); |
746 | vpn->send_connect_request (conf->id); |
… | |
… | |
774 | si.host= 0; |
777 | si.host= 0; |
775 | |
778 | |
776 | last_activity = 0; |
779 | last_activity = 0; |
777 | retry_cnt = 0; |
780 | retry_cnt = 0; |
778 | |
781 | |
779 | rekey.reset (); |
782 | rekey.stop (); |
780 | keepalive.reset (); |
783 | keepalive.stop (); |
781 | establish_connection.reset (); |
784 | establish_connection.stop (); |
782 | } |
785 | } |
783 | |
786 | |
784 | void |
787 | void |
785 | connection::shutdown () |
788 | connection::shutdown () |
786 | { |
789 | { |
… | |
… | |
791 | } |
794 | } |
792 | |
795 | |
793 | void |
796 | void |
794 | connection::rekey_cb (time_watcher &w) |
797 | connection::rekey_cb (time_watcher &w) |
795 | { |
798 | { |
796 | w.at = TSTAMP_CANCEL; |
|
|
797 | |
|
|
798 | reset_connection (); |
799 | reset_connection (); |
799 | establish_connection (); |
800 | establish_connection (); |
800 | } |
801 | } |
801 | |
802 | |
802 | void |
803 | void |
803 | connection::send_data_packet (tap_packet *pkt, bool broadcast) |
804 | connection::send_data_packet (tap_packet *pkt) |
804 | { |
805 | { |
805 | vpndata_packet *p = new vpndata_packet; |
806 | vpndata_packet *p = new vpndata_packet; |
806 | int tos = 0; |
807 | int tos = 0; |
807 | |
808 | |
808 | // I am not hilarious about peeking into packets, but so be it. |
809 | // I am not hilarious about peeking into packets, but so be it. |
809 | if (conf->inherit_tos |
810 | if (conf->inherit_tos && pkt->is_ipv4 ()) |
810 | && (*pkt)[12] == 0x08 && (*pkt)[13] == 0x00 // IP |
|
|
811 | && ((*pkt)[14] & 0xf0) == 0x40) // IPv4 |
|
|
812 | tos = (*pkt)[15] & IPTOS_TOS_MASK; |
811 | tos = (*pkt)[15] & IPTOS_TOS_MASK; |
813 | |
812 | |
814 | p->setup (this, broadcast ? 0 : conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs |
813 | p->setup (this, conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs |
815 | send_vpn_packet (p, si, tos); |
814 | send_vpn_packet (p, si, tos); |
816 | |
815 | |
817 | delete p; |
816 | delete p; |
818 | |
817 | |
819 | if (oseqno > MAX_SEQNO) |
818 | if (oseqno > MAX_SEQNO) |
820 | rekey (); |
819 | rekey (); |
821 | } |
820 | } |
822 | |
821 | |
823 | void |
822 | void |
824 | connection::inject_data_packet (tap_packet *pkt, bool broadcast) |
823 | connection::inject_data_packet (tap_packet *pkt, bool broadcast/*TODO DDD*/) |
825 | { |
824 | { |
826 | if (ictx && octx) |
825 | if (ictx && octx) |
827 | send_data_packet (pkt, broadcast); |
826 | send_data_packet (pkt); |
828 | else |
827 | else |
829 | { |
828 | { |
830 | if (!broadcast)//DDDD |
829 | if (!broadcast)//DDDD |
831 | data_queue.put (new tap_packet (*pkt)); |
830 | data_queue.put (new tap_packet (*pkt)); |
832 | |
831 | |
… | |
… | |
838 | { |
837 | { |
839 | if (ictx && octx) |
838 | if (ictx && octx) |
840 | send_vpn_packet (pkt, si, tos); |
839 | send_vpn_packet (pkt, si, tos); |
841 | else |
840 | else |
842 | { |
841 | { |
843 | vpn_queue.put (new vpn_packet (*pkt)); |
842 | vpn_queue.put ((vpn_packet *)new data_packet (*(data_packet *)pkt)); |
844 | |
843 | |
845 | establish_connection (); |
844 | establish_connection (); |
846 | } |
845 | } |
847 | } |
846 | } |
848 | |
847 | |
… | |
… | |
907 | if (p->initiate) |
906 | if (p->initiate) |
908 | send_auth_request (rsi, false); |
907 | send_auth_request (rsi, false); |
909 | |
908 | |
910 | rsachallenge k; |
909 | rsachallenge k; |
911 | |
910 | |
912 | if (0 > RSA_private_decrypt (sizeof (p->encr), |
911 | if (!rsa_decrypt (::conf.rsa_key, p->encr, k)) |
913 | (unsigned char *)&p->encr, (unsigned char *)&k, |
912 | { |
914 | ::conf.rsa_key, RSA_PKCS1_OAEP_PADDING)) |
|
|
915 | slog (L_ERR, _("%s(%s): challenge illegal or corrupted"), |
913 | slog (L_ERR, _("%s(%s): challenge illegal or corrupted (%s). mismatched key or config file?"), |
916 | conf->nodename, (const char *)rsi); |
914 | conf->nodename, (const char *)rsi, ERR_error_string (ERR_get_error (), 0)); |
|
|
915 | break; |
|
|
916 | } |
917 | else |
917 | else |
918 | { |
918 | { |
919 | delete octx; |
919 | delete octx; |
920 | |
920 | |
921 | octx = new crypto_ctx (k, 1); |
921 | octx = new crypto_ctx (k, 1); |
922 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
922 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
923 | |
923 | |
|
|
924 | // compatibility code, remove when no longer required |
|
|
925 | if (p->flags & 1) p->features |= FEATURE_COMPRESSION; |
|
|
926 | |
924 | conf->protocols = p->protocols; |
927 | conf->protocols = p->protocols; |
|
|
928 | features = p->features & FEATURES; |
925 | |
929 | |
926 | send_auth_response (rsi, p->id, k); |
930 | send_auth_response (rsi, p->id, k); |
927 | |
931 | |
928 | connection_established (); |
932 | connection_established (); |
929 | |
933 | |
… | |
… | |
954 | |
958 | |
955 | rsachallenge chg; |
959 | rsachallenge chg; |
956 | |
960 | |
957 | if (!rsa_cache.find (p->id, chg)) |
961 | if (!rsa_cache.find (p->id, chg)) |
958 | { |
962 | { |
959 | slog (L_ERR, _("%s(%s): unrequested auth response"), |
963 | slog (L_ERR, _("%s(%s): unrequested auth response ignored"), |
960 | conf->nodename, (const char *)rsi); |
964 | conf->nodename, (const char *)rsi); |
961 | break; |
965 | break; |
962 | } |
966 | } |
963 | else |
967 | else |
964 | { |
968 | { |
965 | crypto_ctx *cctx = new crypto_ctx (chg, 0); |
969 | crypto_ctx *cctx = new crypto_ctx (chg, 0); |
966 | |
970 | |
967 | if (!p->hmac_chk (cctx)) |
971 | if (!p->hmac_chk (cctx)) |
|
|
972 | { |
968 | slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n" |
973 | slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n" |
969 | "could be an attack, or just corruption or an synchronization error"), |
974 | "could be an attack, or just corruption or a synchronization error"), |
970 | conf->nodename, (const char *)rsi); |
975 | conf->nodename, (const char *)rsi); |
|
|
976 | break; |
|
|
977 | } |
971 | else |
978 | else |
972 | { |
979 | { |
973 | rsaresponse h; |
980 | rsaresponse h; |
974 | |
981 | |
975 | rsa_hash (p->id, chg, h); |
982 | rsa_hash (p->id, chg, h); |
… | |
… | |
1021 | { |
1028 | { |
1022 | vpndata_packet *p = (vpndata_packet *)pkt; |
1029 | vpndata_packet *p = (vpndata_packet *)pkt; |
1023 | |
1030 | |
1024 | if (!p->hmac_chk (ictx)) |
1031 | if (!p->hmac_chk (ictx)) |
1025 | slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n" |
1032 | slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n" |
1026 | "could be an attack, or just corruption or an synchronization error"), |
1033 | "could be an attack, or just corruption or a synchronization error"), |
1027 | conf->nodename, (const char *)rsi); |
1034 | conf->nodename, (const char *)rsi); |
1028 | else |
1035 | else |
1029 | { |
1036 | { |
1030 | u32 seqno; |
1037 | u32 seqno; |
1031 | tap_packet *d = p->unpack (this, seqno); |
1038 | tap_packet *d = p->unpack (this, seqno); |
1032 | |
1039 | |
1033 | if (iseqno.recv_ok (seqno)) |
1040 | if (iseqno.recv_ok (seqno)) |
1034 | { |
1041 | { |
1035 | vpn->tap->send (d); |
1042 | vpn->tap->send (d); |
1036 | |
|
|
1037 | if (p->dst () == 0) // re-broadcast |
|
|
1038 | for (vpn::conns_vector::iterator i = vpn->conns.begin (); i != vpn->conns.end (); ++i) |
|
|
1039 | { |
|
|
1040 | connection *c = *i; |
|
|
1041 | |
|
|
1042 | if (c->conf != THISNODE && c->conf != conf) |
|
|
1043 | c->inject_data_packet (d); |
|
|
1044 | } |
|
|
1045 | |
1043 | |
1046 | if (si != rsi) |
1044 | if (si != rsi) |
1047 | { |
1045 | { |
1048 | // fast re-sync on connection changes, useful especially for tcp/ip |
1046 | // fast re-sync on connection changes, useful especially for tcp/ip |
1049 | si = rsi; |
1047 | si = rsi; |
… | |
… | |
1123 | { |
1121 | { |
1124 | reset_connection (); |
1122 | reset_connection (); |
1125 | establish_connection (); |
1123 | establish_connection (); |
1126 | } |
1124 | } |
1127 | else if (NOW < last_activity + ::conf.keepalive) |
1125 | else if (NOW < last_activity + ::conf.keepalive) |
1128 | w.at = last_activity + ::conf.keepalive; |
1126 | w.start (last_activity + ::conf.keepalive); |
1129 | else if (conf->connectmode != conf_node::C_ONDEMAND |
1127 | else if (conf->connectmode != conf_node::C_ONDEMAND |
1130 | || THISNODE->connectmode != conf_node::C_ONDEMAND) |
1128 | || THISNODE->connectmode != conf_node::C_ONDEMAND) |
1131 | { |
1129 | { |
1132 | send_ping (si); |
1130 | send_ping (si); |
1133 | w.at = NOW + 5; |
1131 | w.start (NOW + 5); |
1134 | } |
1132 | } |
1135 | else if (NOW < last_activity + ::conf.keepalive + 10) |
1133 | else if (NOW < last_activity + ::conf.keepalive + 10) |
1136 | // hold ondemand connections implicitly a few seconds longer |
1134 | // hold ondemand connections implicitly a few seconds longer |
1137 | // should delete octx, though, or something like that ;) |
1135 | // should delete octx, though, or something like that ;) |
1138 | w.at = last_activity + ::conf.keepalive + 10; |
1136 | w.start (last_activity + ::conf.keepalive + 10); |
1139 | else |
1137 | else |
1140 | reset_connection (); |
1138 | reset_connection (); |
1141 | } |
1139 | } |
1142 | |
1140 | |
1143 | void connection::send_connect_request (int id) |
1141 | void connection::send_connect_request (int id) |