… | |
… | |
17 | 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 |
18 | */ |
18 | */ |
19 | |
19 | |
20 | #include "config.h" |
20 | #include "config.h" |
21 | |
21 | |
22 | extern "C" { |
|
|
23 | # include "lzf/lzf.h" |
|
|
24 | } |
|
|
25 | |
|
|
26 | #include <cassert> |
22 | #include <cassert> |
27 | |
23 | |
28 | #include <list> |
24 | #include <list> |
29 | |
25 | |
30 | #include <openssl/rand.h> |
26 | #include <openssl/rand.h> |
… | |
… | |
46 | # define RAND_pseudo_bytes RAND_bytes |
42 | # define RAND_pseudo_bytes RAND_bytes |
47 | #endif |
43 | #endif |
48 | |
44 | |
49 | #define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic |
45 | #define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic |
50 | |
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 | |
51 | struct crypto_ctx |
53 | struct crypto_ctx |
52 | { |
54 | { |
53 | EVP_CIPHER_CTX cctx; |
55 | EVP_CIPHER_CTX cctx; |
54 | HMAC_CTX hctx; |
56 | HMAC_CTX hctx; |
55 | |
57 | |
… | |
… | |
58 | }; |
60 | }; |
59 | |
61 | |
60 | crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) |
62 | crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) |
61 | { |
63 | { |
62 | EVP_CIPHER_CTX_init (&cctx); |
64 | EVP_CIPHER_CTX_init (&cctx); |
63 | 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)); |
64 | HMAC_CTX_init (&hctx); |
66 | HMAC_CTX_init (&hctx); |
65 | 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); |
66 | } |
68 | } |
67 | |
69 | |
68 | crypto_ctx::~crypto_ctx () |
70 | crypto_ctx::~crypto_ctx () |
69 | { |
71 | { |
70 | EVP_CIPHER_CTX_cleanup (&cctx); |
72 | require (EVP_CIPHER_CTX_cleanup (&cctx)); |
71 | HMAC_CTX_cleanup (&hctx); |
73 | HMAC_CTX_cleanup (&hctx); |
72 | } |
74 | } |
73 | |
75 | |
74 | static void |
76 | static void |
75 | rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) |
77 | rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) |
76 | { |
78 | { |
77 | EVP_MD_CTX ctx; |
79 | EVP_MD_CTX ctx; |
78 | |
80 | |
79 | EVP_MD_CTX_init (&ctx); |
81 | EVP_MD_CTX_init (&ctx); |
80 | EVP_DigestInit (&ctx, RSA_HASH); |
82 | require (EVP_DigestInit (&ctx, RSA_HASH)); |
81 | EVP_DigestUpdate(&ctx, &chg, sizeof chg); |
83 | require (EVP_DigestUpdate(&ctx, &chg, sizeof chg)); |
82 | EVP_DigestUpdate(&ctx, &id, sizeof id); |
84 | require (EVP_DigestUpdate(&ctx, &id, sizeof id)); |
83 | EVP_DigestFinal (&ctx, (unsigned char *)&h, 0); |
85 | require (EVP_DigestFinal (&ctx, (unsigned char *)&h, 0)); |
84 | EVP_MD_CTX_cleanup (&ctx); |
86 | EVP_MD_CTX_cleanup (&ctx); |
85 | } |
87 | } |
86 | |
88 | |
87 | struct rsa_entry { |
89 | struct rsa_entry { |
88 | tstamp expire; |
90 | tstamp expire; |
… | |
… | |
310 | } |
312 | } |
311 | |
313 | |
312 | #define MAXVPNDATA (MAX_MTU - 6 - 6) |
314 | #define MAXVPNDATA (MAX_MTU - 6 - 6) |
313 | #define DATAHDR (sizeof (u32) + RAND_SIZE) |
315 | #define DATAHDR (sizeof (u32) + RAND_SIZE) |
314 | |
316 | |
315 | struct vpndata_packet:vpn_packet |
317 | struct vpndata_packet : vpn_packet |
316 | { |
318 | { |
317 | u8 data[MAXVPNDATA + DATAHDR]; // seqno |
319 | u8 data[MAXVPNDATA + DATAHDR]; // seqno |
318 | |
320 | |
319 | 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); |
320 | tap_packet *unpack (connection *conn, u32 &seqno); |
322 | tap_packet *unpack (connection *conn, u32 &seqno); |
… | |
… | |
333 | int outl = 0, outl2; |
335 | int outl = 0, outl2; |
334 | ptype type = PT_DATA_UNCOMPRESSED; |
336 | ptype type = PT_DATA_UNCOMPRESSED; |
335 | |
337 | |
336 | #if ENABLE_COMPRESSION |
338 | #if ENABLE_COMPRESSION |
337 | u8 cdata[MAX_MTU]; |
339 | u8 cdata[MAX_MTU]; |
338 | u32 cl; |
|
|
339 | |
340 | |
|
|
341 | if (conn->features & ENABLE_COMPRESSION) |
|
|
342 | { |
340 | cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7); |
343 | u32 cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7); |
|
|
344 | |
341 | if (cl) |
345 | if (cl) |
342 | { |
346 | { |
343 | type = PT_DATA_COMPRESSED; |
347 | type = PT_DATA_COMPRESSED; |
344 | d = cdata; |
348 | d = cdata; |
345 | l = cl + 2; |
349 | l = cl + 2; |
346 | |
350 | |
347 | d[0] = cl >> 8; |
351 | d[0] = cl >> 8; |
348 | d[1] = cl; |
352 | d[1] = cl; |
|
|
353 | } |
349 | } |
354 | } |
350 | #endif |
355 | #endif |
351 | |
356 | |
352 | EVP_EncryptInit_ex (cctx, 0, 0, 0, 0); |
357 | require (EVP_EncryptInit_ex (cctx, 0, 0, 0, 0)); |
353 | |
358 | |
354 | struct { |
359 | struct { |
355 | #if RAND_SIZE |
360 | #if RAND_SIZE |
356 | u8 rnd[RAND_SIZE]; |
361 | u8 rnd[RAND_SIZE]; |
357 | #endif |
362 | #endif |
… | |
… | |
361 | datahdr.seqno = ntohl (seqno); |
366 | datahdr.seqno = ntohl (seqno); |
362 | #if RAND_SIZE |
367 | #if RAND_SIZE |
363 | RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE); |
368 | RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE); |
364 | #endif |
369 | #endif |
365 | |
370 | |
366 | EVP_EncryptUpdate (cctx, |
371 | require (EVP_EncryptUpdate (cctx, |
367 | (unsigned char *) data + outl, &outl2, |
372 | (unsigned char *) data + outl, &outl2, |
368 | (unsigned char *) &datahdr, DATAHDR); |
373 | (unsigned char *) &datahdr, DATAHDR)); |
369 | outl += outl2; |
374 | outl += outl2; |
370 | |
375 | |
371 | EVP_EncryptUpdate (cctx, |
376 | require (EVP_EncryptUpdate (cctx, |
372 | (unsigned char *) data + outl, &outl2, |
377 | (unsigned char *) data + outl, &outl2, |
373 | (unsigned char *) d, l); |
378 | (unsigned char *) d, l)); |
374 | outl += outl2; |
379 | outl += outl2; |
375 | |
380 | |
376 | EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2); |
381 | require (EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2)); |
377 | outl += outl2; |
382 | outl += outl2; |
378 | |
383 | |
379 | len = outl + data_hdr_size (); |
384 | len = outl + data_hdr_size (); |
380 | |
385 | |
381 | set_hdr (type, dst); |
386 | set_hdr (type, dst); |
… | |
… | |
390 | int outl = 0, outl2; |
395 | int outl = 0, outl2; |
391 | tap_packet *p = new tap_packet; |
396 | tap_packet *p = new tap_packet; |
392 | u8 *d; |
397 | u8 *d; |
393 | u32 l = len - data_hdr_size (); |
398 | u32 l = len - data_hdr_size (); |
394 | |
399 | |
395 | EVP_DecryptInit_ex (cctx, 0, 0, 0, 0); |
400 | require (EVP_DecryptInit_ex (cctx, 0, 0, 0, 0)); |
396 | |
401 | |
397 | #if ENABLE_COMPRESSION |
402 | #if ENABLE_COMPRESSION |
398 | u8 cdata[MAX_MTU]; |
403 | u8 cdata[MAX_MTU]; |
399 | |
404 | |
400 | if (type == PT_DATA_COMPRESSED) |
405 | if (type == PT_DATA_COMPRESSED) |
… | |
… | |
402 | else |
407 | else |
403 | #endif |
408 | #endif |
404 | d = &(*p)[6 + 6 - DATAHDR]; |
409 | d = &(*p)[6 + 6 - DATAHDR]; |
405 | |
410 | |
406 | /* 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 */ |
407 | EVP_DecryptUpdate (cctx, |
412 | require (EVP_DecryptUpdate (cctx, |
408 | d, &outl2, |
413 | d, &outl2, |
409 | (unsigned char *)&data, len - data_hdr_size ()); |
414 | (unsigned char *)&data, len - data_hdr_size ())); |
410 | outl += outl2; |
415 | outl += outl2; |
411 | |
416 | |
412 | EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2); |
417 | require (EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2)); |
413 | outl += outl2; |
418 | outl += outl2; |
414 | |
419 | |
415 | seqno = ntohl (*(u32 *)(d + RAND_SIZE)); |
420 | seqno = ntohl (*(u32 *)(d + RAND_SIZE)); |
416 | |
421 | |
417 | id2mac (dst () ? dst() : THISNODE->id, p->dst); |
422 | id2mac (dst () ? dst() : THISNODE->id, p->dst); |
… | |
… | |
446 | { |
451 | { |
447 | // actually, hmaclen cannot be checked because the hmac |
452 | // actually, hmaclen cannot be checked because the hmac |
448 | // field comes before this data, so peers with other |
453 | // field comes before this data, so peers with other |
449 | // hmacs simply will not work. |
454 | // hmacs simply will not work. |
450 | u8 prot_major, prot_minor, randsize, hmaclen; |
455 | u8 prot_major, prot_minor, randsize, hmaclen; |
451 | u8 flags, challengelen, pad2, pad3; |
456 | u8 flags, challengelen, features, pad3; |
452 | u32 cipher_nid, digest_nid, hmac_nid; |
457 | u32 cipher_nid, digest_nid, hmac_nid; |
453 | |
|
|
454 | const u8 curflags () const |
|
|
455 | { |
|
|
456 | return 0x80 |
|
|
457 | | (ENABLE_COMPRESSION ? 0x01 : 0x00); |
|
|
458 | } |
|
|
459 | |
458 | |
460 | void setup (ptype type, int dst); |
459 | void setup (ptype type, int dst); |
461 | bool chk_config () const; |
460 | bool chk_config () const; |
|
|
461 | |
|
|
462 | static u8 get_features () |
|
|
463 | { |
|
|
464 | u8 f = 0; |
|
|
465 | #if ENABLE_COMPRESSION |
|
|
466 | f |= FEATURE_COMPRESSION; |
|
|
467 | #endif |
|
|
468 | #if ENABLE_ROHC |
|
|
469 | f |= FEATURE_ROHC; |
|
|
470 | #endif |
|
|
471 | return f; |
|
|
472 | } |
462 | }; |
473 | }; |
463 | |
474 | |
464 | void config_packet::setup (ptype type, int dst) |
475 | void config_packet::setup (ptype type, int dst) |
465 | { |
476 | { |
466 | prot_major = PROTOCOL_MAJOR; |
477 | prot_major = PROTOCOL_MAJOR; |
467 | prot_minor = PROTOCOL_MINOR; |
478 | prot_minor = PROTOCOL_MINOR; |
468 | randsize = RAND_SIZE; |
479 | randsize = RAND_SIZE; |
469 | hmaclen = HMACLENGTH; |
480 | hmaclen = HMACLENGTH; |
470 | flags = curflags (); |
481 | flags = ENABLE_COMPRESSION ? 0x81 : 0x80; |
471 | challengelen = sizeof (rsachallenge); |
482 | challengelen = sizeof (rsachallenge); |
|
|
483 | features = get_features (); |
472 | |
484 | |
473 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
485 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
474 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
486 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
475 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
487 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
476 | |
488 | |
… | |
… | |
484 | slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR); |
496 | slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR); |
485 | else if (randsize != RAND_SIZE) |
497 | else if (randsize != RAND_SIZE) |
486 | slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE); |
498 | slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE); |
487 | else if (hmaclen != HMACLENGTH) |
499 | else if (hmaclen != HMACLENGTH) |
488 | slog (L_WARN, _("hmac length mismatch (remote %d <=> local %d)"), hmaclen, HMACLENGTH); |
500 | slog (L_WARN, _("hmac length mismatch (remote %d <=> local %d)"), hmaclen, HMACLENGTH); |
|
|
501 | #if 0 // this implementation should handle all flag settings |
489 | else if (flags != curflags ()) |
502 | else if (flags != curflags ()) |
490 | slog (L_WARN, _("flag mismatch (remote %x <=> local %x)"), flags, curflags ()); |
503 | slog (L_WARN, _("flag mismatch (remote %x <=> local %x)"), flags, curflags ()); |
|
|
504 | #endif |
491 | else if (challengelen != sizeof (rsachallenge)) |
505 | else if (challengelen != sizeof (rsachallenge)) |
492 | slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge)); |
506 | slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge)); |
493 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
507 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
494 | slog (L_WARN, _("cipher mismatch (remote %x <=> local %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER)); |
508 | slog (L_WARN, _("cipher mismatch (remote %x <=> local %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER)); |
495 | else if (digest_nid != htonl (EVP_MD_type (RSA_HASH))) |
509 | else if (digest_nid != htonl (EVP_MD_type (RSA_HASH))) |
… | |
… | |
504 | |
518 | |
505 | struct auth_req_packet : config_packet |
519 | struct auth_req_packet : config_packet |
506 | { |
520 | { |
507 | char magic[8]; |
521 | char magic[8]; |
508 | u8 initiate; // false if this is just an automatic reply |
522 | u8 initiate; // false if this is just an automatic reply |
509 | u8 protocols; // supported protocols (will get patches on forward) |
523 | u8 protocols; // supported protocols (will be patched on forward) |
510 | u8 pad2, pad3; |
524 | u8 pad2, pad3; |
511 | rsaid id; |
525 | rsaid id; |
512 | rsaencrdata encr; |
526 | rsaencrdata encr; |
513 | |
527 | |
514 | auth_req_packet (int dst, bool initiate_, u8 protocols_) |
528 | auth_req_packet (int dst, bool initiate_, u8 protocols_) |
… | |
… | |
832 | { |
846 | { |
833 | if (ictx && octx) |
847 | if (ictx && octx) |
834 | send_vpn_packet (pkt, si, tos); |
848 | send_vpn_packet (pkt, si, tos); |
835 | else |
849 | else |
836 | { |
850 | { |
837 | vpn_queue.put (new vpn_packet (*pkt)); |
851 | vpn_queue.put ((vpn_packet *)new data_packet (*(data_packet *)pkt)); |
838 | |
852 | |
839 | establish_connection (); |
853 | establish_connection (); |
840 | } |
854 | } |
841 | } |
855 | } |
842 | |
856 | |
… | |
… | |
914 | delete octx; |
928 | delete octx; |
915 | |
929 | |
916 | octx = new crypto_ctx (k, 1); |
930 | octx = new crypto_ctx (k, 1); |
917 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
931 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
918 | |
932 | |
|
|
933 | // compatibility code, remove when no longer required |
|
|
934 | if (p->flags & 1) p->features |= FEATURE_COMPRESSION; |
|
|
935 | |
919 | conf->protocols = p->protocols; |
936 | conf->protocols = p->protocols; |
|
|
937 | features = p->features & config_packet::get_features (); |
920 | |
938 | |
921 | send_auth_response (rsi, p->id, k); |
939 | send_auth_response (rsi, p->id, k); |
922 | |
940 | |
923 | connection_established (); |
941 | connection_established (); |
924 | |
942 | |
… | |
… | |
1038 | si = rsi; |
1056 | si = rsi; |
1039 | |
1057 | |
1040 | slog (L_INFO, _("%s(%s): socket address changed to %s"), |
1058 | slog (L_INFO, _("%s(%s): socket address changed to %s"), |
1041 | conf->nodename, (const char *)si, (const char *)rsi); |
1059 | conf->nodename, (const char *)si, (const char *)rsi); |
1042 | } |
1060 | } |
1043 | |
|
|
1044 | delete d; |
|
|
1045 | |
|
|
1046 | break; |
|
|
1047 | } |
1061 | } |
|
|
1062 | |
|
|
1063 | delete d; |
|
|
1064 | |
|
|
1065 | break; |
1048 | } |
1066 | } |
1049 | } |
1067 | } |
1050 | |
1068 | |
1051 | send_reset (rsi); |
1069 | send_reset (rsi); |
1052 | break; |
1070 | break; |