1 | /* |
1 | /* |
2 | connection.C -- manage a single connection |
2 | connection.C -- manage a single connection |
|
|
3 | Copyright (C) 2003-2005 Marc Lehmann <gvpe@schmorp.de> |
3 | |
4 | |
|
|
5 | This file is part of GVPE. |
|
|
6 | |
4 | This program is free software; you can redistribute it and/or modify |
7 | GVPE is free software; you can redistribute it and/or modify |
5 | it under the terms of the GNU General Public License as published by |
8 | 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 |
9 | the Free Software Foundation; either version 2 of the License, or |
7 | (at your option) any later version. |
10 | (at your option) any later version. |
8 | |
11 | |
9 | This program is distributed in the hope that it will be useful, |
12 | This program is distributed in the hope that it will be useful, |
10 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
11 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
12 | GNU General Public License for more details. |
15 | GNU General Public License for more details. |
13 | |
16 | |
14 | You should have received a copy of the GNU General Public License |
17 | You should have received a copy of the GNU General Public License |
15 | along with this program; if not, write to the Free Software |
18 | along with gvpe; if not, write to the Free Software |
16 | Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
19 | Foundation, Inc. 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
17 | */ |
20 | */ |
18 | |
21 | |
19 | #include "config.h" |
22 | #include "config.h" |
20 | |
|
|
21 | extern "C" { |
|
|
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> |
29 | #include <openssl/rsa.h> |
28 | #include <openssl/rsa.h> |
30 | #include <openssl/err.h> |
29 | #include <openssl/err.h> |
31 | |
|
|
32 | #include "gettext.h" |
|
|
33 | |
30 | |
34 | #include "conf.h" |
31 | #include "conf.h" |
35 | #include "slog.h" |
32 | #include "slog.h" |
36 | #include "device.h" |
33 | #include "device.h" |
37 | #include "vpn.h" |
34 | #include "vpn.h" |
38 | #include "connection.h" |
35 | #include "connection.h" |
39 | |
36 | |
|
|
37 | #include "netcompat.h" |
|
|
38 | |
40 | #if !HAVE_RAND_PSEUDO_BYTES |
39 | #if !HAVE_RAND_PSEUDO_BYTES |
41 | # define RAND_pseudo_bytes RAND_bytes |
40 | # define RAND_pseudo_bytes RAND_bytes |
42 | #endif |
41 | #endif |
43 | |
42 | |
44 | #define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic |
43 | #define MAGIC "vped\xbd\xc6\xdb\x82" // 8 bytes of magic |
45 | |
44 | |
|
|
45 | #define ULTRA_FAST 1 |
|
|
46 | #define HLOG 15 |
|
|
47 | #include "lzf/lzf.h" |
|
|
48 | #include "lzf/lzf_c.c" |
|
|
49 | #include "lzf/lzf_d.c" |
|
|
50 | |
46 | struct crypto_ctx |
51 | struct crypto_ctx |
47 | { |
52 | { |
48 | EVP_CIPHER_CTX cctx; |
53 | EVP_CIPHER_CTX cctx; |
49 | HMAC_CTX hctx; |
54 | HMAC_CTX hctx; |
50 | |
55 | |
… | |
… | |
53 | }; |
58 | }; |
54 | |
59 | |
55 | crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) |
60 | crypto_ctx::crypto_ctx (const rsachallenge &challenge, int enc) |
56 | { |
61 | { |
57 | EVP_CIPHER_CTX_init (&cctx); |
62 | EVP_CIPHER_CTX_init (&cctx); |
58 | EVP_CipherInit_ex (&cctx, CIPHER, 0, &challenge[CHG_CIPHER_KEY], 0, enc); |
63 | require (EVP_CipherInit_ex (&cctx, CIPHER, 0, &challenge[CHG_CIPHER_KEY], 0, enc)); |
59 | HMAC_CTX_init (&hctx); |
64 | HMAC_CTX_init (&hctx); |
60 | HMAC_Init_ex (&hctx, &challenge[CHG_HMAC_KEY], HMAC_KEYLEN, DIGEST, 0); |
65 | HMAC_Init_ex (&hctx, &challenge[CHG_HMAC_KEY], HMAC_KEYLEN, DIGEST, 0); |
61 | } |
66 | } |
62 | |
67 | |
63 | crypto_ctx::~crypto_ctx () |
68 | crypto_ctx::~crypto_ctx () |
64 | { |
69 | { |
65 | EVP_CIPHER_CTX_cleanup (&cctx); |
70 | require (EVP_CIPHER_CTX_cleanup (&cctx)); |
66 | HMAC_CTX_cleanup (&hctx); |
71 | HMAC_CTX_cleanup (&hctx); |
67 | } |
72 | } |
68 | |
73 | |
69 | static void |
74 | static void |
70 | rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) |
75 | rsa_hash (const rsaid &id, const rsachallenge &chg, rsaresponse &h) |
71 | { |
76 | { |
72 | EVP_MD_CTX ctx; |
77 | EVP_MD_CTX ctx; |
73 | |
78 | |
74 | EVP_MD_CTX_init (&ctx); |
79 | EVP_MD_CTX_init (&ctx); |
75 | EVP_DigestInit (&ctx, RSA_HASH); |
80 | require (EVP_DigestInit (&ctx, RSA_HASH)); |
76 | EVP_DigestUpdate(&ctx, &chg, sizeof chg); |
81 | require (EVP_DigestUpdate(&ctx, &chg, sizeof chg)); |
77 | EVP_DigestUpdate(&ctx, &id, sizeof id); |
82 | require (EVP_DigestUpdate(&ctx, &id, sizeof id)); |
78 | EVP_DigestFinal (&ctx, (unsigned char *)&h, 0); |
83 | require (EVP_DigestFinal (&ctx, (unsigned char *)&h, 0)); |
79 | EVP_MD_CTX_cleanup (&ctx); |
84 | EVP_MD_CTX_cleanup (&ctx); |
80 | } |
85 | } |
81 | |
86 | |
82 | struct rsa_entry { |
87 | struct rsa_entry |
|
|
88 | { |
83 | tstamp expire; |
89 | tstamp expire; |
84 | rsaid id; |
90 | rsaid id; |
85 | rsachallenge chg; |
91 | rsachallenge chg; |
86 | }; |
92 | }; |
87 | |
93 | |
88 | struct rsa_cache : list<rsa_entry> |
94 | struct rsa_cache : list<rsa_entry> |
89 | { |
95 | { |
90 | void cleaner_cb (time_watcher &w); time_watcher cleaner; |
96 | inline void cleaner_cb (ev::timer &w, int revents); ev::timer cleaner; |
91 | |
97 | |
92 | bool find (const rsaid &id, rsachallenge &chg) |
98 | bool find (const rsaid &id, rsachallenge &chg) |
93 | { |
99 | { |
94 | for (iterator i = begin (); i != end (); ++i) |
100 | for (iterator i = begin (); i != end (); ++i) |
95 | { |
101 | { |
96 | if (!memcmp (&id, &i->id, sizeof id) && i->expire > NOW) |
102 | if (!memcmp (&id, &i->id, sizeof id) && i->expire > ev_now ()) |
97 | { |
103 | { |
98 | memcpy (&chg, &i->chg, sizeof chg); |
104 | memcpy (&chg, &i->chg, sizeof chg); |
99 | |
105 | |
100 | erase (i); |
106 | erase (i); |
101 | return true; |
107 | return true; |
102 | } |
108 | } |
103 | } |
109 | } |
104 | |
110 | |
105 | if (cleaner.at < NOW) |
111 | if (!cleaner.is_active ()) |
106 | cleaner.start (NOW + RSA_TTL); |
112 | cleaner.again (); |
107 | |
113 | |
108 | return false; |
114 | return false; |
109 | } |
115 | } |
110 | |
116 | |
111 | void gen (rsaid &id, rsachallenge &chg) |
117 | void gen (rsaid &id, rsachallenge &chg) |
112 | { |
118 | { |
113 | rsa_entry e; |
119 | rsa_entry e; |
114 | |
120 | |
115 | RAND_bytes ((unsigned char *)&id, sizeof id); |
121 | RAND_bytes ((unsigned char *)&id, sizeof id); |
116 | RAND_bytes ((unsigned char *)&chg, sizeof chg); |
122 | RAND_bytes ((unsigned char *)&chg, sizeof chg); |
117 | |
123 | |
118 | e.expire = NOW + RSA_TTL; |
124 | e.expire = ev_now () + RSA_TTL; |
119 | e.id = id; |
125 | e.id = id; |
120 | memcpy (&e.chg, &chg, sizeof chg); |
126 | memcpy (&e.chg, &chg, sizeof chg); |
121 | |
127 | |
122 | push_back (e); |
128 | push_back (e); |
123 | |
129 | |
124 | if (cleaner.at < NOW) |
130 | if (!cleaner.is_active ()) |
125 | cleaner.start (NOW + RSA_TTL); |
131 | cleaner.again (); |
126 | } |
132 | } |
127 | |
133 | |
128 | rsa_cache () |
134 | rsa_cache () |
129 | : cleaner (this, &rsa_cache::cleaner_cb) |
135 | { |
130 | { } |
136 | cleaner.set<rsa_cache, &rsa_cache::cleaner_cb> (this); |
|
|
137 | cleaner.set (RSA_TTL, RSA_TTL); |
|
|
138 | } |
131 | |
139 | |
132 | } rsa_cache; |
140 | } rsa_cache; |
133 | |
141 | |
134 | void rsa_cache::cleaner_cb (time_watcher &w) |
142 | void rsa_cache::cleaner_cb (ev::timer &w, int revents) |
135 | { |
143 | { |
136 | if (empty ()) |
144 | if (empty ()) |
137 | w.at = TSTAMP_CANCEL; |
145 | w.stop (); |
138 | else |
146 | else |
139 | { |
147 | { |
140 | w.at = NOW + RSA_TTL; |
|
|
141 | |
|
|
142 | for (iterator i = begin (); i != end (); ) |
148 | for (iterator i = begin (); i != end (); ) |
143 | if (i->expire <= NOW) |
149 | if (i->expire <= ev_now ()) |
144 | i = erase (i); |
150 | i = erase (i); |
145 | else |
151 | else |
146 | ++i; |
152 | ++i; |
147 | } |
153 | } |
148 | } |
154 | } |
149 | |
155 | |
150 | ////////////////////////////////////////////////////////////////////////////// |
156 | ////////////////////////////////////////////////////////////////////////////// |
151 | |
157 | |
152 | void pkt_queue::put (net_packet *p) |
158 | pkt_queue::pkt_queue (double max_ttl, int max_queue) |
|
|
159 | : max_ttl (max_ttl), max_queue (max_queue) |
153 | { |
160 | { |
154 | if (queue[i]) |
161 | queue = new pkt [max_queue]; |
155 | { |
|
|
156 | delete queue[i]; |
|
|
157 | j = (j + 1) % QUEUEDEPTH; |
|
|
158 | } |
|
|
159 | |
162 | |
160 | queue[i] = p; |
|
|
161 | |
|
|
162 | i = (i + 1) % QUEUEDEPTH; |
|
|
163 | } |
|
|
164 | |
|
|
165 | net_packet *pkt_queue::get () |
|
|
166 | { |
|
|
167 | net_packet *p = queue[j]; |
|
|
168 | |
|
|
169 | if (p) |
|
|
170 | { |
|
|
171 | queue[j] = 0; |
|
|
172 | j = (j + 1) % QUEUEDEPTH; |
|
|
173 | } |
|
|
174 | |
|
|
175 | return p; |
|
|
176 | } |
|
|
177 | |
|
|
178 | pkt_queue::pkt_queue () |
|
|
179 | { |
|
|
180 | memset (queue, 0, sizeof (queue)); |
|
|
181 | i = 0; |
163 | i = 0; |
182 | j = 0; |
164 | j = 0; |
|
|
165 | |
|
|
166 | expire.set<pkt_queue, &pkt_queue::expire_cb> (this); |
183 | } |
167 | } |
184 | |
168 | |
185 | pkt_queue::~pkt_queue () |
169 | pkt_queue::~pkt_queue () |
186 | { |
170 | { |
187 | for (i = QUEUEDEPTH; --i > 0; ) |
171 | while (net_packet *p = get ()) |
|
|
172 | delete p; |
|
|
173 | |
188 | delete queue[i]; |
174 | delete [] queue; |
189 | } |
175 | } |
190 | |
176 | |
|
|
177 | void pkt_queue::expire_cb (ev::timer &w, int revents) |
|
|
178 | { |
|
|
179 | ev_tstamp expire = ev_now () - max_ttl; |
|
|
180 | |
|
|
181 | for (;;) |
|
|
182 | { |
|
|
183 | if (empty ()) |
|
|
184 | break; |
|
|
185 | |
|
|
186 | double diff = queue[j].tstamp - expire; |
|
|
187 | |
|
|
188 | if (diff >= 0.) |
|
|
189 | { |
|
|
190 | w.start (diff > 0.5 ? diff : 0.5); |
|
|
191 | break; |
|
|
192 | } |
|
|
193 | |
|
|
194 | delete get (); |
|
|
195 | } |
|
|
196 | } |
|
|
197 | |
|
|
198 | void pkt_queue::put (net_packet *p) |
|
|
199 | { |
|
|
200 | ev_tstamp now = ev_now (); |
|
|
201 | |
|
|
202 | // start expiry timer |
|
|
203 | if (empty ()) |
|
|
204 | expire.start (max_ttl); |
|
|
205 | |
|
|
206 | int ni = i + 1 == max_queue ? 0 : i + 1; |
|
|
207 | |
|
|
208 | if (ni == j) |
|
|
209 | delete get (); |
|
|
210 | |
|
|
211 | queue[i].pkt = p; |
|
|
212 | queue[i].tstamp = now; |
|
|
213 | |
|
|
214 | i = ni; |
|
|
215 | } |
|
|
216 | |
|
|
217 | net_packet *pkt_queue::get () |
|
|
218 | { |
|
|
219 | if (empty ()) |
|
|
220 | return 0; |
|
|
221 | |
|
|
222 | net_packet *p = queue[j].pkt; |
|
|
223 | queue[j].pkt = 0; |
|
|
224 | |
|
|
225 | j = j + 1 == max_queue ? 0 : j + 1; |
|
|
226 | |
|
|
227 | return p; |
|
|
228 | } |
|
|
229 | |
191 | struct net_rateinfo { |
230 | struct net_rateinfo |
|
|
231 | { |
192 | u32 host; |
232 | u32 host; |
193 | double pcnt, diff; |
233 | double pcnt, diff; |
194 | tstamp last; |
234 | tstamp last; |
195 | }; |
235 | }; |
196 | |
236 | |
197 | // only do action once every x seconds per host whole allowing bursts. |
237 | // only do action once every x seconds per host whole allowing bursts. |
198 | // this implementation ("splay list" ;) is inefficient, |
238 | // this implementation ("splay list" ;) is inefficient, |
199 | // but low on resources. |
239 | // but low on resources. |
200 | struct net_rate_limiter : list<net_rateinfo> |
240 | struct net_rate_limiter : list<net_rateinfo> |
201 | { |
241 | { |
202 | static const double ALPHA = 1. - 1. / 600.; // allow bursts |
242 | # define NRL_ALPHA (1. - 1. / 600.) // allow bursts |
203 | static const double CUTOFF = 10.; // one event every CUTOFF seconds |
243 | # define NRL_CUTOFF 10. // one event every CUTOFF seconds |
204 | static const double EXPIRE = CUTOFF * 30.; // expire entries after this time |
244 | # define NRL_EXPIRE (NRL_CUTOFF * 30.) // expire entries after this time |
205 | static const double MAXDIF = CUTOFF * (1. / (1. - ALPHA)); // maximum diff /count value |
245 | # define NRL_MAXDIF (NRL_CUTOFF * (1. / (1. - NRL_ALPHA))) // maximum diff /count value |
206 | |
246 | |
207 | bool can (const sockinfo &si) { return can((u32)si.host); } |
247 | bool can (const sockinfo &si) { return can((u32)si.host); } |
208 | bool can (u32 host); |
248 | bool can (u32 host); |
209 | }; |
249 | }; |
210 | |
250 | |
… | |
… | |
215 | iterator i; |
255 | iterator i; |
216 | |
256 | |
217 | for (i = begin (); i != end (); ) |
257 | for (i = begin (); i != end (); ) |
218 | if (i->host == host) |
258 | if (i->host == host) |
219 | break; |
259 | break; |
220 | else if (i->last < NOW - EXPIRE) |
260 | else if (i->last < ev_now () - NRL_EXPIRE) |
221 | i = erase (i); |
261 | i = erase (i); |
222 | else |
262 | else |
223 | i++; |
263 | i++; |
224 | |
264 | |
225 | if (i == end ()) |
265 | if (i == end ()) |
226 | { |
266 | { |
227 | net_rateinfo ri; |
267 | net_rateinfo ri; |
228 | |
268 | |
229 | ri.host = host; |
269 | ri.host = host; |
230 | ri.pcnt = 1.; |
270 | ri.pcnt = 1.; |
231 | ri.diff = MAXDIF; |
271 | ri.diff = NRL_MAXDIF; |
232 | ri.last = NOW; |
272 | ri.last = ev_now (); |
233 | |
273 | |
234 | push_front (ri); |
274 | push_front (ri); |
235 | |
275 | |
236 | return true; |
276 | return true; |
237 | } |
277 | } |
238 | else |
278 | else |
239 | { |
279 | { |
240 | net_rateinfo ri (*i); |
280 | net_rateinfo ri (*i); |
241 | erase (i); |
281 | erase (i); |
242 | |
282 | |
243 | ri.pcnt = ri.pcnt * ALPHA; |
283 | ri.pcnt = ri.pcnt * NRL_ALPHA; |
244 | ri.diff = ri.diff * ALPHA + (NOW - ri.last); |
284 | ri.diff = ri.diff * NRL_ALPHA + (ev_now () - ri.last); |
245 | |
285 | |
246 | ri.last = NOW; |
286 | ri.last = ev_now (); |
247 | |
287 | |
248 | double dif = ri.diff / ri.pcnt; |
288 | double dif = ri.diff / ri.pcnt; |
249 | |
289 | |
250 | bool send = dif > CUTOFF; |
290 | bool send = dif > NRL_CUTOFF; |
251 | |
291 | |
252 | if (dif > MAXDIF) |
292 | if (dif > NRL_MAXDIF) |
253 | { |
293 | { |
254 | ri.pcnt = 1.; |
294 | ri.pcnt = 1.; |
255 | ri.diff = MAXDIF; |
295 | ri.diff = NRL_MAXDIF; |
256 | } |
296 | } |
257 | else if (send) |
297 | else if (send) |
258 | ri.pcnt++; |
298 | ri.pcnt++; |
259 | |
299 | |
260 | push_front (ri); |
300 | push_front (ri); |
… | |
… | |
307 | } |
347 | } |
308 | |
348 | |
309 | #define MAXVPNDATA (MAX_MTU - 6 - 6) |
349 | #define MAXVPNDATA (MAX_MTU - 6 - 6) |
310 | #define DATAHDR (sizeof (u32) + RAND_SIZE) |
350 | #define DATAHDR (sizeof (u32) + RAND_SIZE) |
311 | |
351 | |
312 | struct vpndata_packet:vpn_packet |
352 | struct vpndata_packet : vpn_packet |
313 | { |
353 | { |
314 | u8 data[MAXVPNDATA + DATAHDR]; // seqno |
354 | u8 data[MAXVPNDATA + DATAHDR]; // seqno |
315 | |
355 | |
316 | void setup (connection *conn, int dst, u8 *d, u32 len, u32 seqno); |
356 | void setup (connection *conn, int dst, u8 *d, u32 len, u32 seqno); |
317 | tap_packet *unpack (connection *conn, u32 &seqno); |
357 | tap_packet *unpack (connection *conn, u32 &seqno); |
… | |
… | |
330 | int outl = 0, outl2; |
370 | int outl = 0, outl2; |
331 | ptype type = PT_DATA_UNCOMPRESSED; |
371 | ptype type = PT_DATA_UNCOMPRESSED; |
332 | |
372 | |
333 | #if ENABLE_COMPRESSION |
373 | #if ENABLE_COMPRESSION |
334 | u8 cdata[MAX_MTU]; |
374 | u8 cdata[MAX_MTU]; |
335 | u32 cl; |
|
|
336 | |
375 | |
|
|
376 | if (conn->features & ENABLE_COMPRESSION) |
|
|
377 | { |
337 | cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7); |
378 | u32 cl = lzf_compress (d, l, cdata + 2, (l - 2) & ~7); |
|
|
379 | |
338 | if (cl) |
380 | if (cl) |
339 | { |
381 | { |
340 | type = PT_DATA_COMPRESSED; |
382 | type = PT_DATA_COMPRESSED; |
341 | d = cdata; |
383 | d = cdata; |
342 | l = cl + 2; |
384 | l = cl + 2; |
343 | |
385 | |
344 | d[0] = cl >> 8; |
386 | d[0] = cl >> 8; |
345 | d[1] = cl; |
387 | d[1] = cl; |
|
|
388 | } |
346 | } |
389 | } |
347 | #endif |
390 | #endif |
348 | |
391 | |
349 | EVP_EncryptInit_ex (cctx, 0, 0, 0, 0); |
392 | require (EVP_EncryptInit_ex (cctx, 0, 0, 0, 0)); |
350 | |
393 | |
351 | struct { |
394 | struct { |
352 | #if RAND_SIZE |
395 | #if RAND_SIZE |
353 | u8 rnd[RAND_SIZE]; |
396 | u8 rnd[RAND_SIZE]; |
354 | #endif |
397 | #endif |
… | |
… | |
358 | datahdr.seqno = ntohl (seqno); |
401 | datahdr.seqno = ntohl (seqno); |
359 | #if RAND_SIZE |
402 | #if RAND_SIZE |
360 | RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE); |
403 | RAND_pseudo_bytes ((unsigned char *) datahdr.rnd, RAND_SIZE); |
361 | #endif |
404 | #endif |
362 | |
405 | |
363 | EVP_EncryptUpdate (cctx, |
406 | require (EVP_EncryptUpdate (cctx, |
364 | (unsigned char *) data + outl, &outl2, |
407 | (unsigned char *) data + outl, &outl2, |
365 | (unsigned char *) &datahdr, DATAHDR); |
408 | (unsigned char *) &datahdr, DATAHDR)); |
366 | outl += outl2; |
409 | outl += outl2; |
367 | |
410 | |
368 | EVP_EncryptUpdate (cctx, |
411 | require (EVP_EncryptUpdate (cctx, |
369 | (unsigned char *) data + outl, &outl2, |
412 | (unsigned char *) data + outl, &outl2, |
370 | (unsigned char *) d, l); |
413 | (unsigned char *) d, l)); |
371 | outl += outl2; |
414 | outl += outl2; |
372 | |
415 | |
373 | EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2); |
416 | require (EVP_EncryptFinal_ex (cctx, (unsigned char *) data + outl, &outl2)); |
374 | outl += outl2; |
417 | outl += outl2; |
375 | |
418 | |
376 | len = outl + data_hdr_size (); |
419 | len = outl + data_hdr_size (); |
377 | |
420 | |
378 | set_hdr (type, dst); |
421 | set_hdr (type, dst); |
… | |
… | |
387 | int outl = 0, outl2; |
430 | int outl = 0, outl2; |
388 | tap_packet *p = new tap_packet; |
431 | tap_packet *p = new tap_packet; |
389 | u8 *d; |
432 | u8 *d; |
390 | u32 l = len - data_hdr_size (); |
433 | u32 l = len - data_hdr_size (); |
391 | |
434 | |
392 | EVP_DecryptInit_ex (cctx, 0, 0, 0, 0); |
435 | require (EVP_DecryptInit_ex (cctx, 0, 0, 0, 0)); |
393 | |
436 | |
394 | #if ENABLE_COMPRESSION |
437 | #if ENABLE_COMPRESSION |
395 | u8 cdata[MAX_MTU]; |
438 | u8 cdata[MAX_MTU]; |
396 | |
439 | |
397 | if (type == PT_DATA_COMPRESSED) |
440 | if (type == PT_DATA_COMPRESSED) |
… | |
… | |
399 | else |
442 | else |
400 | #endif |
443 | #endif |
401 | d = &(*p)[6 + 6 - DATAHDR]; |
444 | d = &(*p)[6 + 6 - DATAHDR]; |
402 | |
445 | |
403 | /* this overwrites part of the src mac, but we fix that later */ |
446 | /* this overwrites part of the src mac, but we fix that later */ |
404 | EVP_DecryptUpdate (cctx, |
447 | require (EVP_DecryptUpdate (cctx, |
405 | d, &outl2, |
448 | d, &outl2, |
406 | (unsigned char *)&data, len - data_hdr_size ()); |
449 | (unsigned char *)&data, len - data_hdr_size ())); |
407 | outl += outl2; |
450 | outl += outl2; |
408 | |
451 | |
409 | EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2); |
452 | require (EVP_DecryptFinal_ex (cctx, (unsigned char *)d + outl, &outl2)); |
410 | outl += outl2; |
453 | outl += outl2; |
411 | |
454 | |
412 | seqno = ntohl (*(u32 *)(d + RAND_SIZE)); |
455 | seqno = ntohl (*(u32 *)(d + RAND_SIZE)); |
413 | |
456 | |
414 | id2mac (dst () ? dst() : THISNODE->id, p->dst); |
457 | id2mac (dst () ? dst() : THISNODE->id, p->dst); |
… | |
… | |
443 | { |
486 | { |
444 | // actually, hmaclen cannot be checked because the hmac |
487 | // actually, hmaclen cannot be checked because the hmac |
445 | // field comes before this data, so peers with other |
488 | // field comes before this data, so peers with other |
446 | // hmacs simply will not work. |
489 | // hmacs simply will not work. |
447 | u8 prot_major, prot_minor, randsize, hmaclen; |
490 | u8 prot_major, prot_minor, randsize, hmaclen; |
448 | u8 flags, challengelen, pad2, pad3; |
491 | u8 flags, challengelen, features, pad3; |
449 | u32 cipher_nid, digest_nid, hmac_nid; |
492 | u32 cipher_nid, digest_nid, hmac_nid; |
450 | |
|
|
451 | const u8 curflags () const |
|
|
452 | { |
|
|
453 | return 0x80 |
|
|
454 | | (ENABLE_COMPRESSION ? 0x01 : 0x00); |
|
|
455 | } |
|
|
456 | |
493 | |
457 | void setup (ptype type, int dst); |
494 | void setup (ptype type, int dst); |
458 | bool chk_config () const; |
495 | bool chk_config () const; |
|
|
496 | |
|
|
497 | static u8 get_features () |
|
|
498 | { |
|
|
499 | u8 f = 0; |
|
|
500 | #if ENABLE_COMPRESSION |
|
|
501 | f |= FEATURE_COMPRESSION; |
|
|
502 | #endif |
|
|
503 | #if ENABLE_ROHC |
|
|
504 | f |= FEATURE_ROHC; |
|
|
505 | #endif |
|
|
506 | #if ENABLE_BRIDGING |
|
|
507 | f |= FEATURE_BRIDGING; |
|
|
508 | #endif |
|
|
509 | return f; |
|
|
510 | } |
459 | }; |
511 | }; |
460 | |
512 | |
461 | void config_packet::setup (ptype type, int dst) |
513 | void config_packet::setup (ptype type, int dst) |
462 | { |
514 | { |
463 | prot_major = PROTOCOL_MAJOR; |
515 | prot_major = PROTOCOL_MAJOR; |
464 | prot_minor = PROTOCOL_MINOR; |
516 | prot_minor = PROTOCOL_MINOR; |
465 | randsize = RAND_SIZE; |
517 | randsize = RAND_SIZE; |
466 | hmaclen = HMACLENGTH; |
518 | hmaclen = HMACLENGTH; |
467 | flags = curflags (); |
519 | flags = 0; |
468 | challengelen = sizeof (rsachallenge); |
520 | challengelen = sizeof (rsachallenge); |
|
|
521 | features = get_features (); |
469 | |
522 | |
470 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
523 | cipher_nid = htonl (EVP_CIPHER_nid (CIPHER)); |
471 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
524 | digest_nid = htonl (EVP_MD_type (RSA_HASH)); |
472 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
525 | hmac_nid = htonl (EVP_MD_type (DIGEST)); |
473 | |
526 | |
… | |
… | |
476 | } |
529 | } |
477 | |
530 | |
478 | bool config_packet::chk_config () const |
531 | bool config_packet::chk_config () const |
479 | { |
532 | { |
480 | if (prot_major != PROTOCOL_MAJOR) |
533 | if (prot_major != PROTOCOL_MAJOR) |
481 | slog (L_WARN, _("major version mismatch (%d <=> %d)"), prot_major, PROTOCOL_MAJOR); |
534 | slog (L_WARN, _("major version mismatch (remote %d <=> local %d)"), prot_major, PROTOCOL_MAJOR); |
482 | else if (randsize != RAND_SIZE) |
535 | else if (randsize != RAND_SIZE) |
483 | slog (L_WARN, _("rand size mismatch (%d <=> %d)"), randsize, RAND_SIZE); |
536 | slog (L_WARN, _("rand size mismatch (remote %d <=> local %d)"), randsize, RAND_SIZE); |
484 | else if (hmaclen != HMACLENGTH) |
537 | else if (hmaclen != HMACLENGTH) |
485 | slog (L_WARN, _("hmac length mismatch (%d <=> %d)"), hmaclen, HMACLENGTH); |
538 | slog (L_WARN, _("hmac length mismatch (remote %d <=> local %d)"), hmaclen, HMACLENGTH); |
486 | else if (flags != curflags ()) |
|
|
487 | slog (L_WARN, _("flag mismatch (%x <=> %x)"), flags, curflags ()); |
|
|
488 | else if (challengelen != sizeof (rsachallenge)) |
539 | else if (challengelen != sizeof (rsachallenge)) |
489 | slog (L_WARN, _("challenge length mismatch (%d <=> %d)"), challengelen, sizeof (rsachallenge)); |
540 | slog (L_WARN, _("challenge length mismatch (remote %d <=> local %d)"), challengelen, sizeof (rsachallenge)); |
490 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
541 | else if (cipher_nid != htonl (EVP_CIPHER_nid (CIPHER))) |
491 | slog (L_WARN, _("cipher mismatch (%x <=> %x)"), ntohl (cipher_nid), EVP_CIPHER_nid (CIPHER)); |
542 | 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))) |
543 | 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)); |
544 | 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))) |
545 | else if (hmac_nid != htonl (EVP_MD_type (DIGEST))) |
495 | slog (L_WARN, _("hmac mismatch (%x <=> %x)"), ntohl (hmac_nid), EVP_MD_type (DIGEST)); |
546 | slog (L_WARN, _("hmac mismatch (remote %x <=> local %x)"), ntohl (hmac_nid), EVP_MD_type (DIGEST)); |
496 | else |
547 | else |
497 | return true; |
548 | return true; |
498 | |
549 | |
499 | return false; |
550 | return false; |
500 | } |
551 | } |
501 | |
552 | |
502 | struct auth_req_packet : config_packet |
553 | struct auth_req_packet : config_packet |
503 | { |
554 | { |
504 | char magic[8]; |
555 | char magic[8]; |
505 | u8 initiate; // false if this is just an automatic reply |
556 | u8 initiate; // false if this is just an automatic reply |
506 | u8 protocols; // supported protocols (will get patches on forward) |
557 | u8 protocols; // supported protocols (will be patched on forward) |
507 | u8 pad2, pad3; |
558 | u8 pad2, pad3; |
508 | rsaid id; |
559 | rsaid id; |
509 | rsaencrdata encr; |
560 | rsaencrdata encr; |
510 | |
561 | |
511 | auth_req_packet (int dst, bool initiate_, u8 protocols_) |
562 | auth_req_packet (int dst, bool initiate_, u8 protocols_) |
… | |
… | |
568 | ///////////////////////////////////////////////////////////////////////////// |
619 | ///////////////////////////////////////////////////////////////////////////// |
569 | |
620 | |
570 | void |
621 | void |
571 | connection::connection_established () |
622 | connection::connection_established () |
572 | { |
623 | { |
|
|
624 | slog (L_TRACE, _("%s: possible connection establish (ictx %d, octx %d)"), conf->nodename, !!ictx, !!octx); |
|
|
625 | |
573 | if (ictx && octx) |
626 | if (ictx && octx) |
574 | { |
627 | { |
575 | connectmode = conf->connectmode; |
628 | // make sure rekeying timeouts are slightly asymmetric |
576 | |
629 | ev::tstamp rekey_interval = ::conf.rekey + (conf->id > THISNODE->id ? 10 : 0); |
577 | rekey.start (NOW + ::conf.rekey); |
630 | rekey.start (rekey_interval, rekey_interval); |
578 | keepalive.start (NOW + ::conf.keepalive); |
631 | keepalive.start (::conf.keepalive); |
579 | |
632 | |
580 | // send queued packets |
633 | // send queued packets |
581 | if (ictx && octx) |
634 | if (ictx && octx) |
582 | { |
635 | { |
583 | while (tap_packet *p = (tap_packet *)data_queue.get ()) |
636 | while (tap_packet *p = (tap_packet *)data_queue.get ()) |
584 | { |
637 | { |
585 | send_data_packet (p); |
638 | if (p->len) send_data_packet (p); |
586 | delete p; |
639 | delete p; |
587 | } |
640 | } |
588 | |
641 | |
589 | while (vpn_packet *p = (vpn_packet *)vpn_queue.get ()) |
642 | while (vpn_packet *p = (vpn_packet *)vpn_queue.get ()) |
590 | { |
643 | { |
591 | send_vpn_packet (p, si, IPTOS_RELIABILITY); |
644 | if (p->len) send_vpn_packet (p, si, IPTOS_RELIABILITY); |
592 | delete p; |
645 | delete p; |
593 | } |
646 | } |
594 | } |
647 | } |
595 | } |
648 | } |
596 | else |
649 | else |
597 | { |
650 | { |
598 | retry_cnt = 0; |
651 | retry_cnt = 0; |
599 | establish_connection.start (NOW + 5); |
652 | establish_connection.start (5); |
600 | keepalive.reset (); |
653 | keepalive.stop (); |
601 | rekey.reset (); |
654 | rekey.stop (); |
602 | } |
655 | } |
603 | } |
656 | } |
604 | |
657 | |
605 | void |
658 | void |
606 | connection::reset_si () |
659 | connection::reset_si () |
… | |
… | |
608 | protocol = best_protocol (THISNODE->protocols & conf->protocols); |
661 | protocol = best_protocol (THISNODE->protocols & conf->protocols); |
609 | |
662 | |
610 | // mask out protocols we cannot establish |
663 | // mask out protocols we cannot establish |
611 | if (!conf->udp_port) protocol &= ~PROT_UDPv4; |
664 | if (!conf->udp_port) protocol &= ~PROT_UDPv4; |
612 | if (!conf->tcp_port) protocol &= ~PROT_TCPv4; |
665 | if (!conf->tcp_port) protocol &= ~PROT_TCPv4; |
|
|
666 | if (!conf->dns_port) protocol &= ~PROT_DNSv4; |
|
|
667 | |
|
|
668 | if (protocol |
|
|
669 | && (!conf->can_direct (THISNODE) |
|
|
670 | || !THISNODE->can_direct (conf))) |
|
|
671 | { |
|
|
672 | slog (L_DEBUG, _("%s: direct connection denied"), conf->nodename); |
|
|
673 | protocol = 0; |
|
|
674 | } |
613 | |
675 | |
614 | si.set (conf, protocol); |
676 | si.set (conf, protocol); |
615 | } |
677 | } |
616 | |
678 | |
617 | // ensure sockinfo is valid, forward if necessary |
679 | // ensure sockinfo is valid, forward if necessary |
… | |
… | |
622 | { |
684 | { |
623 | connection *r = vpn->find_router (); |
685 | connection *r = vpn->find_router (); |
624 | |
686 | |
625 | if (r) |
687 | if (r) |
626 | { |
688 | { |
627 | slog (L_DEBUG, _("%s: no common protocol, trying indirectly through %s"), |
689 | slog (L_DEBUG, _("%s: no common protocol, trying indirectly through %s (%s)"), |
628 | conf->nodename, r->conf->nodename); |
690 | conf->nodename, r->conf->nodename, (const char *)r->si); |
629 | return r->si; |
691 | return r->si; |
630 | } |
692 | } |
631 | else |
693 | else |
632 | slog (L_DEBUG, _("%s: node unreachable, no common protocol"), |
694 | slog (L_DEBUG, _("%s: node unreachable, no common protocol"), |
633 | conf->nodename); |
695 | conf->nodename); |
… | |
… | |
672 | connection::send_auth_request (const sockinfo &si, bool initiate) |
734 | connection::send_auth_request (const sockinfo &si, bool initiate) |
673 | { |
735 | { |
674 | auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols); |
736 | auth_req_packet *pkt = new auth_req_packet (conf->id, initiate, THISNODE->protocols); |
675 | |
737 | |
676 | rsachallenge chg; |
738 | rsachallenge chg; |
677 | |
|
|
678 | rsa_cache.gen (pkt->id, chg); |
739 | rsa_cache.gen (pkt->id, chg); |
679 | |
740 | 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 | |
741 | |
685 | slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si); |
742 | slog (L_TRACE, ">>%d PT_AUTH_REQ [%s]", conf->id, (const char *)si); |
686 | |
743 | |
687 | send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly |
744 | send_vpn_packet (pkt, si, IPTOS_RELIABILITY | IPTOS_LOWDELAY); // rsa is very very costly |
688 | |
745 | |
… | |
… | |
708 | } |
765 | } |
709 | |
766 | |
710 | void |
767 | void |
711 | connection::send_connect_info (int rid, const sockinfo &rsi, u8 rprotocols) |
768 | connection::send_connect_info (int rid, const sockinfo &rsi, u8 rprotocols) |
712 | { |
769 | { |
713 | slog (L_TRACE, ">>%d PT_CONNECT_INFO(%d,%s)\n", |
770 | slog (L_TRACE, ">>%d PT_CONNECT_INFO(%d,%s)", |
714 | conf->id, rid, (const char *)rsi); |
771 | conf->id, rid, (const char *)rsi); |
715 | |
772 | |
716 | connect_info_packet *r = new connect_info_packet (conf->id, rid, rsi, rprotocols); |
773 | connect_info_packet *r = new connect_info_packet (conf->id, rid, rsi, rprotocols); |
717 | |
774 | |
718 | r->hmac_set (octx); |
775 | r->hmac_set (octx); |
719 | send_vpn_packet (r, si); |
776 | send_vpn_packet (r, si); |
720 | |
777 | |
721 | delete r; |
778 | delete r; |
722 | } |
779 | } |
723 | |
780 | |
724 | void |
781 | inline void |
725 | connection::establish_connection_cb (time_watcher &w) |
782 | connection::establish_connection_cb (ev::timer &w, int revents) |
726 | { |
783 | { |
727 | if (ictx || conf == THISNODE |
784 | if (!ictx |
|
|
785 | && conf != THISNODE |
728 | || connectmode == conf_node::C_NEVER |
786 | && connectmode != conf_node::C_NEVER |
729 | || connectmode == conf_node::C_DISABLED) |
787 | && connectmode != conf_node::C_DISABLED |
730 | w.at = TSTAMP_CANCEL; |
788 | && !w.is_active ()) |
731 | else if (w.at <= NOW) |
|
|
732 | { |
789 | { |
733 | double retry_int = double (retry_cnt & 3 ? (retry_cnt & 3) : 1 << (retry_cnt >> 2)) * 0.6; |
790 | // a bit hacky, if ondemand, and packets are no longer queued, then reset the connection |
734 | |
791 | // and stop trying. should probably be handled by a per-connection expire handler. |
735 | if (retry_int < 3600 * 8) |
792 | if (connectmode == conf_node::C_ONDEMAND && vpn_queue.empty () && data_queue.empty ()) |
|
|
793 | { |
|
|
794 | reset_connection (); |
736 | retry_cnt++; |
795 | return; |
|
|
796 | } |
737 | |
797 | |
738 | w.at = NOW + retry_int; |
798 | ev::tstamp retry_int = ev::tstamp (retry_cnt & 3 |
|
|
799 | ? (retry_cnt & 3) + 1 |
|
|
800 | : 1 << (retry_cnt >> 2)); |
739 | |
801 | |
740 | reset_si (); |
802 | reset_si (); |
741 | |
803 | |
|
|
804 | bool slow = si.prot & PROT_SLOW; |
|
|
805 | |
742 | if (si.prot && !si.host) |
806 | if (si.prot && !si.host) |
|
|
807 | { |
|
|
808 | slog (L_TRACE, _("%s: connection request (indirect)"), conf->nodename); |
|
|
809 | /*TODO*/ /* start the timer so we don't recurse endlessly */ |
|
|
810 | w.start (1); |
743 | vpn->send_connect_request (conf->id); |
811 | vpn->send_connect_request (conf->id); |
|
|
812 | } |
744 | else |
813 | else |
745 | { |
814 | { |
|
|
815 | slog (L_TRACE, _("%s: connection request (direct)"), conf->nodename, !!ictx, !!octx); |
|
|
816 | |
746 | const sockinfo &dsi = forward_si (si); |
817 | const sockinfo &dsi = forward_si (si); |
|
|
818 | |
|
|
819 | slow = slow || (dsi.prot & PROT_SLOW); |
747 | |
820 | |
748 | if (dsi.valid () && auth_rate_limiter.can (dsi)) |
821 | if (dsi.valid () && auth_rate_limiter.can (dsi)) |
749 | { |
822 | { |
750 | if (retry_cnt < 4) |
823 | if (retry_cnt < 4) |
751 | send_auth_request (dsi, true); |
824 | send_auth_request (dsi, true); |
752 | else |
825 | else |
753 | send_ping (dsi, 0); |
826 | send_ping (dsi, 0); |
754 | } |
827 | } |
755 | } |
828 | } |
|
|
829 | |
|
|
830 | retry_int *= slow ? 8. : 0.7; |
|
|
831 | |
|
|
832 | if (retry_int < conf->max_retry) |
|
|
833 | retry_cnt++; |
|
|
834 | else |
|
|
835 | retry_int = conf->max_retry; |
|
|
836 | |
|
|
837 | w.start (retry_int); |
756 | } |
838 | } |
757 | } |
839 | } |
758 | |
840 | |
759 | void |
841 | void |
760 | connection::reset_connection () |
842 | connection::reset_connection () |
… | |
… | |
763 | { |
845 | { |
764 | slog (L_INFO, _("%s(%s): connection lost"), |
846 | slog (L_INFO, _("%s(%s): connection lost"), |
765 | conf->nodename, (const char *)si); |
847 | conf->nodename, (const char *)si); |
766 | |
848 | |
767 | if (::conf.script_node_down) |
849 | if (::conf.script_node_down) |
768 | run_script (run_script_cb (this, &connection::script_node_down), false); |
850 | { |
|
|
851 | run_script_cb cb; |
|
|
852 | cb.set<connection, &connection::script_node_down> (this); |
|
|
853 | if (!run_script (cb, false)) |
|
|
854 | slog (L_WARN, _("node-down command execution failed, continuing.")); |
|
|
855 | } |
769 | } |
856 | } |
770 | |
857 | |
771 | delete ictx; ictx = 0; |
858 | delete ictx; ictx = 0; |
772 | delete octx; octx = 0; |
859 | delete octx; octx = 0; |
|
|
860 | #if ENABLE_DNS |
|
|
861 | dnsv4_reset_connection (); |
|
|
862 | #endif |
773 | |
863 | |
774 | si.host= 0; |
864 | si.host = 0; |
775 | |
865 | |
776 | last_activity = 0; |
866 | last_activity = 0; |
777 | retry_cnt = 0; |
867 | retry_cnt = 0; |
778 | |
868 | |
779 | rekey.reset (); |
869 | rekey.stop (); |
780 | keepalive.reset (); |
870 | keepalive.stop (); |
781 | establish_connection.reset (); |
871 | establish_connection.stop (); |
782 | } |
872 | } |
783 | |
873 | |
784 | void |
874 | void |
785 | connection::shutdown () |
875 | connection::shutdown () |
786 | { |
876 | { |
… | |
… | |
788 | send_reset (si); |
878 | send_reset (si); |
789 | |
879 | |
790 | reset_connection (); |
880 | reset_connection (); |
791 | } |
881 | } |
792 | |
882 | |
793 | void |
883 | inline void |
794 | connection::rekey_cb (time_watcher &w) |
884 | connection::rekey_cb (ev::timer &w, int revents) |
795 | { |
885 | { |
796 | w.at = TSTAMP_CANCEL; |
|
|
797 | |
|
|
798 | reset_connection (); |
886 | reset_connection (); |
799 | establish_connection (); |
887 | establish_connection (); |
800 | } |
888 | } |
801 | |
889 | |
802 | void |
890 | void |
803 | connection::send_data_packet (tap_packet *pkt, bool broadcast) |
891 | connection::send_data_packet (tap_packet *pkt) |
804 | { |
892 | { |
805 | vpndata_packet *p = new vpndata_packet; |
893 | vpndata_packet *p = new vpndata_packet; |
806 | int tos = 0; |
894 | int tos = 0; |
807 | |
895 | |
808 | // I am not hilarious about peeking into packets, but so be it. |
896 | // I am not hilarious about peeking into packets, but so be it. |
809 | if (conf->inherit_tos |
897 | 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; |
898 | tos = (*pkt)[15] & IPTOS_TOS_MASK; |
813 | |
899 | |
814 | p->setup (this, broadcast ? 0 : conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs |
900 | p->setup (this, conf->id, &((*pkt)[6 + 6]), pkt->len - 6 - 6, ++oseqno); // skip 2 macs |
815 | send_vpn_packet (p, si, tos); |
901 | send_vpn_packet (p, si, tos); |
816 | |
902 | |
817 | delete p; |
903 | delete p; |
818 | |
904 | |
819 | if (oseqno > MAX_SEQNO) |
905 | if (oseqno > MAX_SEQNO) |
820 | rekey (); |
906 | rekey (); |
821 | } |
907 | } |
822 | |
908 | |
823 | void |
909 | void |
824 | connection::inject_data_packet (tap_packet *pkt, bool broadcast) |
910 | connection::inject_data_packet (tap_packet *pkt, bool broadcast/*TODO DDD*/) |
825 | { |
911 | { |
826 | if (ictx && octx) |
912 | if (ictx && octx) |
827 | send_data_packet (pkt, broadcast); |
913 | send_data_packet (pkt); |
828 | else |
914 | else |
829 | { |
915 | { |
830 | if (!broadcast)//DDDD |
916 | if (!broadcast) |
831 | data_queue.put (new tap_packet (*pkt)); |
917 | data_queue.put (new tap_packet (*pkt)); |
832 | |
918 | |
833 | establish_connection (); |
919 | establish_connection (); |
834 | } |
920 | } |
835 | } |
921 | } |
… | |
… | |
838 | { |
924 | { |
839 | if (ictx && octx) |
925 | if (ictx && octx) |
840 | send_vpn_packet (pkt, si, tos); |
926 | send_vpn_packet (pkt, si, tos); |
841 | else |
927 | else |
842 | { |
928 | { |
843 | vpn_queue.put (new vpn_packet (*pkt)); |
929 | vpn_queue.put ((vpn_packet *)new data_packet (*(data_packet *)pkt)); |
844 | |
930 | |
845 | establish_connection (); |
931 | establish_connection (); |
846 | } |
932 | } |
847 | } |
933 | } |
848 | |
934 | |
849 | void |
935 | void |
850 | connection::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi) |
936 | connection::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi) |
851 | { |
937 | { |
852 | last_activity = NOW; |
938 | last_activity = ev_now (); |
853 | |
939 | |
854 | slog (L_NOISE, "<<%d received packet type %d from %d to %d", |
940 | slog (L_NOISE, "<<%d received packet type %d from %d to %d", |
855 | conf->id, pkt->typ (), pkt->src (), pkt->dst ()); |
941 | conf->id, pkt->typ (), pkt->src (), pkt->dst ()); |
|
|
942 | |
|
|
943 | if (connectmode == conf_node::C_DISABLED) |
|
|
944 | return; |
856 | |
945 | |
857 | switch (pkt->typ ()) |
946 | switch (pkt->typ ()) |
858 | { |
947 | { |
859 | case vpn_packet::PT_PING: |
948 | case vpn_packet::PT_PING: |
860 | // we send pings instead of auth packets after some retries, |
949 | // we send pings instead of auth packets after some retries, |
… | |
… | |
907 | if (p->initiate) |
996 | if (p->initiate) |
908 | send_auth_request (rsi, false); |
997 | send_auth_request (rsi, false); |
909 | |
998 | |
910 | rsachallenge k; |
999 | rsachallenge k; |
911 | |
1000 | |
912 | if (0 > RSA_private_decrypt (sizeof (p->encr), |
1001 | if (!rsa_decrypt (::conf.rsa_key, p->encr, k)) |
913 | (unsigned char *)&p->encr, (unsigned char *)&k, |
1002 | { |
914 | ::conf.rsa_key, RSA_PKCS1_OAEP_PADDING)) |
|
|
915 | slog (L_ERR, _("%s(%s): challenge illegal or corrupted"), |
1003 | slog (L_ERR, _("%s(%s): challenge illegal or corrupted (%s). mismatched key or config file?"), |
916 | conf->nodename, (const char *)rsi); |
1004 | conf->nodename, (const char *)rsi, ERR_error_string (ERR_get_error (), 0)); |
|
|
1005 | break; |
|
|
1006 | } |
917 | else |
1007 | else |
918 | { |
1008 | { |
919 | delete octx; |
1009 | delete octx; |
920 | |
1010 | |
921 | octx = new crypto_ctx (k, 1); |
1011 | octx = new crypto_ctx (k, 1); |
922 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
1012 | oseqno = ntohl (*(u32 *)&k[CHG_SEQNO]) & 0x7fffffff; |
923 | |
1013 | |
924 | conf->protocols = p->protocols; |
1014 | conf->protocols = p->protocols; |
|
|
1015 | features = p->features & config_packet::get_features (); |
925 | |
1016 | |
926 | send_auth_response (rsi, p->id, k); |
1017 | send_auth_response (rsi, p->id, k); |
927 | |
1018 | |
928 | connection_established (); |
1019 | connection_established (); |
929 | |
1020 | |
… | |
… | |
954 | |
1045 | |
955 | rsachallenge chg; |
1046 | rsachallenge chg; |
956 | |
1047 | |
957 | if (!rsa_cache.find (p->id, chg)) |
1048 | if (!rsa_cache.find (p->id, chg)) |
958 | { |
1049 | { |
959 | slog (L_ERR, _("%s(%s): unrequested auth response"), |
1050 | slog (L_ERR, _("%s(%s): unrequested auth response ignored"), |
960 | conf->nodename, (const char *)rsi); |
1051 | conf->nodename, (const char *)rsi); |
961 | break; |
1052 | break; |
962 | } |
1053 | } |
963 | else |
1054 | else |
964 | { |
1055 | { |
965 | crypto_ctx *cctx = new crypto_ctx (chg, 0); |
1056 | crypto_ctx *cctx = new crypto_ctx (chg, 0); |
966 | |
1057 | |
967 | if (!p->hmac_chk (cctx)) |
1058 | if (!p->hmac_chk (cctx)) |
|
|
1059 | { |
968 | slog (L_ERR, _("%s(%s): hmac authentication error on auth response, received invalid packet\n" |
1060 | 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"), |
1061 | "could be an attack, or just corruption or a synchronization error"), |
970 | conf->nodename, (const char *)rsi); |
1062 | conf->nodename, (const char *)rsi); |
|
|
1063 | break; |
|
|
1064 | } |
971 | else |
1065 | else |
972 | { |
1066 | { |
973 | rsaresponse h; |
1067 | rsaresponse h; |
974 | |
1068 | |
975 | rsa_hash (p->id, chg, h); |
1069 | rsa_hash (p->id, chg, h); |
… | |
… | |
990 | slog (L_INFO, _("%s(%s): connection established, protocol version %d.%d"), |
1084 | slog (L_INFO, _("%s(%s): connection established, protocol version %d.%d"), |
991 | conf->nodename, (const char *)rsi, |
1085 | conf->nodename, (const char *)rsi, |
992 | p->prot_major, p->prot_minor); |
1086 | p->prot_major, p->prot_minor); |
993 | |
1087 | |
994 | if (::conf.script_node_up) |
1088 | if (::conf.script_node_up) |
995 | run_script (run_script_cb (this, &connection::script_node_up), false); |
1089 | { |
|
|
1090 | run_script_cb cb; |
|
|
1091 | cb.set<connection, &connection::script_node_up> (this); |
|
|
1092 | if (!run_script (cb, false)) |
|
|
1093 | slog (L_WARN, _("node-up command execution failed, continuing.")); |
|
|
1094 | } |
996 | |
1095 | |
997 | break; |
1096 | break; |
998 | } |
1097 | } |
999 | else |
1098 | else |
1000 | slog (L_ERR, _("%s(%s): sent and received challenge do not match"), |
1099 | slog (L_ERR, _("%s(%s): sent and received challenge do not match"), |
… | |
… | |
1021 | { |
1120 | { |
1022 | vpndata_packet *p = (vpndata_packet *)pkt; |
1121 | vpndata_packet *p = (vpndata_packet *)pkt; |
1023 | |
1122 | |
1024 | if (!p->hmac_chk (ictx)) |
1123 | if (!p->hmac_chk (ictx)) |
1025 | slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n" |
1124 | slog (L_ERR, _("%s(%s): hmac authentication error, received invalid packet\n" |
1026 | "could be an attack, or just corruption or an synchronization error"), |
1125 | "could be an attack, or just corruption or a synchronization error"), |
1027 | conf->nodename, (const char *)rsi); |
1126 | conf->nodename, (const char *)rsi); |
1028 | else |
1127 | else |
1029 | { |
1128 | { |
1030 | u32 seqno; |
1129 | u32 seqno; |
1031 | tap_packet *d = p->unpack (this, seqno); |
1130 | tap_packet *d = p->unpack (this, seqno); |
1032 | |
1131 | |
1033 | if (iseqno.recv_ok (seqno)) |
1132 | if (iseqno.recv_ok (seqno)) |
1034 | { |
1133 | { |
1035 | vpn->tap->send (d); |
1134 | vpn->tap->send (d); |
1036 | |
1135 | |
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 | |
|
|
1046 | if (si != rsi) |
1136 | if (si != rsi) |
1047 | { |
1137 | { |
1048 | // fast re-sync on connection changes, useful especially for tcp/ip |
1138 | // fast re-sync on source address changes, useful especially for tcp/ip |
1049 | si = rsi; |
1139 | si = rsi; |
1050 | |
1140 | |
1051 | slog (L_INFO, _("%s(%s): socket address changed to %s"), |
1141 | slog (L_INFO, _("%s(%s): socket address changed to %s"), |
1052 | conf->nodename, (const char *)si, (const char *)rsi); |
1142 | conf->nodename, (const char *)si, (const char *)rsi); |
1053 | } |
1143 | } |
1054 | |
|
|
1055 | delete d; |
|
|
1056 | |
|
|
1057 | break; |
|
|
1058 | } |
1144 | } |
|
|
1145 | |
|
|
1146 | delete d; |
|
|
1147 | break; |
1059 | } |
1148 | } |
1060 | } |
1149 | } |
1061 | |
1150 | |
1062 | send_reset (rsi); |
1151 | send_reset (rsi); |
1063 | break; |
1152 | break; |
… | |
… | |
1065 | case vpn_packet::PT_CONNECT_REQ: |
1154 | case vpn_packet::PT_CONNECT_REQ: |
1066 | if (ictx && octx && rsi == si && pkt->hmac_chk (ictx)) |
1155 | if (ictx && octx && rsi == si && pkt->hmac_chk (ictx)) |
1067 | { |
1156 | { |
1068 | connect_req_packet *p = (connect_req_packet *) pkt; |
1157 | connect_req_packet *p = (connect_req_packet *) pkt; |
1069 | |
1158 | |
1070 | assert (p->id > 0 && p->id <= vpn->conns.size ()); // hmac-auth does not mean we accept anything |
1159 | if (p->id > 0 && p->id <= vpn->conns.size ()) |
1071 | connection *c = vpn->conns[p->id - 1]; |
|
|
1072 | conf->protocols = p->protocols; |
|
|
1073 | |
|
|
1074 | slog (L_TRACE, "<<%d PT_CONNECT_REQ(%d) [%d]\n", |
|
|
1075 | conf->id, p->id, c->ictx && c->octx); |
|
|
1076 | |
|
|
1077 | if (c->ictx && c->octx) |
|
|
1078 | { |
1160 | { |
|
|
1161 | connection *c = vpn->conns[p->id - 1]; |
|
|
1162 | conf->protocols = p->protocols; |
|
|
1163 | |
|
|
1164 | slog (L_TRACE, "<<%d PT_CONNECT_REQ(%d) [%d]", |
|
|
1165 | conf->id, p->id, c->ictx && c->octx); |
|
|
1166 | |
|
|
1167 | if (c->ictx && c->octx) |
|
|
1168 | { |
1079 | // send connect_info packets to both sides, in case one is |
1169 | // send connect_info packets to both sides, in case one is |
1080 | // behind a nat firewall (or both ;) |
1170 | // behind a nat firewall (or both ;) |
1081 | c->send_connect_info (conf->id, si, conf->protocols); |
1171 | c->send_connect_info (conf->id, si, conf->protocols); |
1082 | send_connect_info (c->conf->id, c->si, c->conf->protocols); |
1172 | send_connect_info (c->conf->id, c->si, c->conf->protocols); |
|
|
1173 | } |
|
|
1174 | else |
|
|
1175 | c->establish_connection (); |
1083 | } |
1176 | } |
1084 | else |
1177 | else |
1085 | c->establish_connection (); |
1178 | slog (L_WARN, |
|
|
1179 | _("received authenticated connection request from unknown node #%d, config file mismatch?"), |
|
|
1180 | p->id); |
1086 | } |
1181 | } |
1087 | |
1182 | |
1088 | break; |
1183 | break; |
1089 | |
1184 | |
1090 | case vpn_packet::PT_CONNECT_INFO: |
1185 | case vpn_packet::PT_CONNECT_INFO: |
1091 | if (ictx && octx && rsi == si && pkt->hmac_chk (ictx)) |
1186 | if (ictx && octx && rsi == si && pkt->hmac_chk (ictx)) |
1092 | { |
1187 | { |
1093 | connect_info_packet *p = (connect_info_packet *) pkt; |
1188 | connect_info_packet *p = (connect_info_packet *)pkt; |
1094 | |
1189 | |
1095 | assert (p->id > 0 && p->id <= vpn->conns.size ()); // hmac-auth does not mean we accept anything |
1190 | if (p->id > 0 && p->id <= vpn->conns.size ()) |
1096 | |
1191 | { |
1097 | connection *c = vpn->conns[p->id - 1]; |
1192 | connection *c = vpn->conns[p->id - 1]; |
1098 | |
1193 | |
1099 | c->conf->protocols = p->protocols; |
1194 | c->conf->protocols = p->protocols; |
1100 | protocol = best_protocol (c->conf->protocols & THISNODE->protocols & p->si.supported_protocols (c->conf)); |
1195 | protocol = best_protocol (c->conf->protocols & THISNODE->protocols & p->si.supported_protocols (c->conf)); |
1101 | p->si.upgrade_protocol (protocol, c->conf); |
1196 | p->si.upgrade_protocol (protocol, c->conf); |
1102 | |
1197 | |
1103 | slog (L_TRACE, "<<%d PT_CONNECT_INFO(%d,%s) (%d)", |
1198 | slog (L_TRACE, "<<%d PT_CONNECT_INFO(%d,%s) (%d)", |
1104 | conf->id, p->id, (const char *)p->si, !c->ictx && !c->octx); |
1199 | conf->id, p->id, (const char *)p->si, !c->ictx && !c->octx); |
1105 | |
1200 | |
1106 | const sockinfo &dsi = forward_si (p->si); |
1201 | const sockinfo &dsi = forward_si (p->si); |
1107 | |
1202 | |
1108 | if (dsi.valid ()) |
1203 | if (dsi.valid ()) |
1109 | c->send_auth_request (dsi, true); |
1204 | c->send_auth_request (dsi, true); |
|
|
1205 | } |
|
|
1206 | else |
|
|
1207 | slog (L_WARN, |
|
|
1208 | _("received authenticated connection request from unknown node #%d, config file mismatch?"), |
|
|
1209 | p->id); |
1110 | } |
1210 | } |
1111 | |
1211 | |
1112 | break; |
1212 | break; |
1113 | |
1213 | |
1114 | default: |
1214 | default: |
1115 | send_reset (rsi); |
1215 | send_reset (rsi); |
1116 | break; |
1216 | break; |
1117 | } |
1217 | } |
1118 | } |
1218 | } |
1119 | |
1219 | |
1120 | void connection::keepalive_cb (time_watcher &w) |
1220 | inline void |
|
|
1221 | connection::keepalive_cb (ev::timer &w, int revents) |
1121 | { |
1222 | { |
1122 | if (NOW >= last_activity + ::conf.keepalive + 30) |
1223 | if (ev_now () >= last_activity + ::conf.keepalive + 30) |
1123 | { |
1224 | { |
1124 | reset_connection (); |
1225 | reset_connection (); |
1125 | establish_connection (); |
1226 | establish_connection (); |
1126 | } |
1227 | } |
1127 | else if (NOW < last_activity + ::conf.keepalive) |
1228 | else if (ev_now () < last_activity + ::conf.keepalive) |
1128 | w.at = last_activity + ::conf.keepalive; |
1229 | w.start (last_activity + ::conf.keepalive - ev::now ()); |
1129 | else if (conf->connectmode != conf_node::C_ONDEMAND |
1230 | else if (conf->connectmode != conf_node::C_ONDEMAND |
1130 | || THISNODE->connectmode != conf_node::C_ONDEMAND) |
1231 | || THISNODE->connectmode != conf_node::C_ONDEMAND) |
1131 | { |
1232 | { |
1132 | send_ping (si); |
1233 | send_ping (si); |
1133 | w.at = NOW + 5; |
1234 | w.start (5); |
1134 | } |
1235 | } |
1135 | else if (NOW < last_activity + ::conf.keepalive + 10) |
1236 | else if (ev_now () < last_activity + ::conf.keepalive + 10) |
1136 | // hold ondemand connections implicitly a few seconds longer |
1237 | // hold ondemand connections implicitly a few seconds longer |
1137 | // should delete octx, though, or something like that ;) |
1238 | // should delete octx, though, or something like that ;) |
1138 | w.at = last_activity + ::conf.keepalive + 10; |
1239 | w.start (last_activity + ::conf.keepalive + 10 - ev::now ()); |
1139 | else |
1240 | else |
1140 | reset_connection (); |
1241 | reset_connection (); |
1141 | } |
1242 | } |
1142 | |
1243 | |
1143 | void connection::send_connect_request (int id) |
1244 | void connection::send_connect_request (int id) |
… | |
… | |
1149 | send_vpn_packet (p, si); |
1250 | send_vpn_packet (p, si); |
1150 | |
1251 | |
1151 | delete p; |
1252 | delete p; |
1152 | } |
1253 | } |
1153 | |
1254 | |
|
|
1255 | void connection::script_init_env (const char *ext) |
|
|
1256 | { |
|
|
1257 | char *env; |
|
|
1258 | asprintf (&env, "IFUPDATA%s=%s", ext, conf->if_up_data); putenv (env); |
|
|
1259 | asprintf (&env, "NODENAME%s=%s", ext, conf->nodename); putenv (env); |
|
|
1260 | asprintf (&env, "MAC%s=%02x:%02x:%02x:%02x:%02x:%02x", ext, |
|
|
1261 | 0xfe, 0xfd, 0x80, 0x00, conf->id >> 8, |
|
|
1262 | conf->id & 0xff); putenv (env); |
|
|
1263 | } |
|
|
1264 | |
1154 | void connection::script_node () |
1265 | void connection::script_init_connect_env () |
1155 | { |
1266 | { |
1156 | vpn->script_if_up (); |
1267 | vpn->script_init_env (); |
1157 | |
1268 | |
1158 | char *env; |
1269 | char *env; |
1159 | asprintf (&env, "DESTID=%d", conf->id); putenv (env); |
1270 | asprintf (&env, "DESTID=%d", conf->id); putenv (env); |
1160 | asprintf (&env, "DESTNODE=%s", conf->nodename); putenv (env); |
1271 | asprintf (&env, "DESTNODE=%s", conf->nodename); putenv (env); |
1161 | asprintf (&env, "DESTIP=%s", si.ntoa ()); putenv (env); |
1272 | asprintf (&env, "DESTIP=%s", si.ntoa ()); putenv (env); |
1162 | asprintf (&env, "DESTPORT=%d", ntohs (si.port)); putenv (env); |
1273 | asprintf (&env, "DESTPORT=%d", ntohs (si.port)); putenv (env); |
1163 | } |
1274 | } |
1164 | |
1275 | |
|
|
1276 | inline const char * |
1165 | const char *connection::script_node_up () |
1277 | connection::script_node_up () |
1166 | { |
1278 | { |
1167 | script_node (); |
1279 | script_init_connect_env (); |
1168 | |
1280 | |
1169 | putenv ("STATE=up"); |
1281 | putenv ((char *)"STATE=up"); |
1170 | |
1282 | |
|
|
1283 | char *filename; |
|
|
1284 | asprintf (&filename, |
|
|
1285 | "%s/%s", |
|
|
1286 | confbase, |
1171 | return ::conf.script_node_up ? ::conf.script_node_up : "node-up"; |
1287 | ::conf.script_node_up ? ::conf.script_node_up : "node-up"); |
1172 | } |
|
|
1173 | |
1288 | |
|
|
1289 | return filename; |
|
|
1290 | } |
|
|
1291 | |
|
|
1292 | inline const char * |
1174 | const char *connection::script_node_down () |
1293 | connection::script_node_down () |
1175 | { |
1294 | { |
1176 | script_node (); |
1295 | script_init_connect_env (); |
1177 | |
1296 | |
1178 | putenv ("STATE=down"); |
1297 | putenv ((char *)"STATE=down"); |
1179 | |
1298 | |
1180 | return ::conf.script_node_up ? ::conf.script_node_down : "node-down"; |
1299 | char *filename; |
1181 | } |
1300 | asprintf (&filename, |
|
|
1301 | "%s/%s", |
|
|
1302 | confbase, |
|
|
1303 | ::conf.script_node_down ? ::conf.script_node_down : "node-down"); |
1182 | |
1304 | |
|
|
1305 | return filename; |
|
|
1306 | } |
|
|
1307 | |
1183 | connection::connection(struct vpn *vpn_) |
1308 | connection::connection (struct vpn *vpn, conf_node *conf) |
1184 | : vpn(vpn_) |
1309 | : vpn(vpn), conf(conf), |
1185 | , rekey (this, &connection::rekey_cb) |
1310 | #if ENABLE_DNS |
1186 | , keepalive (this, &connection::keepalive_cb) |
1311 | dns (0), |
|
|
1312 | #endif |
|
|
1313 | data_queue(conf->max_ttl, conf->max_queue), |
|
|
1314 | vpn_queue(conf->max_ttl, conf->max_queue) |
|
|
1315 | { |
|
|
1316 | rekey .set<connection, &connection::rekey_cb > (this); |
|
|
1317 | keepalive .set<connection, &connection::keepalive_cb > (this); |
1187 | , establish_connection (this, &connection::establish_connection_cb) |
1318 | establish_connection.set<connection, &connection::establish_connection_cb> (this); |
1188 | { |
1319 | |
1189 | octx = ictx = 0; |
1320 | octx = ictx = 0; |
1190 | retry_cnt = 0; |
1321 | retry_cnt = 0; |
1191 | |
1322 | |
1192 | connectmode = conf_node::C_ALWAYS; // initial setting |
1323 | if (!conf->protocols) // make sure some protocol is enabled |
|
|
1324 | conf->protocols = PROT_UDPv4; |
|
|
1325 | |
|
|
1326 | connectmode = conf->connectmode; |
|
|
1327 | |
|
|
1328 | // queue a dummy packet to force an initial connection attempt |
|
|
1329 | if (connectmode != conf_node::C_ALWAYS && connectmode != conf_node::C_DISABLED) |
|
|
1330 | { |
|
|
1331 | net_packet *p = new net_packet; |
|
|
1332 | p->len = 0; |
|
|
1333 | vpn_queue.put (p); |
|
|
1334 | } |
|
|
1335 | |
1193 | reset_connection (); |
1336 | reset_connection (); |
1194 | } |
1337 | } |
1195 | |
1338 | |
1196 | connection::~connection () |
1339 | connection::~connection () |
1197 | { |
1340 | { |