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