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