… | |
… | |
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; |
… | |
… | |
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; |
462 | }; |
461 | }; |
|
|
462 | |
|
|
463 | #define FEATURES ((ENABLE_COMPRESSION ? FEATURE_COMPRESSION : 0) \ |
|
|
464 | | (ENABLE_ROHC ? FEATURE_ROHC : 0)) |
463 | |
465 | |
464 | void config_packet::setup (ptype type, int dst) |
466 | void config_packet::setup (ptype type, int dst) |
465 | { |
467 | { |
466 | prot_major = PROTOCOL_MAJOR; |
468 | prot_major = PROTOCOL_MAJOR; |
467 | prot_minor = PROTOCOL_MINOR; |
469 | prot_minor = PROTOCOL_MINOR; |
468 | randsize = RAND_SIZE; |
470 | randsize = RAND_SIZE; |
469 | hmaclen = HMACLENGTH; |
471 | hmaclen = HMACLENGTH; |
470 | flags = curflags (); |
472 | flags = ENABLE_COMPRESSION ? 0x81 : 0x80; |
471 | challengelen = sizeof (rsachallenge); |
473 | challengelen = sizeof (rsachallenge); |
|
|
474 | features = FEATURES; |
472 | |
475 | |
473 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
476 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
474 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
477 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
475 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
478 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
476 | |
479 | |
… | |
… | |
484 | slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR); |
487 | slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR); |
485 | else if (randsize != RAND_SIZE) |
488 | else if (randsize != RAND_SIZE) |
486 | slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE); |
489 | slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE); |
487 | else if (hmaclen != HMACLENGTH) |
490 | else if (hmaclen != HMACLENGTH) |
488 | slog (L_WARN, _("hmac length mismatch (remote %d <=> local %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 |
489 | else if (flags != curflags ()) |
493 | else if (flags != curflags ()) |
490 | slog (L_WARN, _("flag mismatch (remote %x <=> local %x)"), flags, curflags ()); |
494 | slog (L_WARN, _("flag mismatch (remote %x <=> local %x)"), flags, curflags ()); |
|
|
495 | #endif |
491 | else if (challengelen != sizeof (rsachallenge)) |
496 | else if (challengelen != sizeof (rsachallenge)) |
492 | slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge)); |
497 | slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge)); |
493 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
498 | 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)); |
499 | 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))) |
500 | else if (digest_nid != htonl (EVP_MD_type (RSA_HASH))) |
… | |
… | |
914 | delete octx; |
919 | delete octx; |
915 | |
920 | |
916 | octx = new crypto_ctx (k, 1); |
921 | octx = new crypto_ctx (k, 1); |
917 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
922 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
918 | |
923 | |
|
|
924 | // compatibility code, remove when no longer required |
|
|
925 | if (p->flags & 1) p->features |= FEATURE_COMPRESSION; |
|
|
926 | |
919 | conf->protocols = p->protocols; |
927 | conf->protocols = p->protocols; |
|
|
928 | features = p->features & FEATURES; |
920 | |
929 | |
921 | send_auth_response (rsi, p->id, k); |
930 | send_auth_response (rsi, p->id, k); |
922 | |
931 | |
923 | connection_established (); |
932 | connection_established (); |
924 | |
933 | |