Commit | Line | Data |
---|---|---|
410c8acf | 1 | /* -*-c-*- |
410c8acf | 2 | * |
3 | * Communication with the peer | |
4 | * | |
5 | * (c) 2001 Straylight/Edgeware | |
6 | */ | |
7 | ||
e04c2d50 | 8 | /*----- Licensing notice --------------------------------------------------* |
410c8acf | 9 | * |
10 | * This file is part of Trivial IP Encryption (TrIPE). | |
11 | * | |
12 | * TrIPE is free software; you can redistribute it and/or modify | |
13 | * it under the terms of the GNU General Public License as published by | |
14 | * the Free Software Foundation; either version 2 of the License, or | |
15 | * (at your option) any later version. | |
e04c2d50 | 16 | * |
410c8acf | 17 | * TrIPE is distributed in the hope that it will be useful, |
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
20 | * GNU General Public License for more details. | |
e04c2d50 | 21 | * |
410c8acf | 22 | * You should have received a copy of the GNU General Public License |
23 | * along with TrIPE; if not, write to the Free Software Foundation, | |
24 | * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
25 | */ | |
26 | ||
410c8acf | 27 | /*----- Header files ------------------------------------------------------*/ |
28 | ||
29 | #include "tripe.h" | |
30 | ||
31 | /*----- Static variables --------------------------------------------------*/ | |
32 | ||
c8e02c8a MW |
33 | static sym_table byname; |
34 | static addrmap byaddr; | |
410c8acf | 35 | static sel_file sock; |
6411163d | 36 | static unsigned nmobile; |
410c8acf | 37 | |
42da2a58 | 38 | /*----- Tunnel table ------------------------------------------------------*/ |
39 | ||
40 | const tunnel_ops *tunnels[] = { | |
41 | #ifdef TUN_LINUX | |
42 | &tun_linux, | |
43 | #endif | |
44 | #ifdef TUN_BSD | |
45 | &tun_bsd, | |
46 | #endif | |
47 | #ifdef TUN_UNET | |
48 | &tun_unet, | |
49 | #endif | |
50 | &tun_slip, | |
51 | 0 | |
52 | }, *tun_default; | |
53 | ||
410c8acf | 54 | /*----- Main code ---------------------------------------------------------*/ |
55 | ||
0ba8de86 | 56 | /* --- @p_pingtype@ --- * |
57 | * | |
58 | * Arguments: @unsigned msg@ = message type | |
59 | * | |
60 | * Returns: String to describe the message. | |
61 | */ | |
62 | ||
63 | static const char *p_pingtype(unsigned msg) | |
64 | { | |
65 | switch (msg & MSG_TYPEMASK) { | |
66 | case MISC_PING: | |
67 | case MISC_PONG: | |
68 | return "transport-ping"; | |
69 | case MISC_EPING: | |
70 | case MISC_EPONG: | |
71 | return "encrypted-ping"; | |
72 | default: | |
73 | abort(); | |
74 | } | |
75 | } | |
76 | ||
77 | /* --- @p_ponged@ --- * | |
78 | * | |
79 | * Arguments: @peer *p@ = peer packet arrived from | |
80 | * @unsigned msg@ = message type | |
81 | * @buf *b@ = buffer containing payload | |
82 | * | |
83 | * Returns: --- | |
84 | * | |
85 | * Use: Processes a ping response. | |
86 | */ | |
87 | ||
88 | static void p_ponged(peer *p, unsigned msg, buf *b) | |
89 | { | |
90 | uint32 id; | |
91 | const octet *magic; | |
92 | ping *pg; | |
e04c2d50 | 93 | |
0ba8de86 | 94 | IF_TRACING(T_PEER, { |
95 | trace(T_PEER, "peer: received %s reply from %s", | |
96 | p_pingtype(msg), p->spec.name); | |
97 | trace_block(T_PACKET, "peer: ping contents", BBASE(b), BSZ(b)); | |
98 | }) | |
99 | ||
100 | if (buf_getu32(b, &id) || | |
101 | (magic = buf_get(b, sizeof(pg->magic))) == 0 || | |
102 | BLEFT(b)) { | |
f43df819 | 103 | a_warn("PEER", "?PEER", p, "malformed-%s", p_pingtype(msg), A_END); |
0ba8de86 | 104 | return; |
105 | } | |
106 | ||
107 | for (pg = p->pings; pg; pg = pg->next) { | |
108 | if (pg->id == id) | |
109 | goto found; | |
110 | } | |
f43df819 MW |
111 | a_warn("PEER", |
112 | "?PEER", p, | |
113 | "unexpected-%s", p_pingtype(msg), | |
114 | "0x%08lx", (unsigned long)id, | |
115 | A_END); | |
0ba8de86 | 116 | return; |
117 | ||
118 | found: | |
119 | if (memcmp(magic, pg->magic, sizeof(pg->magic)) != 0) { | |
f43df819 | 120 | a_warn("PEER", "?PEER", p, "corrupt-%s", p_pingtype(msg), A_END); |
0ba8de86 | 121 | return; |
122 | } | |
123 | p_pingdone(pg, PING_OK); | |
124 | } | |
125 | ||
6411163d MW |
126 | /* --- @p_rxupdstats@ --- * |
127 | * | |
128 | * Arguments: @peer *p@ = peer to update | |
129 | * @size_t n@ = size of incoming packet | |
130 | * | |
131 | * Returns: --- | |
132 | * | |
133 | * Use: Updates the peer's incoming packet statistics. | |
134 | */ | |
135 | ||
136 | static void p_rxupdstats(peer *p, size_t n) | |
137 | { | |
138 | p->st.t_last = time(0); | |
139 | p->st.n_in++; | |
140 | p->st.sz_in += n; | |
141 | } | |
142 | ||
a50f9a0e MW |
143 | /* --- @p_encrypt@ --- * |
144 | * | |
145 | * Arguments: @peer *p@ = peer to encrypt message to | |
146 | * @int ty@ message type to send | |
147 | * @buf *bin, *bout@ = input and output buffers | |
148 | * | |
149 | * Returns: --- | |
150 | * | |
151 | * Use: Convenience function for packet encryption. Forces | |
152 | * renegotiation when necessary. Check for the output buffer | |
153 | * being broken to find out whether the encryption was | |
154 | * successful. | |
155 | */ | |
156 | ||
157 | static int p_encrypt(peer *p, int ty, buf *bin, buf *bout) | |
158 | { | |
159 | int err = ksl_encrypt(&p->ks, ty, bin, bout); | |
160 | ||
161 | if (err == KSERR_REGEN) { | |
162 | kx_start(&p->kx, 1); | |
163 | err = 0; | |
164 | } | |
165 | if (!BOK(bout)) | |
166 | err = -1; | |
167 | return (err); | |
168 | } | |
169 | ||
170 | /* --- @p_decrypt@ --- * | |
171 | * | |
6411163d MW |
172 | * Arguments: @peer **pp@ = pointer to peer to decrypt message from |
173 | * @addr *a@ = address the packet arrived on | |
174 | * @size_t n@ = size of original incoming packet | |
a50f9a0e MW |
175 | * @int ty@ = message type to expect |
176 | * @buf *bin, *bout@ = input and output buffers | |
177 | * | |
178 | * Returns: Zero on success; nonzero on error. | |
179 | * | |
180 | * Use: Convenience function for packet decryption. Reports errors | |
181 | * and updates statistics appropriately. | |
6411163d MW |
182 | * |
183 | * If @*pp@ is null on entry and there are mobile peers then we | |
184 | * see if any of them can decrypt the packet. If so, we record | |
185 | * @*a@ as the peer's new address and send a notification. | |
a50f9a0e MW |
186 | */ |
187 | ||
6411163d MW |
188 | static int p_decrypt(peer **pp, addr *a, size_t n, |
189 | int ty, buf *bin, buf *bout) | |
a50f9a0e | 190 | { |
6411163d MW |
191 | peer *p; |
192 | peer_byaddr *pa; | |
193 | int err = KSERR_DECRYPT; | |
194 | unsigned f; | |
195 | ||
196 | if (*pp) { | |
197 | p = *pp; | |
198 | T( trace(T_PEER, "peer: decrypting packet from known peer `%s'", | |
199 | p_name(p)); ) | |
200 | err = ksl_decrypt(&p->ks, ty, bin, bout); | |
201 | } else { | |
202 | p = 0; | |
203 | if (nmobile) { | |
204 | T( trace(T_PEER, "peer: unknown source: trying mobile peers..."); ) | |
205 | FOREACH_PEER(q, { | |
66196407 | 206 | if (!(q->spec.f & PSF_MOBILE)) continue; |
6411163d MW |
207 | if ((err = ksl_decrypt(&q->ks, ty, bin, bout)) == KSERR_DECRYPT) { |
208 | T( trace(T_PEER, "peer: peer `%s' failed to decrypt", | |
209 | p_name(q)); ) | |
210 | continue; | |
211 | } else { | |
212 | p = *pp = q; | |
213 | IF_TRACING(T_PEER, { | |
214 | if (!err) | |
215 | trace(T_PEER, "peer: peer `%s' reports success", p_name(p)); | |
216 | else { | |
217 | trace(T_PEER, "peer: peer `%s' reports decryption error %d", | |
218 | p_name(p), err); | |
219 | } | |
220 | }) | |
221 | break; | |
222 | } | |
223 | }); | |
224 | } | |
225 | if (!p) { | |
226 | a_warn("PEER", "-", "unexpected-source", "?ADDR", a, A_END); | |
227 | return (-1); | |
228 | } | |
229 | if (!err) { | |
230 | T( trace(T_PEER, "peer: updating address for `%s'", p_name(p)); ) | |
6411163d MW |
231 | pa = am_find(&byaddr, a, sizeof(peer_byaddr), &f); assert(!f); |
232 | am_remove(&byaddr, p->byaddr); | |
233 | p->byaddr = pa; | |
234 | pa->p = p; | |
235 | p->spec.sa = *a; | |
236 | a_notify("NEWADDR", "?PEER", p, "?ADDR", a, A_END); | |
237 | } | |
238 | } | |
88622d1d | 239 | p_rxupdstats(p, n); |
6411163d MW |
240 | if (err) { |
241 | if (p) p->st.n_reject++; | |
242 | a_warn("PEER", "?PEER", p, "decrypt-failed", | |
243 | "error-code", "%d", err, A_END); | |
a50f9a0e MW |
244 | return (-1); |
245 | } | |
246 | if (!BOK(bout)) | |
247 | return (-1); | |
248 | return (0); | |
249 | } | |
250 | ||
410c8acf | 251 | /* --- @p_read@ --- * |
252 | * | |
253 | * Arguments: @int fd@ = file descriptor to read from | |
254 | * @unsigned mode@ = what happened | |
255 | * @void *v@ = an uninteresting pointer | |
256 | * | |
257 | * Returns: --- | |
258 | * | |
259 | * Use: Reads a packet from somewhere. | |
260 | */ | |
261 | ||
262 | static void p_read(int fd, unsigned mode, void *v) | |
263 | { | |
37941236 | 264 | peer *p = 0; |
410c8acf | 265 | addr a; |
266 | size_t sz; | |
267 | ssize_t n; | |
268 | int ch; | |
269 | buf b, bb; | |
270 | ||
271 | /* --- Read the data --- */ | |
272 | ||
8d0c7a83 | 273 | TIMER; |
410c8acf | 274 | sz = sizeof(addr); |
275 | n = recvfrom(fd, buf_i, sizeof(buf_i), 0, &a.sa, &sz); | |
276 | if (n < 0) { | |
f43df819 | 277 | a_warn("PEER", "-", "socket-read-error", "?ERRNO", A_END); |
410c8acf | 278 | return; |
279 | } | |
280 | ||
37941236 | 281 | /* --- If the packet is a greeting, don't check peers --- */ |
282 | ||
283 | if (n && buf_i[0] == (MSG_MISC | MISC_GREET)) { | |
284 | IF_TRACING(T_PEER, { | |
285 | trace(T_PEER, "peer: greeting received from INET %s %u", | |
286 | inet_ntoa(a.sin.sin_addr), | |
287 | (unsigned)ntohs(a.sin.sin_port)); | |
288 | trace_block(T_PACKET, "peer: greeting contents", buf_i, n); | |
289 | }) | |
290 | buf_init(&b, buf_i, n); | |
291 | buf_getbyte(&b); | |
292 | if (c_check(&b) || BLEFT(&b)) { | |
f43df819 | 293 | a_warn("PEER", "-", "invalid-greeting", A_END); |
37941236 | 294 | return; |
295 | } | |
f43df819 MW |
296 | a_notify("GREET", |
297 | "?B64", buf_i + 1, (size_t)(n - 1), | |
298 | "?ADDR", &a, | |
299 | A_END); | |
37941236 | 300 | return; |
301 | } | |
302 | ||
6411163d MW |
303 | /* --- Find the appropriate peer --- * |
304 | * | |
305 | * At this stage, don't worry too much about whether we actually found it. | |
306 | */ | |
410c8acf | 307 | |
6411163d | 308 | p = p_findbyaddr(&a); |
410c8acf | 309 | |
b9066fbb | 310 | IF_TRACING(T_PEER, { |
6411163d MW |
311 | if (p) { |
312 | trace(T_PEER, | |
313 | "peer: packet received from `%s' from address INET %s %d", | |
314 | p_name(p), inet_ntoa(a.sin.sin_addr), ntohs(a.sin.sin_port)); | |
315 | } else { | |
316 | trace(T_PEER, "peer: packet received from unknown address INET %s %d", | |
317 | inet_ntoa(a.sin.sin_addr), ntohs(a.sin.sin_port)); | |
318 | } | |
b9066fbb | 319 | trace_block(T_PACKET, "peer: packet contents", buf_i, n); |
320 | }) | |
410c8acf | 321 | |
322 | /* --- Pick the packet apart --- */ | |
323 | ||
324 | buf_init(&b, buf_i, n); | |
325 | if ((ch = buf_getbyte(&b)) < 0) { | |
f43df819 | 326 | a_warn("PEER", "?PEER", p, "bad-packet", "no-type", A_END); |
410c8acf | 327 | return; |
328 | } | |
5bb41301 | 329 | switch (ch & MSG_CATMASK) { |
410c8acf | 330 | case MSG_PACKET: |
5bb41301 | 331 | if (ch & MSG_TYPEMASK) { |
f43df819 MW |
332 | a_warn("PEER", |
333 | "?PEER", p, | |
334 | "bad-packet", | |
335 | "unknown-type", "0x%02x", ch, | |
336 | A_END); | |
6411163d | 337 | if (p) p->st.n_reject++; |
5bb41301 | 338 | return; |
339 | } | |
410c8acf | 340 | buf_init(&bb, buf_o, sizeof(buf_o)); |
6411163d | 341 | if (p_decrypt(&p, &a, n, MSG_PACKET, &b, &bb)) |
410c8acf | 342 | return; |
5bb41301 | 343 | if (BOK(&bb)) { |
344 | p->st.n_ipin++; | |
345 | p->st.sz_ipin += BSZ(&b); | |
42da2a58 | 346 | p->t->ops->inject(p->t, &bb); |
5bb41301 | 347 | } else { |
348 | p->st.n_reject++; | |
f43df819 | 349 | a_warn("PEER", "?PEER", p, "packet-build-failed", A_END); |
5bb41301 | 350 | } |
410c8acf | 351 | break; |
5bb41301 | 352 | case MSG_KEYEXCH: |
6411163d | 353 | if (!p) goto unexp; |
88622d1d | 354 | p_rxupdstats(p, n); |
5bb41301 | 355 | kx_message(&p->kx, ch & MSG_TYPEMASK, &b); |
410c8acf | 356 | break; |
0ba8de86 | 357 | case MSG_MISC: |
358 | switch (ch & MSG_TYPEMASK) { | |
359 | case MISC_NOP: | |
6411163d | 360 | if (!p) goto unexp; |
88622d1d | 361 | p_rxupdstats(p, n); |
0ba8de86 | 362 | T( trace(T_PEER, "peer: received NOP packet"); ) |
363 | break; | |
364 | case MISC_PING: | |
6411163d | 365 | if (!p) goto unexp; |
88622d1d | 366 | p_rxupdstats(p, n); |
0ba8de86 | 367 | buf_put(p_txstart(p, MSG_MISC | MISC_PONG), BCUR(&b), BLEFT(&b)); |
368 | p_txend(p); | |
e04c2d50 | 369 | break; |
0ba8de86 | 370 | case MISC_PONG: |
6411163d | 371 | if (!p) goto unexp; |
88622d1d | 372 | p_rxupdstats(p, n); |
0ba8de86 | 373 | p_ponged(p, MISC_PONG, &b); |
374 | break; | |
375 | case MISC_EPING: | |
376 | buf_init(&bb, buf_t, sizeof(buf_t)); | |
6411163d | 377 | if (p_decrypt(&p, &a, n, ch, &b, &bb)) |
0ba8de86 | 378 | return; |
0ba8de86 | 379 | if (BOK(&bb)) { |
380 | buf_flip(&bb); | |
a50f9a0e MW |
381 | p_encrypt(p, MSG_MISC | MISC_EPONG, &bb, |
382 | p_txstart(p, MSG_MISC | MISC_EPONG)); | |
0ba8de86 | 383 | p_txend(p); |
384 | } | |
385 | break; | |
386 | case MISC_EPONG: | |
387 | buf_init(&bb, buf_t, sizeof(buf_t)); | |
6411163d | 388 | if (p_decrypt(&p, &a, n, ch, &b, &bb)) |
0ba8de86 | 389 | return; |
0ba8de86 | 390 | if (BOK(&bb)) { |
391 | buf_flip(&bb); | |
392 | p_ponged(p, MISC_EPONG, &bb); | |
393 | } | |
394 | break; | |
395 | } | |
396 | break; | |
410c8acf | 397 | default: |
6411163d | 398 | if (p) p->st.n_reject++; |
f43df819 MW |
399 | a_warn("PEER", |
400 | "?PEER", p, | |
401 | "bad-packet", | |
a68280fc | 402 | "unknown-category", "0x%02x", ch, |
f43df819 | 403 | A_END); |
410c8acf | 404 | break; |
6411163d MW |
405 | unexp: |
406 | a_warn("PEER", "-", "unexpected-source", "?ADDR", &a, A_END); | |
407 | break; | |
410c8acf | 408 | } |
409 | } | |
410 | ||
411 | /* --- @p_txstart@ --- * | |
412 | * | |
413 | * Arguments: @peer *p@ = pointer to peer block | |
414 | * @unsigned msg@ = message type code | |
415 | * | |
416 | * Returns: A pointer to a buffer to write to. | |
417 | * | |
418 | * Use: Starts sending to a peer. Only one send can happen at a | |
419 | * time. | |
420 | */ | |
421 | ||
422 | buf *p_txstart(peer *p, unsigned msg) | |
423 | { | |
424 | buf_init(&p->b, buf_o, sizeof(buf_o)); | |
425 | buf_putbyte(&p->b, msg); | |
426 | return (&p->b); | |
427 | } | |
428 | ||
429 | /* --- @p_txend@ --- * | |
430 | * | |
431 | * Arguments: @peer *p@ = pointer to peer block | |
432 | * | |
433 | * Returns: --- | |
434 | * | |
435 | * Use: Sends a packet to the peer. | |
436 | */ | |
437 | ||
0ba8de86 | 438 | static void p_setkatimer(peer *); |
439 | ||
440 | static int p_dotxend(peer *p) | |
410c8acf | 441 | { |
442 | if (!BOK(&p->b)) { | |
f43df819 | 443 | a_warn("PEER", "?PEER", p, "packet-build-failed", A_END); |
0ba8de86 | 444 | return (0); |
410c8acf | 445 | } |
446 | IF_TRACING(T_PEER, trace_block(T_PACKET, "peer: sending packet", | |
447 | BBASE(&p->b), BLEN(&p->b)); ) | |
448 | if (sendto(sock.fd, BBASE(&p->b), BLEN(&p->b), | |
0ba8de86 | 449 | 0, &p->spec.sa.sa, p->spec.sasz) < 0) { |
f43df819 | 450 | a_warn("PEER", "?PEER", p, "socket-write-error", "?ERRNO", A_END); |
0ba8de86 | 451 | return (0); |
452 | } else { | |
5bb41301 | 453 | p->st.n_out++; |
454 | p->st.sz_out += BLEN(&p->b); | |
0ba8de86 | 455 | return (1); |
5bb41301 | 456 | } |
410c8acf | 457 | } |
458 | ||
0ba8de86 | 459 | void p_txend(peer *p) |
460 | { | |
461 | if (p_dotxend(p) && p->spec.t_ka) { | |
462 | sel_rmtimer(&p->tka); | |
463 | p_setkatimer(p); | |
464 | } | |
465 | } | |
466 | ||
467 | /* --- @p_pingwrite@ --- * | |
468 | * | |
469 | * Arguments: @ping *p@ = ping structure | |
470 | * @buf *b@ = buffer to write in | |
471 | * | |
472 | * Returns: --- | |
473 | * | |
474 | * Use: Fills in a ping structure and writes the packet payload. | |
475 | */ | |
476 | ||
477 | static void p_pingwrite(ping *p, buf *b) | |
478 | { | |
479 | static uint32 seq = 0; | |
480 | ||
481 | p->id = U32(seq++); | |
482 | GR_FILL(&rand_global, p->magic, sizeof(p->magic)); | |
483 | buf_putu32(b, p->id); | |
484 | buf_put(b, p->magic, sizeof(p->magic)); | |
485 | } | |
486 | ||
487 | /* --- @p_pingdone@ --- * | |
488 | * | |
489 | * Arguments: @ping *p@ = ping structure | |
490 | * @int rc@ = return code to pass on | |
491 | * | |
492 | * Returns: --- | |
493 | * | |
494 | * Use: Disposes of a ping structure, maybe sending a notification. | |
495 | */ | |
496 | ||
497 | void p_pingdone(ping *p, int rc) | |
498 | { | |
0ba8de86 | 499 | if (p->prev) p->prev->next = p->next; |
500 | else p->p->pings = p->next; | |
501 | if (p->next) p->next->prev = p->prev; | |
502 | if (rc != PING_TIMEOUT) sel_rmtimer(&p->t); | |
060ca767 | 503 | T( trace(T_PEER, "peer: ping 0x%08lx done (rc = %d)", |
504 | (unsigned long)p->id, rc); ) | |
0ba8de86 | 505 | if (rc >= 0) p->func(rc, p->arg); |
506 | } | |
507 | ||
508 | /* --- @p_pingtimeout@ --- * | |
509 | * | |
510 | * Arguments: @struct timeval *now@ = the time now | |
511 | * @void *pv@ = pointer to ping block | |
512 | * | |
513 | * Returns: --- | |
514 | * | |
515 | * Use: Called when a ping times out. | |
516 | */ | |
517 | ||
518 | static void p_pingtimeout(struct timeval *now, void *pv) | |
519 | { | |
520 | ping *p = pv; | |
521 | ||
522 | T( trace(T_PEER, "peer: ping 0x%08lx timed out", (unsigned long)p->id); ) | |
523 | p_pingdone(p, PING_TIMEOUT); | |
524 | } | |
525 | ||
526 | /* --- @p_pingsend@ --- * | |
527 | * | |
528 | * Arguments: @peer *p@ = destination peer | |
529 | * @ping *pg@ = structure to fill in | |
530 | * @unsigned type@ = message type | |
531 | * @unsigned long timeout@ = how long to wait before giving up | |
532 | * @void (*func)(int, void *)@ = callback function | |
533 | * @void *arg@ = argument for callback | |
534 | * | |
535 | * Returns: Zero if successful, nonzero if it failed. | |
536 | * | |
537 | * Use: Sends a ping to a peer. Call @func@ with a nonzero argument | |
538 | * if we get an answer within the timeout, or zero if no answer. | |
539 | */ | |
540 | ||
541 | int p_pingsend(peer *p, ping *pg, unsigned type, | |
542 | unsigned long timeout, | |
543 | void (*func)(int, void *), void *arg) | |
544 | { | |
545 | buf *b, bb; | |
546 | struct timeval tv; | |
547 | ||
0ba8de86 | 548 | switch (type) { |
549 | case MISC_PING: | |
550 | pg->msg = MISC_PONG; | |
551 | b = p_txstart(p, MSG_MISC | MISC_PING); | |
552 | p_pingwrite(pg, b); | |
553 | p_txend(p); | |
554 | break; | |
555 | case MISC_EPING: | |
556 | pg->msg = MISC_EPONG; | |
557 | b = p_txstart(p, MSG_MISC | MISC_EPING); | |
558 | buf_init(&bb, buf_t, sizeof(buf_t)); | |
559 | p_pingwrite(pg, &bb); | |
560 | buf_flip(&bb); | |
a50f9a0e | 561 | p_encrypt(p, MSG_MISC | MISC_EPING, &bb, b); |
0ba8de86 | 562 | if (!BOK(b)) |
563 | return (-1); | |
564 | p_txend(p); | |
565 | break; | |
566 | default: | |
567 | abort(); | |
568 | break; | |
569 | } | |
570 | ||
571 | pg->next = p->pings; | |
572 | pg->prev = 0; | |
573 | pg->p = p; | |
574 | pg->func = func; | |
575 | pg->arg = arg; | |
060ca767 | 576 | if (p->pings) p->pings->prev = pg; |
0ba8de86 | 577 | p->pings = pg; |
578 | gettimeofday(&tv, 0); | |
579 | tv.tv_sec += timeout; | |
580 | sel_addtimer(&sel, &pg->t, &tv, p_pingtimeout, pg); | |
581 | T( trace(T_PEER, "peer: send %s 0x%08lx to %s", | |
582 | p_pingtype(type), (unsigned long)pg->id, p->spec.name); ) | |
583 | return (0); | |
584 | } | |
585 | ||
37941236 | 586 | /* --- @p_greet@ --- * |
587 | * | |
588 | * Arguments: @peer *p@ = peer to send to | |
589 | * @const void *c@ = pointer to challenge | |
590 | * @size_t sz@ = size of challenge | |
591 | * | |
592 | * Returns: --- | |
593 | * | |
594 | * Use: Sends a greeting packet. | |
595 | */ | |
596 | ||
597 | void p_greet(peer *p, const void *c, size_t sz) | |
598 | { | |
599 | buf *b = p_txstart(p, MSG_MISC | MISC_GREET); | |
600 | buf_put(b, c, sz); | |
601 | p_txend(p); | |
602 | } | |
603 | ||
410c8acf | 604 | /* --- @p_tun@ --- * |
605 | * | |
606 | * Arguments: @peer *p@ = pointer to peer block | |
607 | * @buf *b@ = buffer containing incoming packet | |
608 | * | |
609 | * Returns: --- | |
610 | * | |
611 | * Use: Handles a packet which needs to be sent to a peer. | |
612 | */ | |
613 | ||
614 | void p_tun(peer *p, buf *b) | |
615 | { | |
616 | buf *bb = p_txstart(p, MSG_PACKET); | |
7b052fe6 | 617 | |
8d0c7a83 | 618 | TIMER; |
a50f9a0e | 619 | p_encrypt(p, MSG_PACKET, b, bb); |
5bb41301 | 620 | if (BOK(bb) && BLEN(bb)) { |
621 | p->st.n_ipout++; | |
622 | p->st.sz_ipout += BLEN(bb); | |
410c8acf | 623 | p_txend(p); |
5bb41301 | 624 | } |
410c8acf | 625 | } |
626 | ||
de014da6 | 627 | /* --- @p_keyreload@ --- * |
628 | * | |
629 | * Arguments: --- | |
630 | * | |
631 | * Returns: --- | |
632 | * | |
633 | * Use: Forces a check of the daemon's keyring files. | |
634 | */ | |
635 | ||
636 | void p_keyreload(void) | |
637 | { | |
c8e02c8a MW |
638 | if (km_reload()) |
639 | FOREACH_PEER(p, { kx_newkeys(&p->kx); }); | |
de014da6 | 640 | } |
641 | ||
410c8acf | 642 | /* --- @p_interval@ --- * |
643 | * | |
644 | * Arguments: --- | |
645 | * | |
646 | * Returns: --- | |
647 | * | |
648 | * Use: Called periodically to do tidying. | |
649 | */ | |
650 | ||
651 | void p_interval(void) | |
652 | { | |
de014da6 | 653 | p_keyreload(); |
c8e02c8a | 654 | FOREACH_PEER(p, { ksl_prune(&p->ks); }); |
410c8acf | 655 | } |
656 | ||
5bb41301 | 657 | /* --- @p_stats@ --- * |
658 | * | |
659 | * Arguments: @peer *p@ = pointer to a peer block | |
660 | * | |
661 | * Returns: A pointer to the peer's statistics. | |
662 | */ | |
663 | ||
664 | stats *p_stats(peer *p) { return (&p->st); } | |
665 | ||
410c8acf | 666 | /* --- @p_ifname@ --- * |
667 | * | |
668 | * Arguments: @peer *p@ = pointer to a peer block | |
669 | * | |
670 | * Returns: A pointer to the peer's interface name. | |
671 | */ | |
672 | ||
64cf2223 MW |
673 | const char *p_ifname(peer *p) { return (p->ifname); } |
674 | ||
675 | /* --- @p_setifname@ --- * | |
676 | * | |
677 | * Arguments: @peer *p@ = pointer to a peer block | |
678 | * @const char *name@ = pointer to the new name | |
679 | * | |
680 | * Returns: --- | |
681 | * | |
682 | * Use: Changes the name held for a peer's interface. | |
683 | */ | |
684 | ||
685 | void p_setifname(peer *p, const char *name) | |
72917fe7 MW |
686 | { |
687 | xfree(p->ifname); | |
688 | p->ifname = xstrdup(name); | |
689 | if (p->spec.tops->setifname) | |
690 | p->spec.tops->setifname(p->t, name); | |
691 | } | |
410c8acf | 692 | |
693 | /* --- @p_addr@ --- * | |
694 | * | |
695 | * Arguments: @peer *p@ = pointer to a peer block | |
696 | * | |
697 | * Returns: A pointer to the peer's address. | |
698 | */ | |
699 | ||
0ba8de86 | 700 | const addr *p_addr(peer *p) { return (&p->spec.sa); } |
410c8acf | 701 | |
702 | /* --- @p_init@ --- * | |
703 | * | |
767b36e2 | 704 | * Arguments: @struct in_addr addr@ = address to bind to |
705 | * @unsigned port@ = port number to listen to | |
410c8acf | 706 | * |
707 | * Returns: --- | |
708 | * | |
709 | * Use: Initializes the peer system; creates the socket. | |
710 | */ | |
711 | ||
767b36e2 | 712 | void p_init(struct in_addr addr, unsigned port) |
410c8acf | 713 | { |
714 | int fd; | |
715 | struct sockaddr_in sin; | |
df9dfccf | 716 | int len = PKBUFSZ; |
0a9920e2 | 717 | |
718 | /* --- Note on socket buffer sizes --- * | |
719 | * | |
720 | * For some bizarre reason, Linux 2.2 (at least) doubles the socket buffer | |
721 | * sizes I pass to @setsockopt@. I'm not putting special-case code here | |
722 | * for Linux: BSD (at least TCPv2) does what I tell it rather than second- | |
723 | * guessing me. | |
724 | */ | |
410c8acf | 725 | |
726 | if ((fd = socket(PF_INET, SOCK_DGRAM, 0)) < 0) | |
727 | die(EXIT_FAILURE, "socket creation failed: %s", strerror(errno)); | |
728 | BURN(sin); | |
729 | sin.sin_family = AF_INET; | |
767b36e2 | 730 | sin.sin_addr = addr; |
410c8acf | 731 | sin.sin_port = htons(port); |
732 | if (bind(fd, (struct sockaddr *)&sin, sizeof(sin))) | |
733 | die(EXIT_FAILURE, "bind failed: %s", strerror(errno)); | |
0a9920e2 | 734 | if (setsockopt(fd, SOL_SOCKET, SO_RCVBUF, &len, sizeof(len)) || |
735 | setsockopt(fd, SOL_SOCKET, SO_SNDBUF, &len, sizeof(len))) { | |
736 | die(EXIT_FAILURE, "failed to set socket buffer sizes: %s", | |
737 | strerror(errno)); | |
738 | } | |
650a6624 | 739 | fdflags(fd, O_NONBLOCK, O_NONBLOCK, FD_CLOEXEC, FD_CLOEXEC); |
410c8acf | 740 | sel_initfile(&sel, &sock, fd, SEL_READ, p_read, 0); |
741 | sel_addfile(&sock); | |
742 | T( trace(T_PEER, "peer: created socket"); ) | |
c8e02c8a MW |
743 | |
744 | sym_create(&byname); | |
745 | am_create(&byaddr); | |
410c8acf | 746 | } |
747 | ||
748 | /* --- @p_port@ --- * | |
749 | * | |
750 | * Arguments: --- | |
751 | * | |
752 | * Returns: Port number used for socket. | |
753 | */ | |
754 | ||
755 | unsigned p_port(void) | |
756 | { | |
757 | addr a; | |
758 | size_t sz = sizeof(addr); | |
759 | ||
760 | if (getsockname(sock.fd, &a.sa, &sz)) | |
761 | die(EXIT_FAILURE, "couldn't read port number: %s", strerror(errno)); | |
762 | assert(a.sa.sa_family == AF_INET); | |
763 | return (ntohs(a.sin.sin_port)); | |
764 | } | |
765 | ||
0ba8de86 | 766 | /* --- @p_keepalive@ --- * |
767 | * | |
768 | * Arguments: @struct timeval *now@ = the current time | |
769 | * @void *pv@ = peer to wake up | |
770 | * | |
771 | * Returns: --- | |
772 | * | |
773 | * Use: Sends a keepalive ping message to its peer. | |
774 | */ | |
775 | ||
776 | static void p_keepalive(struct timeval *now, void *pv) | |
777 | { | |
778 | peer *p = pv; | |
779 | p_txstart(p, MSG_MISC | MISC_NOP); p_dotxend(p); | |
780 | T( trace(T_PEER, "peer: sent keepalive to %s", p->spec.name); ) | |
781 | p_setkatimer(p); | |
782 | } | |
783 | ||
784 | /* --- @p_setkatimer@ --- * | |
785 | * | |
786 | * Arguments: @peer *p@ = peer to set | |
787 | * | |
788 | * Returns: --- | |
789 | * | |
790 | * Use: Resets the keepalive timer thing. | |
791 | */ | |
792 | ||
793 | static void p_setkatimer(peer *p) | |
794 | { | |
795 | struct timeval tv; | |
796 | ||
797 | if (!p->spec.t_ka) | |
798 | return; | |
799 | gettimeofday(&tv, 0); | |
800 | tv.tv_sec += p->spec.t_ka; | |
801 | sel_addtimer(&sel, &p->tka, &tv, p_keepalive, p); | |
802 | } | |
803 | ||
410c8acf | 804 | /* --- @p_create@ --- * |
805 | * | |
0ba8de86 | 806 | * Arguments: @peerspec *spec@ = information about this peer |
410c8acf | 807 | * |
808 | * Returns: Pointer to the peer block, or null if it failed. | |
809 | * | |
810 | * Use: Creates a new named peer block. No peer is actually attached | |
811 | * by this point. | |
812 | */ | |
813 | ||
0ba8de86 | 814 | peer *p_create(peerspec *spec) |
410c8acf | 815 | { |
816 | peer *p = CREATE(peer); | |
eb5f3fea MW |
817 | const tunnel_ops *tops = spec->tops; |
818 | int fd; | |
c8e02c8a MW |
819 | unsigned f; |
820 | ||
821 | p->byname = sym_find(&byname, spec->name, -1, sizeof(peer_byname), &f); | |
822 | if (f) goto tidy_0; | |
823 | p->byaddr = am_find(&byaddr, &spec->sa, sizeof(peer_byaddr), &f); | |
824 | if (f) goto tidy_1; | |
825 | p->byname->p = p->byaddr->p = p; | |
42da2a58 | 826 | |
0ba8de86 | 827 | T( trace(T_PEER, "peer: creating new peer `%s'", spec->name); ) |
828 | p->spec = *spec; | |
c8e02c8a | 829 | p->spec.name = (/*unconst*/ char *)SYM_NAME(p->byname); |
48b84569 MW |
830 | if (spec->tag) |
831 | p->spec.tag = xstrdup(spec->tag); | |
410c8acf | 832 | p->ks = 0; |
629842d8 | 833 | p->pings = 0; |
64cf2223 | 834 | p->ifname = 0; |
5bb41301 | 835 | memset(&p->st, 0, sizeof(stats)); |
836 | p->st.t_start = time(0); | |
388e0319 | 837 | if (!(tops->flags & TUNF_PRIVOPEN)) |
eb5f3fea | 838 | fd = -1; |
388e0319 | 839 | else if ((fd = ps_tunfd(tops, &p->ifname)) < 0) |
c8e02c8a | 840 | goto tidy_2; |
eb5f3fea MW |
841 | if ((p->t = tops->create(p, fd, &p->ifname)) == 0) |
842 | goto tidy_3; | |
843 | T( trace(T_TUNNEL, "peer: attached interface %s to peer `%s'", | |
844 | p->ifname, p_name(p)); ) | |
0ba8de86 | 845 | p_setkatimer(p); |
8743c776 | 846 | if (kx_init(&p->kx, p, &p->ks, p->spec.f & PSF_KXMASK)) |
eb5f3fea | 847 | goto tidy_4; |
f43df819 | 848 | a_notify("ADD", |
6047fbac MW |
849 | "?PEER", p, |
850 | "%s", p->ifname, | |
851 | "?ADDR", &p->spec.sa, | |
852 | A_END); | |
8743c776 | 853 | if (!(p->spec.f & KXF_CORK)) { |
010e6f63 | 854 | a_notify("KXSTART", "?PEER", p, A_END); |
f43df819 | 855 | /* Couldn't tell anyone before */ |
010e6f63 | 856 | } |
6411163d | 857 | if (p->spec.f & PSF_MOBILE) nmobile++; |
410c8acf | 858 | return (p); |
859 | ||
eb5f3fea | 860 | tidy_4: |
0ba8de86 | 861 | if (spec->t_ka) |
862 | sel_rmtimer(&p->tka); | |
72917fe7 | 863 | xfree(p->ifname); |
0ba8de86 | 864 | p->t->ops->destroy(p->t); |
eb5f3fea MW |
865 | tidy_3: |
866 | if (fd >= 0) close(fd); | |
c8e02c8a MW |
867 | tidy_2: |
868 | am_remove(&byaddr, p->byaddr); | |
48b84569 | 869 | if (p->spec.tag) xfree(p->spec.tag); |
c8e02c8a MW |
870 | tidy_1: |
871 | sym_remove(&byname, p->byname); | |
410c8acf | 872 | tidy_0: |
410c8acf | 873 | DESTROY(p); |
874 | return (0); | |
875 | } | |
876 | ||
877 | /* --- @p_name@ --- * | |
878 | * | |
879 | * Arguments: @peer *p@ = pointer to a peer block | |
880 | * | |
881 | * Returns: A pointer to the peer's name. | |
882 | */ | |
883 | ||
6411163d MW |
884 | const char *p_name(peer *p) |
885 | { if (p) return (p->spec.name); else return ("-"); } | |
410c8acf | 886 | |
48b84569 MW |
887 | /* --- @p_tag@ --- * |
888 | * | |
889 | * Arguments: @peer *p@ = pointer to a peer block | |
890 | * | |
891 | * Returns: A pointer to the peer's public key tag. | |
892 | */ | |
893 | ||
894 | const char *p_tag(peer *p) | |
895 | { return (p->spec.tag ? p->spec.tag : p->spec.name); } | |
896 | ||
060ca767 | 897 | /* --- @p_spec@ --- * |
898 | * | |
899 | * Arguments: @peer *p@ = pointer to a peer block | |
900 | * | |
901 | * Returns: Pointer to the peer's specification | |
902 | */ | |
903 | ||
904 | const peerspec *p_spec(peer *p) { return (&p->spec); } | |
905 | ||
c8e02c8a MW |
906 | /* --- @p_findbyaddr@ --- * |
907 | * | |
908 | * Arguments: @const addr *a@ = address to look up | |
909 | * | |
910 | * Returns: Pointer to the peer block, or null if not found. | |
911 | * | |
912 | * Use: Finds a peer by address. | |
913 | */ | |
914 | ||
915 | peer *p_findbyaddr(const addr *a) | |
916 | { | |
917 | peer_byaddr *pa; | |
918 | ||
6411163d MW |
919 | if ((pa = am_find(&byaddr, a, 0, 0)) != 0) { |
920 | assert(pa->p); | |
c8e02c8a | 921 | return (pa->p); |
6411163d | 922 | } |
c8e02c8a MW |
923 | return (0); |
924 | } | |
925 | ||
410c8acf | 926 | /* --- @p_find@ --- * |
927 | * | |
928 | * Arguments: @const char *name@ = name to look up | |
929 | * | |
930 | * Returns: Pointer to the peer block, or null if not found. | |
931 | * | |
932 | * Use: Finds a peer by name. | |
933 | */ | |
934 | ||
935 | peer *p_find(const char *name) | |
936 | { | |
c8e02c8a MW |
937 | peer_byname *pn; |
938 | ||
939 | if ((pn = sym_find(&byname, name, -1, 0, 0)) != 0) | |
940 | return (pn->p); | |
e04c2d50 | 941 | return (0); |
410c8acf | 942 | } |
943 | ||
944 | /* --- @p_destroy@ --- * | |
945 | * | |
946 | * Arguments: @peer *p@ = pointer to a peer | |
947 | * | |
948 | * Returns: --- | |
949 | * | |
950 | * Use: Destroys a peer. | |
951 | */ | |
952 | ||
953 | void p_destroy(peer *p) | |
954 | { | |
0ba8de86 | 955 | ping *pg, *ppg; |
956 | ||
957 | T( trace(T_PEER, "peer: destroying peer `%s'", p->spec.name); ) | |
f43df819 | 958 | a_notify("KILL", "%s", p->spec.name, A_END); |
5bb41301 | 959 | ksl_free(&p->ks); |
410c8acf | 960 | kx_free(&p->kx); |
6411163d MW |
961 | if (p->spec.f & PSF_MOBILE) |
962 | nmobile--; | |
64cf2223 MW |
963 | if (p->ifname) |
964 | xfree(p->ifname); | |
48b84569 MW |
965 | if (p->spec.tag) |
966 | xfree(p->spec.tag); | |
42da2a58 | 967 | p->t->ops->destroy(p->t); |
0ba8de86 | 968 | if (p->spec.t_ka) |
969 | sel_rmtimer(&p->tka); | |
0ba8de86 | 970 | for (pg = p->pings; pg; pg = ppg) { |
971 | ppg = pg->next; | |
972 | p_pingdone(pg, PING_PEERDIED); | |
973 | } | |
c8e02c8a MW |
974 | sym_remove(&byname, p->byname); |
975 | am_remove(&byaddr, p->byaddr); | |
410c8acf | 976 | DESTROY(p); |
977 | } | |
978 | ||
c8e02c8a MW |
979 | /* --- @p_mkiter@ --- * |
980 | * | |
981 | * Arguments: @peer_iter *i@ = pointer to an iterator | |
982 | * | |
983 | * Returns: --- | |
984 | * | |
985 | * Use: Initializes the iterator. | |
986 | */ | |
987 | ||
988 | void p_mkiter(peer_iter *i) { sym_mkiter(&i->i, &byname); } | |
989 | ||
990 | /* --- @p_next@ --- * | |
991 | * | |
992 | * Arguments: @peer_iter *i@ = pointer to an iterator | |
410c8acf | 993 | * |
c8e02c8a | 994 | * Returns: Next peer, or null if at the end. |
410c8acf | 995 | * |
c8e02c8a | 996 | * Use: Returns the next peer. |
410c8acf | 997 | */ |
998 | ||
c8e02c8a MW |
999 | peer *p_next(peer_iter *i) |
1000 | { | |
1001 | peer_byname *pn; | |
1002 | ||
1003 | if ((pn = sym_next(&i->i)) == 0) | |
1004 | return (0); | |
1005 | return (pn->p); | |
1006 | } | |
410c8acf | 1007 | |
1008 | /*----- That's all, folks -------------------------------------------------*/ |