userv-ipif: Always request routes from userv, regardless of link quality
[secnet] / netlink.c
CommitLineData
2fe58dfd
SE
1/* User-kernel network link */
2
ff05a229 3/* See RFCs 791, 792, 1123 and 1812 */
2fe58dfd 4
ff05a229
SE
5/* The netlink device is actually a router. Tunnels are unnumbered
6 point-to-point lines (RFC1812 section 2.2.7); the router has a
7 single address (the 'router-id'). */
8
9/* This is where we currently have the anti-spoofing paranoia - before
10 sending a packet to the kernel we check that the tunnel it came
11 over could reasonably have produced it. */
12
13
14/* Points to note from RFC1812 (which may require changes in this
15 file):
16
173.3.4 Maximum Transmission Unit - MTU
18
19 The MTU of each logical interface MUST be configurable within the
20 range of legal MTUs for the interface.
21
22 Many Link Layer protocols define a maximum frame size that may be
23 sent. In such cases, a router MUST NOT allow an MTU to be set which
24 would allow sending of frames larger than those allowed by the Link
25 Layer protocol. However, a router SHOULD be willing to receive a
26 packet as large as the maximum frame size even if that is larger than
27 the MTU.
28
294.2.1 A router SHOULD count datagrams discarded.
30
314.2.2.1 Source route options - we probably should implement processing
32of source routes, even though mostly the security policy will prevent
33their use.
34
355.3.13.4 Source Route Options
36
37 A router MUST implement support for source route options in forwarded
38 packets. A router MAY implement a configuration option that, when
39 enabled, causes all source-routed packets to be discarded. However,
40 such an option MUST NOT be enabled by default.
41
425.3.13.5 Record Route Option
43
44 Routers MUST support the Record Route option in forwarded packets.
45
46 A router MAY provide a configuration option that, if enabled, will
47 cause the router to ignore (i.e., pass through unchanged) Record
48 Route options in forwarded packets. If provided, such an option MUST
49 default to enabling the record-route. This option should not affect
50 the processing of Record Route options in datagrams received by the
51 router itself (in particular, Record Route options in ICMP echo
52 requests will still be processed according to Section [4.3.3.6]).
53
545.3.13.6 Timestamp Option
55
56 Routers MUST support the timestamp option in forwarded packets. A
57 timestamp value MUST follow the rules given [INTRO:2].
58
59 If the flags field = 3 (timestamp and prespecified address), the
60 router MUST add its timestamp if the next prespecified address
61 matches any of the router's IP addresses. It is not necessary that
62 the prespecified address be either the address of the interface on
63 which the packet arrived or the address of the interface over which
64 it will be sent.
65
66
674.2.2.7 Fragmentation: RFC 791 Section 3.2
68
69 Fragmentation, as described in [INTERNET:1], MUST be supported by a
70 router.
71
724.2.2.8 Reassembly: RFC 791 Section 3.2
73
74 As specified in the corresponding section of [INTRO:2], a router MUST
75 support reassembly of datagrams that it delivers to itself.
76
774.2.2.9 Time to Live: RFC 791 Section 3.2
78
79 Note in particular that a router MUST NOT check the TTL of a packet
80 except when forwarding it.
81
82 A router MUST NOT discard a datagram just because it was received
83 with TTL equal to zero or one; if it is to the router and otherwise
84 valid, the router MUST attempt to receive it.
85
86 On messages the router originates, the IP layer MUST provide a means
87 for the transport layer to set the TTL field of every datagram that
88 is sent. When a fixed TTL value is used, it MUST be configurable.
89
90
918.1 The Simple Network Management Protocol - SNMP
928.1.1 SNMP Protocol Elements
93
94 Routers MUST be manageable by SNMP [MGT:3]. The SNMP MUST operate
95 using UDP/IP as its transport and network protocols.
96
97
98*/
2fe58dfd 99
3b83c932 100#include <string.h>
59230b9b
IJ
101#include <assert.h>
102#include <limits.h>
8689b3a9 103#include "secnet.h"
2fe58dfd 104#include "util.h"
7138d0c5 105#include "ipaddr.h"
9d3a4132 106#include "netlink.h"
042a8da9 107#include "process.h"
2fe58dfd 108
469fd1d9
SE
109#define OPT_SOFTROUTE 1
110#define OPT_ALLOWROUTE 2
111
ff05a229
SE
112#define ICMP_TYPE_ECHO_REPLY 0
113
114#define ICMP_TYPE_UNREACHABLE 3
115#define ICMP_CODE_NET_UNREACHABLE 0
116#define ICMP_CODE_PROTOCOL_UNREACHABLE 2
117#define ICMP_CODE_FRAGMENTATION_REQUIRED 4
118#define ICMP_CODE_NET_PROHIBITED 13
119
120#define ICMP_TYPE_ECHO_REQUEST 8
121
122#define ICMP_TYPE_TIME_EXCEEDED 11
123#define ICMP_CODE_TTL_EXCEEDED 0
124
4efd681a 125/* Generic IP checksum routine */
1caa23ff 126static inline uint16_t ip_csum(uint8_t *iph,int32_t count)
2fe58dfd 127{
4efd681a
SE
128 register uint32_t sum=0;
129
130 while (count>1) {
131 sum+=ntohs(*(uint16_t *)iph);
132 iph+=2;
133 count-=2;
134 }
135 if(count>0)
136 sum+=*(uint8_t *)iph;
137 while (sum>>16)
138 sum=(sum&0xffff)+(sum>>16);
139 return htons(~sum);
2fe58dfd
SE
140}
141
4efd681a
SE
142#ifdef i386
143/*
144 * This is a version of ip_compute_csum() optimized for IP headers,
145 * which always checksum on 4 octet boundaries.
146 *
147 * By Jorge Cwik <jorge@laser.satlink.net>, adapted for linux by
148 * Arnt Gulbrandsen.
149 */
1caa23ff 150static inline uint16_t ip_fast_csum(uint8_t *iph, int32_t ihl) {
4efd681a
SE
151 uint32_t sum;
152
20d324b6
SE
153 __asm__ __volatile__(
154 "movl (%1), %0 ;\n"
155 "subl $4, %2 ;\n"
156 "jbe 2f ;\n"
157 "addl 4(%1), %0 ;\n"
158 "adcl 8(%1), %0 ;\n"
159 "adcl 12(%1), %0 ;\n"
160"1: adcl 16(%1), %0 ;\n"
161 "lea 4(%1), %1 ;\n"
162 "decl %2 ;\n"
163 "jne 1b ;\n"
164 "adcl $0, %0 ;\n"
165 "movl %0, %2 ;\n"
166 "shrl $16, %0 ;\n"
167 "addw %w2, %w0 ;\n"
168 "adcl $0, %0 ;\n"
169 "notl %0 ;\n"
170"2: ;\n"
4efd681a
SE
171 /* Since the input registers which are loaded with iph and ipl
172 are modified, we must also specify them as outputs, or gcc
173 will assume they contain their original values. */
174 : "=r" (sum), "=r" (iph), "=r" (ihl)
20d324b6
SE
175 : "1" (iph), "2" (ihl)
176 : "memory");
4efd681a
SE
177 return sum;
178}
179#else
1caa23ff 180static inline uint16_t ip_fast_csum(uint8_t *iph, int32_t ihl)
2fe58dfd 181{
1caa23ff 182 assert(ihl < INT_MAX/4);
4efd681a
SE
183 return ip_csum(iph,ihl*4);
184}
185#endif
186
187struct iphdr {
188#if defined (WORDS_BIGENDIAN)
189 uint8_t version:4,
190 ihl:4;
191#else
192 uint8_t ihl:4,
193 version:4;
194#endif
195 uint8_t tos;
196 uint16_t tot_len;
197 uint16_t id;
198 uint16_t frag_off;
199 uint8_t ttl;
200 uint8_t protocol;
201 uint16_t check;
202 uint32_t saddr;
203 uint32_t daddr;
204 /* The options start here. */
205};
206
207struct icmphdr {
208 struct iphdr iph;
209 uint8_t type;
210 uint8_t code;
211 uint16_t check;
212 union {
213 uint32_t unused;
214 struct {
215 uint8_t pointer;
216 uint8_t unused1;
217 uint16_t unused2;
218 } pprob;
219 uint32_t gwaddr;
220 struct {
221 uint16_t id;
222 uint16_t seq;
223 } echo;
224 } d;
225};
226
70dc107b
SE
227static void netlink_packet_deliver(struct netlink *st,
228 struct netlink_client *client,
229 struct buffer_if *buf);
4efd681a 230
ff05a229
SE
231/* XXX RFC1812 4.3.2.5:
232 All other ICMP error messages (Destination Unreachable,
233 Redirect, Time Exceeded, and Parameter Problem) SHOULD have their
234 precedence value set to 6 (INTERNETWORK CONTROL) or 7 (NETWORK
235 CONTROL). The IP Precedence value for these error messages MAY be
236 settable.
237 */
4efd681a
SE
238static struct icmphdr *netlink_icmp_tmpl(struct netlink *st,
239 uint32_t dest,uint16_t len)
240{
241 struct icmphdr *h;
242
243 BUF_ALLOC(&st->icmp,"netlink_icmp_tmpl");
244 buffer_init(&st->icmp,st->max_start_pad);
245 h=buf_append(&st->icmp,sizeof(*h));
246
247 h->iph.version=4;
248 h->iph.ihl=5;
249 h->iph.tos=0;
250 h->iph.tot_len=htons(len+(h->iph.ihl*4)+8);
251 h->iph.id=0;
252 h->iph.frag_off=0;
ff05a229 253 h->iph.ttl=255; /* XXX should be configurable */
4efd681a
SE
254 h->iph.protocol=1;
255 h->iph.saddr=htonl(st->secnet_address);
256 h->iph.daddr=htonl(dest);
257 h->iph.check=0;
258 h->iph.check=ip_fast_csum((uint8_t *)&h->iph,h->iph.ihl);
259 h->check=0;
260 h->d.unused=0;
261
262 return h;
263}
264
265/* Fill in the ICMP checksum field correctly */
266static void netlink_icmp_csum(struct icmphdr *h)
267{
1caa23ff 268 int32_t len;
4efd681a
SE
269
270 len=ntohs(h->iph.tot_len)-(4*h->iph.ihl);
271 h->check=0;
272 h->check=ip_csum(&h->type,len);
273}
274
275/* RFC1122:
276 * An ICMP error message MUST NOT be sent as the result of
277 * receiving:
278 *
279 * * an ICMP error message, or
280 *
281 * * a datagram destined to an IP broadcast or IP multicast
282 * address, or
283 *
284 * * a datagram sent as a link-layer broadcast, or
285 *
286 * * a non-initial fragment, or
287 *
288 * * a datagram whose source address does not define a single
289 * host -- e.g., a zero address, a loopback address, a
290 * broadcast address, a multicast address, or a Class E
291 * address.
292 */
293static bool_t netlink_icmp_may_reply(struct buffer_if *buf)
294{
295 struct iphdr *iph;
8dea8d37 296 struct icmphdr *icmph;
4efd681a
SE
297 uint32_t source;
298
299 iph=(struct iphdr *)buf->start;
8dea8d37
SE
300 icmph=(struct icmphdr *)buf->start;
301 if (iph->protocol==1) {
302 switch(icmph->type) {
303 case 3: /* Destination unreachable */
304 case 11: /* Time Exceeded */
305 case 12: /* Parameter Problem */
306 return False;
307 }
308 }
4efd681a
SE
309 /* How do we spot broadcast destination addresses? */
310 if (ntohs(iph->frag_off)&0x1fff) return False; /* Non-initial fragment */
311 source=ntohl(iph->saddr);
312 if (source==0) return False;
313 if ((source&0xff000000)==0x7f000000) return False;
314 /* How do we spot broadcast source addresses? */
315 if ((source&0xf0000000)==0xe0000000) return False; /* Multicast */
316 if ((source&0xf0000000)==0xf0000000) return False; /* Class E */
317 return True;
318}
319
320/* How much of the original IP packet do we include in its ICMP
321 response? The header plus up to 64 bits. */
ff05a229
SE
322
323/* XXX TODO RFC1812:
3244.3.2.3 Original Message Header
325
326 Historically, every ICMP error message has included the Internet
327 header and at least the first 8 data bytes of the datagram that
328 triggered the error. This is no longer adequate, due to the use of
329 IP-in-IP tunneling and other technologies. Therefore, the ICMP
330 datagram SHOULD contain as much of the original datagram as possible
331 without the length of the ICMP datagram exceeding 576 bytes. The
332 returned IP header (and user data) MUST be identical to that which
333 was received, except that the router is not required to undo any
334 modifications to the IP header that are normally performed in
335 forwarding that were performed before the error was detected (e.g.,
336 decrementing the TTL, or updating options). Note that the
337 requirements of Section [4.3.3.5] supersede this requirement in some
338 cases (i.e., for a Parameter Problem message, if the problem is in a
339 modified field, the router must undo the modification). See Section
340 [4.3.3.5]).
341 */
4efd681a
SE
342static uint16_t netlink_icmp_reply_len(struct buffer_if *buf)
343{
344 struct iphdr *iph=(struct iphdr *)buf->start;
345 uint16_t hlen,plen;
346
347 hlen=iph->ihl*4;
348 /* We include the first 8 bytes of the packet data, provided they exist */
349 hlen+=8;
350 plen=ntohs(iph->tot_len);
351 return (hlen>plen?plen:hlen);
352}
353
70dc107b
SE
354/* client indicates where the packet we're constructing a response to
355 comes from. NULL indicates the host. */
4efd681a 356static void netlink_icmp_simple(struct netlink *st, struct buffer_if *buf,
70dc107b 357 struct netlink_client *client,
4efd681a
SE
358 uint8_t type, uint8_t code)
359{
360 struct iphdr *iph=(struct iphdr *)buf->start;
361 struct icmphdr *h;
362 uint16_t len;
363
364 if (netlink_icmp_may_reply(buf)) {
365 len=netlink_icmp_reply_len(buf);
366 h=netlink_icmp_tmpl(st,ntohl(iph->saddr),len);
367 h->type=type; h->code=code;
368 memcpy(buf_append(&st->icmp,len),buf->start,len);
369 netlink_icmp_csum(h);
70dc107b 370 netlink_packet_deliver(st,NULL,&st->icmp);
4efd681a
SE
371 BUF_ASSERT_FREE(&st->icmp);
372 }
373}
374
375/*
376 * RFC1122: 3.1.2.2 MUST silently discard any IP frame that fails the
377 * checksum.
ff05a229 378 * RFC1812: 4.2.2.5 MUST discard messages containing invalid checksums.
4efd681a
SE
379 *
380 * Is the datagram acceptable?
381 *
382 * 1. Length at least the size of an ip header
383 * 2. Version of 4
384 * 3. Checksums correctly.
385 * 4. Doesn't have a bogus length
386 */
387static bool_t netlink_check(struct netlink *st, struct buffer_if *buf)
388{
389 struct iphdr *iph=(struct iphdr *)buf->start;
1caa23ff 390 int32_t len;
4efd681a 391
9d3a4132
SE
392 if (iph->ihl < 5 || iph->version != 4) return False;
393 if (buf->size < iph->ihl*4) return False;
394 if (ip_fast_csum((uint8_t *)iph, iph->ihl)!=0) return False;
4efd681a
SE
395 len=ntohs(iph->tot_len);
396 /* There should be no padding */
9d3a4132 397 if (buf->size!=len || len<(iph->ihl<<2)) return False;
4efd681a
SE
398 /* XXX check that there's no source route specified */
399 return True;
400}
401
469fd1d9 402/* Deliver a packet. "client" is the _origin_ of the packet, not its
d3fe100d
SE
403 destination, and is NULL for packets from the host and packets
404 generated internally in secnet. */
70dc107b
SE
405static void netlink_packet_deliver(struct netlink *st,
406 struct netlink_client *client,
407 struct buffer_if *buf)
4efd681a
SE
408{
409 struct iphdr *iph=(struct iphdr *)buf->start;
410 uint32_t dest=ntohl(iph->daddr);
70dc107b
SE
411 uint32_t source=ntohl(iph->saddr);
412 uint32_t best_quality;
469fd1d9
SE
413 bool_t allow_route=False;
414 bool_t found_allowed=False;
70dc107b
SE
415 int best_match;
416 int i;
2fe58dfd 417
4efd681a 418 BUF_ASSERT_USED(buf);
2fe58dfd 419
4efd681a 420 if (dest==st->secnet_address) {
4f5e39ec 421 Message(M_ERR,"%s: trying to deliver a packet to myself!\n",st->name);
4efd681a 422 BUF_FREE(buf);
2fe58dfd
SE
423 return;
424 }
4efd681a 425
d3fe100d 426 /* Packets from the host (client==NULL) may always be routed. Packets
469fd1d9
SE
427 from clients with the allow_route option will also be routed. */
428 if (!client || (client && (client->options & OPT_ALLOWROUTE)))
429 allow_route=True;
430
431 /* If !allow_route, we check the routing table anyway, and if
432 there's a suitable route with OPT_ALLOWROUTE set we use it. If
433 there's a suitable route, but none with OPT_ALLOWROUTE set then
434 we generate ICMP 'communication with destination network
435 administratively prohibited'. */
436
437 best_quality=0;
438 best_match=-1;
d3fe100d
SE
439 for (i=0; i<st->n_clients; i++) {
440 if (st->routes[i]->up &&
441 ipset_contains_addr(st->routes[i]->networks,dest)) {
469fd1d9
SE
442 /* It's an available route to the correct destination. But is
443 it better than the one we already have? */
444
445 /* If we have already found an allowed route then we don't
446 bother looking at routes we're not allowed to use. If
447 we don't yet have an allowed route we'll consider any. */
448 if (!allow_route && found_allowed) {
d3fe100d 449 if (!(st->routes[i]->options&OPT_ALLOWROUTE)) continue;
70dc107b 450 }
469fd1d9 451
d3fe100d 452 if (st->routes[i]->link_quality>best_quality
469fd1d9 453 || best_quality==0) {
d3fe100d 454 best_quality=st->routes[i]->link_quality;
469fd1d9 455 best_match=i;
d3fe100d 456 if (st->routes[i]->options&OPT_ALLOWROUTE)
469fd1d9
SE
457 found_allowed=True;
458 /* If quality isn't perfect we may wish to
459 consider kicking the tunnel with a 0-length
460 packet to prompt it to perform a key setup.
461 Then it'll eventually decide it's up or
462 down. */
463 /* If quality is perfect and we're allowed to use the
464 route we don't need to search any more. */
465 if (best_quality>=MAXIMUM_LINK_QUALITY &&
466 (allow_route || found_allowed)) break;
4efd681a 467 }
70dc107b 468 }
469fd1d9
SE
469 }
470 if (best_match==-1) {
471 /* The packet's not going down a tunnel. It might (ought to)
472 be for the host. */
794f2398 473 if (ipset_contains_addr(st->networks,dest)) {
469fd1d9
SE
474 st->deliver_to_host(st->dst,buf);
475 st->outcount++;
70dc107b
SE
476 BUF_ASSERT_FREE(buf);
477 } else {
469fd1d9
SE
478 string_t s,d;
479 s=ipaddr_to_string(source);
480 d=ipaddr_to_string(dest);
ff05a229 481 Message(M_DEBUG,"%s: don't know where to deliver packet "
469fd1d9
SE
482 "(s=%s, d=%s)\n", st->name, s, d);
483 free(s); free(d);
ff05a229
SE
484 netlink_icmp_simple(st,buf,client,ICMP_TYPE_UNREACHABLE,
485 ICMP_CODE_NET_UNREACHABLE);
70dc107b 486 BUF_FREE(buf);
2fe58dfd 487 }
469fd1d9
SE
488 } else {
489 if (!allow_route &&
d3fe100d 490 !(st->routes[best_match]->options&OPT_ALLOWROUTE)) {
469fd1d9
SE
491 string_t s,d;
492 s=ipaddr_to_string(source);
493 d=ipaddr_to_string(dest);
494 /* We have a usable route but aren't allowed to use it.
495 Generate ICMP destination unreachable: communication
496 with destination network administratively prohibited */
497 Message(M_NOTICE,"%s: denied forwarding for packet (s=%s, d=%s)\n",
498 st->name,s,d);
499 free(s); free(d);
500
ff05a229
SE
501 netlink_icmp_simple(st,buf,client,ICMP_TYPE_UNREACHABLE,
502 ICMP_CODE_NET_PROHIBITED);
469fd1d9 503 BUF_FREE(buf);
469fd1d9 504 } else {
ea7ec970
SE
505 if (best_quality>0) {
506 /* XXX Fragment if required */
507 st->routes[best_match]->deliver(
508 st->routes[best_match]->dst, buf);
509 st->routes[best_match]->outcount++;
510 BUF_ASSERT_FREE(buf);
511 } else {
512 /* Generate ICMP destination unreachable */
513 netlink_icmp_simple(st,buf,client,ICMP_TYPE_UNREACHABLE,
514 ICMP_CODE_NET_UNREACHABLE); /* client==NULL */
515 BUF_FREE(buf);
516 }
469fd1d9 517 }
2fe58dfd 518 }
70dc107b 519 BUF_ASSERT_FREE(buf);
4efd681a
SE
520}
521
70dc107b
SE
522static void netlink_packet_forward(struct netlink *st,
523 struct netlink_client *client,
524 struct buffer_if *buf)
4efd681a
SE
525{
526 struct iphdr *iph=(struct iphdr *)buf->start;
527
528 BUF_ASSERT_USED(buf);
529
530 /* Packet has already been checked */
531 if (iph->ttl<=1) {
532 /* Generate ICMP time exceeded */
ff05a229
SE
533 netlink_icmp_simple(st,buf,client,ICMP_TYPE_TIME_EXCEEDED,
534 ICMP_CODE_TTL_EXCEEDED);
4efd681a
SE
535 BUF_FREE(buf);
536 return;
537 }
538 iph->ttl--;
539 iph->check=0;
540 iph->check=ip_fast_csum((uint8_t *)iph,iph->ihl);
541
70dc107b 542 netlink_packet_deliver(st,client,buf);
4efd681a
SE
543 BUF_ASSERT_FREE(buf);
544}
545
9d3a4132 546/* Deal with packets addressed explicitly to us */
70dc107b
SE
547static void netlink_packet_local(struct netlink *st,
548 struct netlink_client *client,
549 struct buffer_if *buf)
4efd681a
SE
550{
551 struct icmphdr *h;
552
469fd1d9
SE
553 st->localcount++;
554
4efd681a
SE
555 h=(struct icmphdr *)buf->start;
556
557 if ((ntohs(h->iph.frag_off)&0xbfff)!=0) {
9d3a4132
SE
558 Message(M_WARNING,"%s: fragmented packet addressed to secnet; "
559 "ignoring it\n",st->name);
4efd681a
SE
560 BUF_FREE(buf);
561 return;
562 }
563
564 if (h->iph.protocol==1) {
565 /* It's ICMP */
ff05a229 566 if (h->type==ICMP_TYPE_ECHO_REQUEST && h->code==0) {
4efd681a
SE
567 /* ICMP echo-request. Special case: we re-use the buffer
568 to construct the reply. */
ff05a229 569 h->type=ICMP_TYPE_ECHO_REPLY;
4efd681a
SE
570 h->iph.daddr=h->iph.saddr;
571 h->iph.saddr=htonl(st->secnet_address);
ff05a229 572 h->iph.ttl=255;
4efd681a
SE
573 h->iph.check=0;
574 h->iph.check=ip_fast_csum((uint8_t *)h,h->iph.ihl);
575 netlink_icmp_csum(h);
70dc107b 576 netlink_packet_deliver(st,NULL,buf);
4efd681a
SE
577 return;
578 }
579 Message(M_WARNING,"%s: unknown incoming ICMP\n",st->name);
580 } else {
581 /* Send ICMP protocol unreachable */
ff05a229
SE
582 netlink_icmp_simple(st,buf,client,ICMP_TYPE_UNREACHABLE,
583 ICMP_CODE_PROTOCOL_UNREACHABLE);
4efd681a
SE
584 BUF_FREE(buf);
585 return;
586 }
587
588 BUF_FREE(buf);
589}
590
9d3a4132
SE
591/* If cid==NULL packet is from host, otherwise cid specifies which tunnel
592 it came from. */
469fd1d9
SE
593static void netlink_incoming(struct netlink *st, struct netlink_client *client,
594 struct buffer_if *buf)
4efd681a 595{
4efd681a
SE
596 uint32_t source,dest;
597 struct iphdr *iph;
598
599 BUF_ASSERT_USED(buf);
600 if (!netlink_check(st,buf)) {
9d3a4132
SE
601 Message(M_WARNING,"%s: bad IP packet from %s\n",
602 st->name,client?client->name:"host");
4efd681a
SE
603 BUF_FREE(buf);
604 return;
605 }
606 iph=(struct iphdr *)buf->start;
607
608 source=ntohl(iph->saddr);
609 dest=ntohl(iph->daddr);
610
d3fe100d
SE
611 /* Check source. If we don't like the source, there's no point
612 generating ICMP because we won't know how to get it to the
613 source of the packet. */
9d3a4132 614 if (client) {
c6f79b17
SE
615 /* Check that the packet source is appropriate for the tunnel
616 it came down */
794f2398 617 if (!ipset_contains_addr(client->networks,source)) {
9d3a4132
SE
618 string_t s,d;
619 s=ipaddr_to_string(source);
620 d=ipaddr_to_string(dest);
621 Message(M_WARNING,"%s: packet from tunnel %s with bad "
622 "source address (s=%s,d=%s)\n",st->name,client->name,s,d);
623 free(s); free(d);
624 BUF_FREE(buf);
625 return;
626 }
627 } else {
c6f79b17
SE
628 /* Check that the packet originates in our configured local
629 network, and hasn't been forwarded from elsewhere or
630 generated with the wrong source address */
794f2398 631 if (!ipset_contains_addr(st->networks,source)) {
9d3a4132
SE
632 string_t s,d;
633 s=ipaddr_to_string(source);
634 d=ipaddr_to_string(dest);
635 Message(M_WARNING,"%s: outgoing packet with bad source address "
636 "(s=%s,d=%s)\n",st->name,s,d);
637 free(s); free(d);
638 BUF_FREE(buf);
639 return;
640 }
4efd681a 641 }
c6f79b17 642
794f2398
SE
643 /* If this is a point-to-point device we don't examine the
644 destination address at all; we blindly send it down our
645 one-and-only registered tunnel, or to the host, depending on
d3fe100d
SE
646 where it came from. It's up to external software to check
647 address validity and generate ICMP, etc. */
c6f79b17
SE
648 if (st->ptp) {
649 if (client) {
469fd1d9 650 st->deliver_to_host(st->dst,buf);
c6f79b17 651 } else {
469fd1d9 652 st->clients->deliver(st->clients->dst,buf);
c6f79b17
SE
653 }
654 BUF_ASSERT_FREE(buf);
655 return;
656 }
657
d3fe100d
SE
658 /* st->secnet_address needs checking before matching destination
659 addresses */
2fe58dfd 660 if (dest==st->secnet_address) {
9d3a4132 661 netlink_packet_local(st,client,buf);
4efd681a 662 BUF_ASSERT_FREE(buf);
2fe58dfd
SE
663 return;
664 }
70dc107b 665 netlink_packet_forward(st,client,buf);
4efd681a
SE
666 BUF_ASSERT_FREE(buf);
667}
668
469fd1d9
SE
669static void netlink_inst_incoming(void *sst, struct buffer_if *buf)
670{
671 struct netlink_client *c=sst;
672 struct netlink *st=c->nst;
673
674 netlink_incoming(st,c,buf);
675}
676
677static void netlink_dev_incoming(void *sst, struct buffer_if *buf)
678{
679 struct netlink *st=sst;
680
681 netlink_incoming(st,NULL,buf);
682}
683
d3fe100d 684static void netlink_set_quality(void *sst, uint32_t quality)
4efd681a 685{
d3fe100d
SE
686 struct netlink_client *c=sst;
687 struct netlink *st=c->nst;
4efd681a 688
d3fe100d
SE
689 c->link_quality=quality;
690 c->up=(c->link_quality==LINK_QUALITY_DOWN)?False:True;
691 if (c->options&OPT_SOFTROUTE) {
692 st->set_routes(st->dst,c);
4efd681a 693 }
4efd681a
SE
694}
695
d3fe100d
SE
696static void netlink_output_subnets(struct netlink *st, uint32_t loglevel,
697 struct subnet_list *snets)
4efd681a 698{
1caa23ff 699 int32_t i;
d3fe100d 700 string_t net;
4efd681a 701
d3fe100d
SE
702 for (i=0; i<snets->entries; i++) {
703 net=subnet_to_string(snets->list[i]);
704 Message(loglevel,"%s ",net);
705 free(net);
9d3a4132 706 }
4efd681a
SE
707}
708
042a8da9 709static void netlink_dump_routes(struct netlink *st, bool_t requested)
9d3a4132
SE
710{
711 int i;
712 string_t net;
042a8da9 713 uint32_t c=M_INFO;
9d3a4132 714
042a8da9 715 if (requested) c=M_WARNING;
469fd1d9
SE
716 if (st->ptp) {
717 net=ipaddr_to_string(st->secnet_address);
718 Message(c,"%s: point-to-point (remote end is %s); routes:\n",
719 st->name, net);
9d3a4132 720 free(net);
d3fe100d 721 netlink_output_subnets(st,c,st->clients->subnets);
469fd1d9
SE
722 Message(c,"\n");
723 } else {
724 Message(c,"%s: routing table:\n",st->name);
d3fe100d
SE
725 for (i=0; i<st->n_clients; i++) {
726 netlink_output_subnets(st,c,st->routes[i]->subnets);
ff05a229 727 Message(c,"-> tunnel %s (%s,mtu %d,%s routes,%s,"
ea7ec970 728 "quality %d,use %d,pri %lu)\n",
d3fe100d 729 st->routes[i]->name,
ff05a229
SE
730 st->routes[i]->up?"up":"down",
731 st->routes[i]->mtu,
d3fe100d
SE
732 st->routes[i]->options&OPT_SOFTROUTE?"soft":"hard",
733 st->routes[i]->options&OPT_ALLOWROUTE?"free":"restricted",
d3fe100d 734 st->routes[i]->link_quality,
ea7ec970
SE
735 st->routes[i]->outcount,
736 (unsigned long)st->routes[i]->priority);
469fd1d9
SE
737 }
738 net=ipaddr_to_string(st->secnet_address);
739 Message(c,"%s/32 -> netlink \"%s\" (use %d)\n",
740 net,st->name,st->localcount);
9d3a4132 741 free(net);
794f2398
SE
742 for (i=0; i<st->subnets->entries; i++) {
743 net=subnet_to_string(st->subnets->list[i]);
744 Message(c,"%s ",net);
469fd1d9
SE
745 free(net);
746 }
794f2398
SE
747 if (i>0)
748 Message(c,"-> host (use %d)\n",st->outcount);
9d3a4132
SE
749 }
750}
751
d3fe100d
SE
752/* ap is a pointer to a member of the routes array */
753static int netlink_compare_client_priority(const void *ap, const void *bp)
70dc107b 754{
d3fe100d
SE
755 const struct netlink_client *const*a=ap;
756 const struct netlink_client *const*b=bp;
70dc107b 757
d3fe100d
SE
758 if ((*a)->priority==(*b)->priority) return 0;
759 if ((*a)->priority<(*b)->priority) return 1;
70dc107b
SE
760 return -1;
761}
762
763static void netlink_phase_hook(void *sst, uint32_t new_phase)
764{
765 struct netlink *st=sst;
766 struct netlink_client *c;
1caa23ff 767 int32_t i;
70dc107b
SE
768
769 /* All the networks serviced by the various tunnels should now
770 * have been registered. We build a routing table by sorting the
d3fe100d 771 * clients by priority. */
bb9d0561
IJ
772 st->routes=safe_malloc_ary(sizeof(*st->routes),st->n_clients,
773 "netlink_phase_hook");
70dc107b
SE
774 /* Fill the table */
775 i=0;
59230b9b
IJ
776 for (c=st->clients; c; c=c->next) {
777 assert(i<INT_MAX);
d3fe100d 778 st->routes[i++]=c;
59230b9b 779 }
d3fe100d
SE
780 /* Sort the table in descending order of priority */
781 qsort(st->routes,st->n_clients,sizeof(*st->routes),
782 netlink_compare_client_priority);
9d3a4132 783
042a8da9
SE
784 netlink_dump_routes(st,False);
785}
786
787static void netlink_signal_handler(void *sst, int signum)
788{
789 struct netlink *st=sst;
790 Message(M_INFO,"%s: route dump requested by SIGUSR1\n",st->name);
791 netlink_dump_routes(st,True);
70dc107b
SE
792}
793
794f2398
SE
794static void netlink_inst_output_config(void *sst, struct buffer_if *buf)
795{
796/* struct netlink_client *c=sst; */
797/* struct netlink *st=c->nst; */
798
799 /* For now we don't output anything */
800 BUF_ASSERT_USED(buf);
801}
802
803static bool_t netlink_inst_check_config(void *sst, struct buffer_if *buf)
804{
805/* struct netlink_client *c=sst; */
806/* struct netlink *st=c->nst; */
807
808 BUF_ASSERT_USED(buf);
809 /* We need to eat all of the configuration information from the buffer
810 for backward compatibility. */
811 buf->size=0;
812 return True;
813}
814
1caa23ff 815static void netlink_inst_set_mtu(void *sst, int32_t new_mtu)
d3fe100d
SE
816{
817 struct netlink_client *c=sst;
818
819 c->mtu=new_mtu;
820}
821
469fd1d9 822static void netlink_inst_reg(void *sst, netlink_deliver_fn *deliver,
1caa23ff
IJ
823 void *dst, int32_t max_start_pad,
824 int32_t max_end_pad)
469fd1d9
SE
825{
826 struct netlink_client *c=sst;
827 struct netlink *st=c->nst;
828
829 if (max_start_pad > st->max_start_pad) st->max_start_pad=max_start_pad;
830 if (max_end_pad > st->max_end_pad) st->max_end_pad=max_end_pad;
831 c->deliver=deliver;
832 c->dst=dst;
833}
834
835static struct flagstr netlink_option_table[]={
836 { "soft", OPT_SOFTROUTE },
837 { "allow-route", OPT_ALLOWROUTE },
838 { NULL, 0}
839};
840/* This is the routine that gets called when the closure that's
841 returned by an invocation of a netlink device closure (eg. tun,
842 userv-ipif) is invoked. It's used to create routes and pass in
843 information about them; the closure it returns is used by site
844 code. */
845static closure_t *netlink_inst_create(struct netlink *st,
846 struct cloc loc, dict_t *dict)
847{
848 struct netlink_client *c;
849 string_t name;
794f2398 850 struct ipset *networks;
1caa23ff
IJ
851 uint32_t options,priority;
852 int32_t mtu;
794f2398 853 list_t *l;
469fd1d9
SE
854
855 name=dict_read_string(dict, "name", True, st->name, loc);
856
794f2398
SE
857 l=dict_lookup(dict,"routes");
858 if (!l)
859 cfgfatal(loc,st->name,"required parameter \"routes\" not found\n");
860 networks=string_list_to_ipset(l,loc,st->name,"routes");
469fd1d9
SE
861 options=string_list_to_word(dict_lookup(dict,"options"),
862 netlink_option_table,st->name);
863
d3fe100d
SE
864 priority=dict_read_number(dict,"priority",False,st->name,loc,0);
865 mtu=dict_read_number(dict,"mtu",False,st->name,loc,0);
866
867 if ((options&OPT_SOFTROUTE) && !st->set_routes) {
469fd1d9
SE
868 cfgfatal(loc,st->name,"this netlink device does not support "
869 "soft routes.\n");
870 return NULL;
871 }
872
873 if (options&OPT_SOFTROUTE) {
874 /* XXX for now we assume that soft routes require root privilege;
875 this may not always be true. The device driver can tell us. */
876 require_root_privileges=True;
877 require_root_privileges_explanation="netlink: soft routes";
878 if (st->ptp) {
879 cfgfatal(loc,st->name,"point-to-point netlinks do not support "
880 "soft routes.\n");
881 return NULL;
882 }
883 }
884
794f2398
SE
885 /* Check that nets are a subset of st->remote_networks;
886 refuse to register if they are not. */
887 if (!ipset_is_subset(st->remote_networks,networks)) {
888 cfgfatal(loc,st->name,"routes are not allowed\n");
469fd1d9
SE
889 return NULL;
890 }
891
892 c=safe_malloc(sizeof(*c),"netlink_inst_create");
893 c->cl.description=name;
894 c->cl.type=CL_NETLINK;
895 c->cl.apply=NULL;
896 c->cl.interface=&c->ops;
897 c->ops.st=c;
898 c->ops.reg=netlink_inst_reg;
899 c->ops.deliver=netlink_inst_incoming;
900 c->ops.set_quality=netlink_set_quality;
794f2398
SE
901 c->ops.output_config=netlink_inst_output_config;
902 c->ops.check_config=netlink_inst_check_config;
d3fe100d 903 c->ops.set_mtu=netlink_inst_set_mtu;
469fd1d9
SE
904 c->nst=st;
905
906 c->networks=networks;
794f2398 907 c->subnets=ipset_to_subnet_list(networks);
d3fe100d 908 c->priority=priority;
469fd1d9
SE
909 c->deliver=NULL;
910 c->dst=NULL;
911 c->name=name;
469fd1d9 912 c->link_quality=LINK_QUALITY_DOWN;
d3fe100d
SE
913 c->mtu=mtu?mtu:st->mtu;
914 c->options=options;
915 c->outcount=0;
916 c->up=False;
917 c->kup=False;
469fd1d9
SE
918 c->next=st->clients;
919 st->clients=c;
59230b9b 920 assert(st->n_clients < INT_MAX);
d3fe100d 921 st->n_clients++;
469fd1d9
SE
922
923 return &c->cl;
924}
925
926static list_t *netlink_inst_apply(closure_t *self, struct cloc loc,
927 dict_t *context, list_t *args)
928{
929 struct netlink *st=self->interface;
930
931 dict_t *dict;
932 item_t *item;
933 closure_t *cl;
934
469fd1d9
SE
935 item=list_elem(args,0);
936 if (!item || item->type!=t_dict) {
937 cfgfatal(loc,st->name,"must have a dictionary argument\n");
938 }
939 dict=item->data.dict;
940
941 cl=netlink_inst_create(st,loc,dict);
942
943 return new_closure(cl);
944}
945
9d3a4132
SE
946netlink_deliver_fn *netlink_init(struct netlink *st,
947 void *dst, struct cloc loc,
fe5e9cc4 948 dict_t *dict, cstring_t description,
d3fe100d 949 netlink_route_fn *set_routes,
9d3a4132 950 netlink_deliver_fn *to_host)
4efd681a 951{
c6f79b17 952 item_t *sa, *ptpa;
794f2398 953 list_t *l;
c6f79b17 954
4efd681a
SE
955 st->dst=dst;
956 st->cl.description=description;
469fd1d9
SE
957 st->cl.type=CL_PURE;
958 st->cl.apply=netlink_inst_apply;
959 st->cl.interface=st;
4efd681a
SE
960 st->max_start_pad=0;
961 st->max_end_pad=0;
962 st->clients=NULL;
d3fe100d
SE
963 st->routes=NULL;
964 st->n_clients=0;
965 st->set_routes=set_routes;
4efd681a
SE
966 st->deliver_to_host=to_host;
967
794f2398 968 st->name=dict_read_string(dict,"name",False,description,loc);
4efd681a 969 if (!st->name) st->name=description;
794f2398
SE
970 l=dict_lookup(dict,"networks");
971 if (l)
972 st->networks=string_list_to_ipset(l,loc,st->name,"networks");
973 else {
4f5e39ec
SE
974 struct ipset *empty;
975 empty=ipset_new();
976 st->networks=ipset_complement(empty);
977 ipset_free(empty);
794f2398
SE
978 }
979 l=dict_lookup(dict,"remote-networks");
980 if (l) {
981 st->remote_networks=string_list_to_ipset(l,loc,st->name,
982 "remote-networks");
983 } else {
984 struct ipset *empty;
985 empty=ipset_new();
986 st->remote_networks=ipset_complement(empty);
987 ipset_free(empty);
988 }
989
c6f79b17 990 sa=dict_find_item(dict,"secnet-address",False,"netlink",loc);
469fd1d9 991 ptpa=dict_find_item(dict,"ptp-address",False,"netlink",loc);
c6f79b17
SE
992 if (sa && ptpa) {
993 cfgfatal(loc,st->name,"you may not specify secnet-address and "
994 "ptp-address in the same netlink device\n");
995 }
996 if (!(sa || ptpa)) {
997 cfgfatal(loc,st->name,"you must specify secnet-address or "
998 "ptp-address for this netlink device\n");
999 }
1000 if (sa) {
794f2398 1001 st->secnet_address=string_item_to_ipaddr(sa,"netlink");
c6f79b17
SE
1002 st->ptp=False;
1003 } else {
794f2398 1004 st->secnet_address=string_item_to_ipaddr(ptpa,"netlink");
c6f79b17
SE
1005 st->ptp=True;
1006 }
d3fe100d
SE
1007 /* To be strictly correct we could subtract secnet_address from
1008 networks here. It shouldn't make any practical difference,
794f2398
SE
1009 though, and will make the route dump look complicated... */
1010 st->subnets=ipset_to_subnet_list(st->networks);
4efd681a
SE
1011 st->mtu=dict_read_number(dict, "mtu", False, "netlink", loc, DEFAULT_MTU);
1012 buffer_new(&st->icmp,ICMP_BUFSIZE);
469fd1d9
SE
1013 st->outcount=0;
1014 st->localcount=0;
70dc107b
SE
1015
1016 add_hook(PHASE_SETUP,netlink_phase_hook,st);
042a8da9 1017 request_signal_notification(SIGUSR1, netlink_signal_handler, st);
4efd681a 1018
469fd1d9
SE
1019 /* If we're point-to-point then we return a CL_NETLINK directly,
1020 rather than a CL_NETLINK_OLD or pure closure (depending on
1021 compatibility). This CL_NETLINK is for our one and only
1022 client. Our cl.apply function is NULL. */
1023 if (st->ptp) {
1024 closure_t *cl;
1025 cl=netlink_inst_create(st,loc,dict);
1026 st->cl=*cl;
1027 }
1028 return netlink_dev_incoming;
2fe58dfd
SE
1029}
1030
9d3a4132 1031/* No connection to the kernel at all... */
2fe58dfd 1032
9d3a4132 1033struct null {
4efd681a 1034 struct netlink nl;
4efd681a 1035};
2fe58dfd 1036
d3fe100d 1037static bool_t null_set_route(void *sst, struct netlink_client *routes)
4efd681a 1038{
9d3a4132 1039 struct null *st=sst;
d3fe100d
SE
1040
1041 if (routes->up!=routes->kup) {
1042 Message(M_INFO,"%s: setting routes for tunnel %s to state %s\n",
1043 st->nl.name,routes->name,
1044 routes->up?"up":"down");
1045 routes->kup=routes->up;
9d3a4132 1046 return True;
2fe58dfd 1047 }
9d3a4132 1048 return False;
2fe58dfd 1049}
9d3a4132 1050
469fd1d9 1051static void null_deliver(void *sst, struct buffer_if *buf)
2fe58dfd
SE
1052{
1053 return;
1054}
1055
1056static list_t *null_apply(closure_t *self, struct cloc loc, dict_t *context,
1057 list_t *args)
1058{
1059 struct null *st;
4efd681a
SE
1060 item_t *item;
1061 dict_t *dict;
2fe58dfd 1062
4efd681a 1063 st=safe_malloc(sizeof(*st),"null_apply");
2fe58dfd 1064
4efd681a
SE
1065 item=list_elem(args,0);
1066 if (!item || item->type!=t_dict)
1067 cfgfatal(loc,"null-netlink","parameter must be a dictionary\n");
1068
1069 dict=item->data.dict;
1070
9d3a4132
SE
1071 netlink_init(&st->nl,st,loc,dict,"null-netlink",null_set_route,
1072 null_deliver);
4efd681a
SE
1073
1074 return new_closure(&st->nl.cl);
2fe58dfd
SE
1075}
1076
2fe58dfd
SE
1077void netlink_module(dict_t *dict)
1078{
4efd681a 1079 add_closure(dict,"null-netlink",null_apply);
2fe58dfd 1080}