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