ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/gvpe/src/connection.C
(Generate patch)

Comparing gvpe/src/connection.C (file contents):
Revision 1.11 by pcg, Sun Apr 13 00:35:46 2003 UTC vs.
Revision 1.37 by pcg, Fri Jun 11 15:56:34 2004 UTC

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
21extern "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
46struct crypto_ctx 53struct 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
55crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) 62crypto_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
63crypto_ctx::~crypto_ctx () 70crypto_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
69static void 76static void
70rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) 77rsa_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
82struct rsa_entry { 89struct rsa_entry {
83 tstamp expire; 90 tstamp expire;
131 138
132} rsa_cache; 139} rsa_cache;
133 140
134void rsa_cache::cleaner_cb (time_watcher &w) 141void 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
147 } 152 }
148} 153}
149 154
150////////////////////////////////////////////////////////////////////////////// 155//////////////////////////////////////////////////////////////////////////////
151 156
152void pkt_queue::put (tap_packet *p) 157void pkt_queue::put (net_packet *p)
153{ 158{
154 if (queue[i]) 159 if (queue[i])
155 { 160 {
156 delete queue[i]; 161 delete queue[i];
157 j = (j + 1) % QUEUEDEPTH; 162 j = (j + 1) % QUEUEDEPTH;
160 queue[i] = p; 165 queue[i] = p;
161 166
162 i = (i + 1) % QUEUEDEPTH; 167 i = (i + 1) % QUEUEDEPTH;
163} 168}
164 169
165tap_packet *pkt_queue::get () 170net_packet *pkt_queue::get ()
166{ 171{
167 tap_packet *p = queue[j]; 172 net_packet *p = queue[j];
168 173
169 if (p) 174 if (p)
170 { 175 {
171 queue[j] = 0; 176 queue[j] = 0;
172 j = (j + 1) % QUEUEDEPTH; 177 j = (j + 1) % QUEUEDEPTH;
197// only do action once every x seconds per host whole allowing bursts. 202// only do action once every x seconds per host whole allowing bursts.
198// this implementation ("splay list" ;) is inefficient, 203// this implementation ("splay list" ;) is inefficient,
199// but low on resources. 204// but low on resources.
200struct net_rate_limiter : list<net_rateinfo> 205struct net_rate_limiter : list<net_rateinfo>
201{ 206{
202 static const double ALPHA = 1. - 1. / 180.; // allow bursts 207# define NRL_ALPHA (1. - 1. / 600.) // allow bursts
203 static const double CUTOFF = 10.; // one event every CUTOFF seconds 208# define NRL_CUTOFF 10. // one event every CUTOFF seconds
204 static const double EXPIRE = CUTOFF * 30.; // expire entries after this time 209# define NRL_EXPIRE (NRL_CUTOFF * 30.) // expire entries after this time
205 static const double MAXDIF = CUTOFF * (1. / (1. - ALPHA)); // maximum diff /count value 210# define NRL_MAXDIF (NRL_CUTOFF * (1. / (1. - NRL_ALPHA))) // maximum diff /count value
206 211
207 bool can (const sockinfo &si) { return can((u32)si.host); } 212 bool can (const sockinfo &si) { return can((u32)si.host); }
208 bool can (u32 host); 213 bool can (u32 host);
209}; 214};
210 215
211net_rate_limiter auth_rate_limiter, reset_rate_limiter; 216net_rate_limiter auth_rate_limiter, reset_rate_limiter;
212 217
215 iterator i; 220 iterator i;
216 221
217 for (i = begin (); i != end (); ) 222 for (i = begin (); i != end (); )
218 if (i->host == host) 223 if (i->host == host)
219 break; 224 break;
220 else if (i->last < NOW - EXPIRE) 225 else if (i->last < NOW - NRL_EXPIRE)
221 i = erase (i); 226 i = erase (i);
222 else 227 else
223 i++; 228 i++;
224 229
225 if (i == end ()) 230 if (i == end ())
226 { 231 {
227 net_rateinfo ri; 232 net_rateinfo ri;
228 233
229 ri.host = host; 234 ri.host = host;
230 ri.pcnt = 1.; 235 ri.pcnt = 1.;
231 ri.diff = MAXDIF; 236 ri.diff = NRL_MAXDIF;
232 ri.last = NOW; 237 ri.last = NOW;
233 238
234 push_front (ri); 239 push_front (ri);
235 240
236 return true; 241 return true;
238 else 243 else
239 { 244 {
240 net_rateinfo ri (*i); 245 net_rateinfo ri (*i);
241 erase (i); 246 erase (i);
242 247
243 ri.pcnt = ri.pcnt * ALPHA; 248 ri.pcnt = ri.pcnt * NRL_ALPHA;
244 ri.diff = ri.diff * ALPHA + (NOW - ri.last); 249 ri.diff = ri.diff * NRL_ALPHA + (NOW - ri.last);
245 250
246 ri.last = NOW; 251 ri.last = NOW;
247 252
248 double dif = ri.diff / ri.pcnt; 253 double dif = ri.diff / ri.pcnt;
249 254
250 bool send = dif > CUTOFF; 255 bool send = dif > NRL_CUTOFF;
251 256
252 if (dif > MAXDIF) 257 if (dif > NRL_MAXDIF)
253 { 258 {
254 ri.pcnt = 1.; 259 ri.pcnt = 1.;
255 ri.diff = MAXDIF; 260 ri.diff = NRL_MAXDIF;
256 } 261 }
257 else if (send) 262 else if (send)
258 ri.pcnt++; 263 ri.pcnt++;
259 264
260 push_front (ri); 265 push_front (ri);
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
312struct vpndata_packet:vpn_packet 317struct 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;
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 }
459}; 473};
460 474
461void config_packet::setup (ptype type, int dst) 475void config_packet::setup (ptype type, int dst)
462{ 476{
463 prot_major = PROTOCOL_MAJOR; 477 prot_major = PROTOCOL_MAJOR;
464 prot_minor = PROTOCOL_MINOR; 478 prot_minor = PROTOCOL_MINOR;
465 randsize = RAND_SIZE; 479 randsize = RAND_SIZE;
466 hmaclen = HMACLENGTH; 480 hmaclen = HMACLENGTH;
467 flags = curflags (); 481 flags = ENABLE_COMPRESSION ? 0x81 : 0x80;
468 challengelen = sizeof (rsachallenge); 482 challengelen = sizeof (rsachallenge);
483 features = get_features ();
469 484
470 cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); 485 cipher_nid = htonl (EVP_CIPHER_nid (CIPHER));
471 digest_nid = htonl (EVP_MD_type (RSA_HASH)); 486 digest_nid = htonl (EVP_MD_type (RSA_HASH));
472 hmac_nid = htonl (EVP_MD_type (DIGEST)); 487 hmac_nid = htonl (EVP_MD_type (DIGEST));
473 488
475 set_hdr (type, dst); 490 set_hdr (type, dst);
476} 491}
477 492
478bool config_packet::chk_config () const 493bool config_packet::chk_config () const
479{ 494{
480 return prot_major == PROTOCOL_MAJOR 495 if (prot_major != PROTOCOL_MAJOR)
481 && randsize == RAND_SIZE 496 slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR);
482 && hmaclen == HMACLENGTH 497 else if (randsize != RAND_SIZE)
483 && flags == curflags () 498 slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE);
499 else if (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
502 else if (flags != curflags ())
503 slog (L_WARN, _("flag mismatch (remote %x <=> local %x)"), flags, curflags ());
504#endif
484 && challengelen == sizeof (rsachallenge) 505 else if (challengelen != sizeof (rsachallenge))
506 slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge));
485 && cipher_nid == htonl (EVP_CIPHER_nid (CIPHER)) 507 else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER)))
508 slog (L_WARN, _("cipher mismatch (remote %x <=> local %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER));
486 && digest_nid == htonl (EVP_MD_type (RSA_HASH)) 509 else if (digest_nid != htonl (EVP_MD_type (RSA_HASH)))
510 slog (L_WARN, _("digest mismatch (remote %x <=> local %x)"), ntohl (digest_nid), EVP_MD_type (RSA_HASH));
487 && hmac_nid == htonl (EVP_MD_type (DIGEST)); 511 else if (hmac_nid != htonl (EVP_MD_type (DIGEST)))
512 slog (L_WARN, _("hmac mismatch (remote %x <=> local %x)"), ntohl (hmac_nid), EVP_MD_type (DIGEST));
513 else
514 return true;
515
516 return false;
488} 517}
489 518
490struct auth_req_packet : config_packet 519struct auth_req_packet : config_packet
491{ 520{
492 char magic[8]; 521 char magic[8];
493 u8 initiate; // false if this is just an automatic reply 522 u8 initiate; // false if this is just an automatic reply
494 u8 protocols; // supported protocols (will get patches on forward) 523 u8 protocols; // supported protocols (will be patched on forward)
495 u8 pad2, pad3; 524 u8 pad2, pad3;
496 rsaid id; 525 rsaid id;
497 rsaencrdata encr; 526 rsaencrdata encr;
498 527
499 auth_req_packet (int dst, bool initiate_, u8 protocols_) 528 auth_req_packet (int dst, bool initiate_, u8 protocols_)
560{ 589{
561 if (ictx && octx) 590 if (ictx && octx)
562 { 591 {
563 connectmode = conf->connectmode; 592 connectmode = conf->connectmode;
564 593
594 // make sure rekeying timeouts are slightly asymmetric
565 rekey.start (NOW + ::conf.rekey); 595 rekey.start (NOW + ::conf.rekey
596 + (conf->id > THISNODE->id ? 10 : 0));
566 keepalive.start (NOW + ::conf.keepalive); 597 keepalive.start (NOW + ::conf.keepalive);
567 598
568 // send queued packets 599 // send queued packets
569 if (ictx && octx) 600 if (ictx && octx)
601 {
570 while (tap_packet *p = queue.get ()) 602 while (tap_packet *p = (tap_packet *)data_queue.get ())
571 { 603 {
572 send_data_packet (p); 604 send_data_packet (p);
573 delete p; 605 delete p;
574 } 606 }
607
608 while (vpn_packet *p = (vpn_packet *)vpn_queue.get ())
609 {
610 send_vpn_packet (p, si, IPTOS_RELIABILITY);
611 delete p;
612 }
613 }
575 } 614 }
576 else 615 else
577 { 616 {
578 retry_cnt = 0; 617 retry_cnt = 0;
579 establish_connection.start (NOW + 5); 618 establish_connection.start (NOW + 5);
580 keepalive.reset (); 619 keepalive.stop ();
581 rekey.reset (); 620 rekey.stop ();
582 } 621 }
583} 622}
584 623
585void 624void
586connection::reset_si () 625connection::reset_si ()
652connection::send_auth_request (const sockinfo &si, bool initiate) 691connection::send_auth_request (const sockinfo &si, bool initiate)
653{ 692{
654 auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols); 693 auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols);
655 694
656 rsachallenge chg; 695 rsachallenge chg;
657
658 rsa_cache.gen (pkt->id, chg); 696 rsa_cache.gen (pkt->id, chg);
659 697 rsa_encrypt (conf->rsa_key, chg, pkt->encr);
660 if (0 > RSA_public_encrypt (sizeof chg,
661 (unsigned char *)&chg, (unsigned char *)&pkt->encr,
662 conf->rsa_key, RSA_PKCS1_OAEP_PADDING))
663 fatal ("RSA_public_encrypt error");
664 698
665 slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si); 699 slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si);
666 700
667 send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly 701 send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly
668 702
702} 736}
703 737
704void 738void
705connection::establish_connection_cb (time_watcher &w) 739connection::establish_connection_cb (time_watcher &w)
706{ 740{
707 if (ictx || conf == THISNODE 741 if (!ictx
742 && conf != THISNODE
708 || connectmode == conf_node::C_NEVER 743 && connectmode != conf_node::C_NEVER
709 || connectmode == conf_node::C_DISABLED) 744 && connectmode != conf_node::C_DISABLED
710 w.at = TSTAMP_CANCEL; 745 && NOW > w.at)
711 else if (w.at <= NOW)
712 { 746 {
713 double retry_int = double (retry_cnt & 3 ? (retry_cnt & 3) : 1 << (retry_cnt >> 2)) * 0.6; 747 double retry_int = double (retry_cnt & 3 ? (retry_cnt & 3) : 1 << (retry_cnt >> 2)) * 0.6;
714 748
715 if (retry_int < 3600 * 8) 749 if (retry_int < conf->max_retry)
716 retry_cnt++; 750 retry_cnt++;
751 else
752 retry_int = conf->max_retry;
717 753
718 w.at = NOW + retry_int; 754 w.start (NOW + retry_int);
719 755
720 reset_si (); 756 reset_si ();
721 757
722 if (si.prot && !si.host) 758 if (si.prot && !si.host)
723 vpn->send_connect_request (conf->id); 759 vpn->send_connect_request (conf->id);
754 si.host= 0; 790 si.host= 0;
755 791
756 last_activity = 0; 792 last_activity = 0;
757 retry_cnt = 0; 793 retry_cnt = 0;
758 794
759 rekey.reset (); 795 rekey.stop ();
760 keepalive.reset (); 796 keepalive.stop ();
761 establish_connection.reset (); 797 establish_connection.stop ();
762} 798}
763 799
764void 800void
765connection::shutdown () 801connection::shutdown ()
766{ 802{
771} 807}
772 808
773void 809void
774connection::rekey_cb (time_watcher &w) 810connection::rekey_cb (time_watcher &w)
775{ 811{
776 w.at = TSTAMP_CANCEL;
777
778 reset_connection (); 812 reset_connection ();
779 establish_connection (); 813 establish_connection ();
780} 814}
781 815
782void 816void
783connection::send_data_packet (tap_packet *pkt, bool broadcast) 817connection::send_data_packet (tap_packet *pkt)
784{ 818{
785 vpndata_packet *p = new vpndata_packet; 819 vpndata_packet *p = new vpndata_packet;
786 int tos = 0; 820 int tos = 0;
787 821
788 if (conf->inherit_tos 822 // I am not hilarious about peeking into packets, but so be it.
789 && (*pkt)[12] == 0x08 && (*pkt)[13] == 0x00 // IP 823 if (conf->inherit_tos && pkt->is_ipv4 ())
790 && ((*pkt)[14] & 0xf0) == 0x40) // IPv4
791 tos = (*pkt)[15] & IPTOS_TOS_MASK; 824 tos = (*pkt)[15] & IPTOS_TOS_MASK;
792 825
793 p->setup (this, broadcast ? 0 : conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs 826 p->setup (this, conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs
794 send_vpn_packet (p, si, tos); 827 send_vpn_packet (p, si, tos);
795 828
796 delete p; 829 delete p;
797 830
798 if (oseqno > MAX_SEQNO) 831 if (oseqno > MAX_SEQNO)
799 rekey (); 832 rekey ();
800} 833}
801 834
802void 835void
803connection::inject_data_packet (tap_packet *pkt, bool broadcast) 836connection::inject_data_packet (tap_packet *pkt, bool broadcast/*TODO DDD*/)
804{ 837{
805 if (ictx && octx) 838 if (ictx && octx)
806 send_data_packet (pkt, broadcast); 839 send_data_packet (pkt);
807 else 840 else
808 { 841 {
809 if (!broadcast)//DDDD 842 if (!broadcast)//DDDD
810 queue.put (new tap_packet (*pkt)); 843 data_queue.put (new tap_packet (*pkt));
811 844
812 establish_connection (); 845 establish_connection ();
813 } 846 }
814} 847}
815 848
816void connection::inject_vpn_packet (vpn_packet *pkt, int tos) 849void connection::inject_vpn_packet (vpn_packet *pkt, int tos)
817{ 850{
818 if (ictx && octx) 851 if (ictx && octx)
819 send_vpn_packet (pkt, si, tos); 852 send_vpn_packet (pkt, si, tos);
820 else 853 else
854 {
855 vpn_queue.put ((vpn_packet *)new data_packet (*(data_packet *)pkt));
856
821 establish_connection (); 857 establish_connection ();
858 }
822} 859}
823 860
824void 861void
825connection::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi) 862connection::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
826{ 863{
882 if (p->initiate) 919 if (p->initiate)
883 send_auth_request (rsi, false); 920 send_auth_request (rsi, false);
884 921
885 rsachallenge k; 922 rsachallenge k;
886 923
887 if (0 > RSA_private_decrypt (sizeof (p->encr), 924 if (!rsa_decrypt (::conf.rsa_key, p->encr, k))
888 (unsigned char *)&p->encr, (unsigned char *)&k, 925 {
889 ::conf.rsa_key, RSA_PKCS1_OAEP_PADDING))
890 slog (L_ERR, _("%s(%s): challenge illegal or corrupted"), 926 slog (L_ERR, _("%s(%s): challenge illegal or corrupted (%s). mismatched key or config file?"),
891 conf->nodename, (const char *)rsi); 927 conf->nodename, (const char *)rsi, ERR_error_string (ERR_get_error (), 0));
928 break;
929 }
892 else 930 else
893 { 931 {
894 delete octx; 932 delete octx;
895 933
896 octx = new crypto_ctx (k, 1); 934 octx = new crypto_ctx (k, 1);
897 oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; 935 oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff;
898 936
937 // compatibility code, remove when no longer required
938 if (p->flags & 1) p->features |= FEATURE_COMPRESSION;
939
899 conf->protocols = p->protocols; 940 conf->protocols = p->protocols;
941 features = p->features & config_packet::get_features ();
900 942
901 send_auth_response (rsi, p->id, k); 943 send_auth_response (rsi, p->id, k);
902 944
903 connection_established (); 945 connection_established ();
904 946
905 break; 947 break;
906 } 948 }
907 } 949 }
950 else
951 slog (L_WARN, _("%s(%s): protocol mismatch"),
952 conf->nodename, (const char *)rsi);
908 953
909 send_reset (rsi); 954 send_reset (rsi);
910 } 955 }
911 956
912 break; 957 break;
925 PROTOCOL_MINOR, conf->nodename, p->prot_minor); 970 PROTOCOL_MINOR, conf->nodename, p->prot_minor);
926 971
927 rsachallenge chg; 972 rsachallenge chg;
928 973
929 if (!rsa_cache.find (p->id, chg)) 974 if (!rsa_cache.find (p->id, chg))
975 {
930 slog (L_ERR, _("%s(%s): unrequested auth response"), 976 slog (L_ERR, _("%s(%s): unrequested auth response ignored"),
931 conf->nodename, (const char *)rsi); 977 conf->nodename, (const char *)rsi);
978 break;
979 }
932 else 980 else
933 { 981 {
934 crypto_ctx *cctx = new crypto_ctx (chg, 0); 982 crypto_ctx *cctx = new crypto_ctx (chg, 0);
935 983
936 if (!p->hmac_chk (cctx)) 984 if (!p->hmac_chk (cctx))
985 {
937 slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n" 986 slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n"
938 "could be an attack, or just corruption or an synchronization error"), 987 "could be an attack, or just corruption or a synchronization error"),
939 conf->nodename, (const char *)rsi); 988 conf->nodename, (const char *)rsi);
989 break;
990 }
940 else 991 else
941 { 992 {
942 rsaresponse h; 993 rsaresponse h;
943 994
944 rsa_hash (p->id, chg, h); 995 rsa_hash (p->id, chg, h);
990 { 1041 {
991 vpndata_packet *p = (vpndata_packet *)pkt; 1042 vpndata_packet *p = (vpndata_packet *)pkt;
992 1043
993 if (!p->hmac_chk (ictx)) 1044 if (!p->hmac_chk (ictx))
994 slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n" 1045 slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n"
995 "could be an attack, or just corruption or an synchronization error"), 1046 "could be an attack, or just corruption or a synchronization error"),
996 conf->nodename, (const char *)rsi); 1047 conf->nodename, (const char *)rsi);
997 else 1048 else
998 { 1049 {
999 u32 seqno; 1050 u32 seqno;
1000 tap_packet *d = p->unpack (this, seqno); 1051 tap_packet *d = p->unpack (this, seqno);
1001 1052
1002 if (iseqno.recv_ok (seqno)) 1053 if (iseqno.recv_ok (seqno))
1003 { 1054 {
1004 vpn->tap->send (d); 1055 vpn->tap->send (d);
1005 1056
1006 if (p->dst () == 0) // re-broadcast
1007 for (vpn::conns_vector::iterator i = vpn->conns.begin (); i != vpn->conns.end (); ++i)
1008 {
1009 connection *c = *i;
1010
1011 if (c->conf != THISNODE && c->conf != conf)
1012 c->inject_data_packet (d);
1013 }
1014
1015 if (si != rsi) 1057 if (si != rsi)
1016 { 1058 {
1017 // fast re-sync on conneciton changes, useful especially for tcp/ip 1059 // fast re-sync on connection changes, useful especially for tcp/ip
1018 si = rsi; 1060 si = rsi;
1019 1061
1020 slog (L_INFO, _("%s(%s): socket address changed to %s"), 1062 slog (L_INFO, _("%s(%s): socket address changed to %s"),
1021 conf->nodename, (const char *)si, (const char *)rsi); 1063 conf->nodename, (const char *)si, (const char *)rsi);
1022 } 1064 }
1023
1024 delete d;
1025
1026 break;
1027 } 1065 }
1066
1067 delete d;
1068 break;
1028 } 1069 }
1029 } 1070 }
1030 1071
1031 send_reset (rsi); 1072 send_reset (rsi);
1032 break; 1073 break;
1092 { 1133 {
1093 reset_connection (); 1134 reset_connection ();
1094 establish_connection (); 1135 establish_connection ();
1095 } 1136 }
1096 else if (NOW < last_activity + ::conf.keepalive) 1137 else if (NOW < last_activity + ::conf.keepalive)
1097 w.at = last_activity + ::conf.keepalive; 1138 w.start (last_activity + ::conf.keepalive);
1098 else if (conf->connectmode != conf_node::C_ONDEMAND 1139 else if (conf->connectmode != conf_node::C_ONDEMAND
1099 || THISNODE->connectmode != conf_node::C_ONDEMAND) 1140 || THISNODE->connectmode != conf_node::C_ONDEMAND)
1100 { 1141 {
1101 send_ping (si); 1142 send_ping (si);
1102 w.at = NOW + 5; 1143 w.start (NOW + 5);
1103 } 1144 }
1145 else if (NOW < last_activity + ::conf.keepalive + 10)
1146 // hold ondemand connections implicitly a few seconds longer
1147 // should delete octx, though, or something like that ;)
1148 w.start (last_activity + ::conf.keepalive + 10);
1104 else 1149 else
1105 reset_connection (); 1150 reset_connection ();
1106} 1151}
1107 1152
1108void connection::send_connect_request (int id) 1153void connection::send_connect_request (int id)

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines