blob: eff808d69964540d61b26f7cfa1b8e94fb479385 [file] [log] [blame]
Harald Weltec5efb5b2018-04-25 17:38:51 +02001/*
2 * TUN interface functions.
3 * Copyright (C) 2002, 2003, 2004 Mondru AB.
4 * Copyright (C) 2017-2018 by Harald Welte <laforge@gnumonks.org>
5 *
6 * The contents of this file may be used under the terms of the GNU
7 * General Public License Version 2, provided that the above copyright
8 * notice and this permission notice is included in all copies or
9 * substantial portions of the software.
10 *
11 */
12
13/*
14 * netdev.c: Contains generic network device related functionality.
15 */
16
17#include <stdio.h>
18#include <stdlib.h>
19#include <sys/types.h>
20#include <sys/socket.h>
21#include <netinet/in.h>
22#include <arpa/inet.h>
23#include <sys/stat.h>
24#include <sys/time.h>
25#include <unistd.h>
26#include <string.h>
27#include <errno.h>
28#include <fcntl.h>
29
30#include <stdio.h>
31#include <fcntl.h>
32#include <unistd.h>
33#include <sys/time.h>
34#include <sys/ioctl.h>
35#include <sys/socket.h>
36#include <errno.h>
37#include <net/route.h>
38#include <net/if.h>
39
40#if defined(__linux__)
41#include <linux/netlink.h>
42#include <linux/rtnetlink.h>
43
44#elif defined (__FreeBSD__)
45#include <net/if_var.h>
46#include <netinet/in_var.h>
47
48#elif defined (__APPLE__)
49#include <net/if.h>
50
51#else
52#error "Unknown platform!"
53#endif
54
55#include "netdev.h"
56#include "syserr.h"
57
58#if defined(__linux__)
59
60#include <linux/ipv6.h>
61
62static int netdev_nlattr(struct nlmsghdr *n, int nsize, int type, void *d, int dlen)
63{
64 int len = RTA_LENGTH(dlen);
65 int alen = NLMSG_ALIGN(n->nlmsg_len);
66 struct rtattr *rta = (struct rtattr *)(((void *)n) + alen);
67 if (alen + len > nsize)
68 return -1;
69 rta->rta_len = len;
70 rta->rta_type = type;
71 memcpy(RTA_DATA(rta), d, dlen);
72 n->nlmsg_len = alen + len;
73 return 0;
74}
75#endif
76
77static int netdev_sifflags(const char *devname, int flags)
78{
79 struct ifreq ifr;
80 int fd;
81
82 memset(&ifr, '\0', sizeof(ifr));
83 ifr.ifr_flags = flags;
84 strncpy(ifr.ifr_name, devname, IFNAMSIZ);
85 ifr.ifr_name[IFNAMSIZ - 1] = 0; /* Make sure to terminate */
86 if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
87 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
88 return -1;
89 }
90 if (ioctl(fd, SIOCSIFFLAGS, &ifr)) {
91 SYS_ERR(DTUN, LOGL_ERROR, errno,
92 "ioctl(SIOCSIFFLAGS) failed");
93 close(fd);
94 return -1;
95 }
96 close(fd);
97 return 0;
98}
99
100int netdev_setaddr4(const char *devname, struct in_addr *addr,
101 struct in_addr *dstaddr, struct in_addr *netmask)
102{
103 struct ifreq ifr;
104 int fd;
105
106 memset(&ifr, '\0', sizeof(ifr));
107 ifr.ifr_addr.sa_family = AF_INET;
108 ifr.ifr_dstaddr.sa_family = AF_INET;
109
110#if defined(__linux__)
111 ifr.ifr_netmask.sa_family = AF_INET;
112
113#elif defined(__FreeBSD__) || defined (__APPLE__)
114 ((struct sockaddr_in *)&ifr.ifr_addr)->sin_len =
115 sizeof(struct sockaddr_in);
116 ((struct sockaddr_in *)&ifr.ifr_dstaddr)->sin_len =
117 sizeof(struct sockaddr_in);
118#endif
119
120 strncpy(ifr.ifr_name, devname, IFNAMSIZ);
121 ifr.ifr_name[IFNAMSIZ - 1] = 0; /* Make sure to terminate */
122
123 /* Create a channel to the NET kernel. */
124 if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
125 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
126 return -1;
127 }
128
129 if (addr) { /* Set the interface address */
130 memcpy(&((struct sockaddr_in *)&ifr.ifr_addr)->sin_addr, addr,
131 sizeof(*addr));
132 if (ioctl(fd, SIOCSIFADDR, (void *)&ifr) < 0) {
133 if (errno != EEXIST) {
134 SYS_ERR(DTUN, LOGL_ERROR, errno,
135 "ioctl(SIOCSIFADDR) failed");
136 } else {
137 SYS_ERR(DTUN, LOGL_NOTICE, errno,
138 "ioctl(SIOCSIFADDR): Address already exists");
139 }
140 close(fd);
141 return -1;
142 }
143 }
144
145 if (dstaddr) { /* Set the destination address */
146 memcpy(&((struct sockaddr_in *)&ifr.ifr_dstaddr)->sin_addr,
147 dstaddr, sizeof(*dstaddr));
148 if (ioctl(fd, SIOCSIFDSTADDR, (caddr_t) & ifr) < 0) {
149 SYS_ERR(DTUN, LOGL_ERROR, errno,
150 "ioctl(SIOCSIFDSTADDR) failed");
151 close(fd);
152 return -1;
153 }
154 }
155
156 if (netmask) { /* Set the netmask */
157#if defined(__linux__)
158 memcpy(&((struct sockaddr_in *)&ifr.ifr_netmask)->sin_addr,
159 netmask, sizeof(*netmask));
160
161#elif defined(__FreeBSD__) || defined (__APPLE__)
162 ((struct sockaddr_in *)&ifr.ifr_addr)->sin_addr.s_addr =
163 netmask->s_addr;
164#endif
165
166 if (ioctl(fd, SIOCSIFNETMASK, (void *)&ifr) < 0) {
167 SYS_ERR(DTUN, LOGL_ERROR, errno,
168 "ioctl(SIOCSIFNETMASK) failed");
169 close(fd);
170 return -1;
171 }
172 }
173
174 close(fd);
175
176 /* On linux the route to the interface is set automatically
177 on FreeBSD we have to do this manually */
178
179 /* TODO: How does it work on Solaris? */
180
181 netdev_sifflags(devname, IFF_UP | IFF_RUNNING);
182
183#if defined(__FreeBSD__) || defined (__APPLE__)
184 netdev_addroute(dstaddr, addr, &this->netmask);
185#endif
186
187 return 0;
188}
189
190int netdev_setaddr6(const char *devname, struct in6_addr *addr, struct in6_addr *dstaddr,
191 size_t prefixlen)
192{
193 struct in6_ifreq ifr;
194 int fd;
195
196 memset(&ifr, 0, sizeof(ifr));
197
198#if defined(__linux__)
199 ifr.ifr6_prefixlen = prefixlen;
200 ifr.ifr6_ifindex = if_nametoindex(devname);
201 if (ifr.ifr6_ifindex == 0) {
202 SYS_ERR(DTUN, LOGL_ERROR, 0, "Error getting ifindex for %s\n", devname);
203 return -1;
204 }
205#elif defined(__FreeBSD__) || defined (__APPLE__)
206 strncpy(ifr.ifr_name, devname, IFNAMSIZ);
207#endif
208
209 /* Create a channel to the NET kernel */
210 if ((fd = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
211 SYS_ERR(DTUN, LOGL_ERROR, 0, "socket() failed");
212 return -1;
213 }
214
215#if defined(__linux__)
216 if (addr) {
217 memcpy(&ifr.ifr6_addr, addr, sizeof(*addr));
218 if (ioctl(fd, SIOCSIFADDR, (void *) &ifr) < 0) {
219 if (errno != EEXIST) {
220 SYS_ERR(DTUN, LOGL_ERROR, 0, "ioctl(SIOCSIFADDR) failed");
221 } else {
222 SYS_ERR(DTUN, LOGL_NOTICE, 0, "ioctl(SIOCSIFADDR): Address already exists");
223 }
224 close(fd);
225 return -1;
226 }
227 }
228
229#if 0
230 /* FIXME: looks like this is not possible/necessary for IPv6? */
231 if (dstaddr) {
232 memcpy(&ifr.ifr6_addr, dstaddr, sizeof(*dstaddr));
233 if (ioctl(fd, SIOCSIFDSTADDR, (caddr_t *) &ifr) < 0) {
234 SYS_ERR(DTUN, LOGL_ERROR, "ioctl(SIOCSIFDSTADDR) failed");
235 close(fd);
236 return -1;
237 }
238 }
239#endif
240
241#elif defined(__FreeBSD__) || defined (__APPLE__)
242 if (addr)
243 memcpy(&ifr.ifr_ifru.ifru_addr, addr, sizeof(ifr.ifr_ifru.ifru_addr));
244 if (dstaddr)
245 memcpy(&ifr.ifr_ifru.ifru_dstaddr, dstaddr, sizeof(ifr.ifr_ifru.ifru_dstaddr));
246
247 if (ioctl(fd, SIOCSIFADDR_IN6, (struct ifreq *)&ifr) < 0) {
248 SYS_ERR(DTUN, LOGL_ERROR, 0, "ioctl(SIOCSIFADDR_IN6) failed");
249 close(fd);
250 return -1;
251 }
252#endif
253
254 close(fd);
255
256 /* On linux the route to the interface is set automatically
257 on FreeBSD we have to do this manually */
258
259 /* TODO: How does it work on Solaris? */
260
261 netdev_sifflags(devname, IFF_UP | IFF_RUNNING);
262
263#if 0 /* FIXME */
264//#if defined(__FreeBSD__) || defined (__APPLE__)
265 netdev_addroute6(dstaddr, addr, prefixlen);
266#endif
267
268 return 0;
269}
270
271int netdev_addaddr4(const char *devname, struct in_addr *addr,
272 struct in_addr *dstaddr, struct in_addr *netmask)
273{
274
275#if defined(__linux__)
276 struct {
277 struct nlmsghdr n;
278 struct ifaddrmsg i;
279 char buf[TUN_NLBUFSIZE];
280 } req;
281
282 struct sockaddr_nl local;
283 socklen_t addr_len;
284 int fd;
285 int status;
286
287 struct sockaddr_nl nladdr;
288 struct iovec iov;
289 struct msghdr msg;
290
291 memset(&req, 0, sizeof(req));
292 req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifaddrmsg));
293 req.n.nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE;
294 req.n.nlmsg_type = RTM_NEWADDR;
295 req.i.ifa_family = AF_INET;
296 req.i.ifa_prefixlen = 32; /* 32 FOR IPv4 */
297 req.i.ifa_flags = 0;
298 req.i.ifa_scope = RT_SCOPE_HOST; /* TODO or 0 */
299 req.i.ifa_index = if_nametoindex(devname);
300 if (!req.i.ifa_index) {
301 SYS_ERR(DTUN, LOGL_ERROR, errno, "Unable to get ifindex for %s", devname);
302 return -1;
303 }
304
305 netdev_nlattr(&req.n, sizeof(req), IFA_ADDRESS, addr, sizeof(*addr));
306 if (dstaddr)
307 netdev_nlattr(&req.n, sizeof(req), IFA_LOCAL, dstaddr, sizeof(*dstaddr));
308
309 if ((fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE)) < 0) {
310 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
311 return -1;
312 }
313
314 memset(&local, 0, sizeof(local));
315 local.nl_family = AF_NETLINK;
316 local.nl_groups = 0;
317
318 if (bind(fd, (struct sockaddr *)&local, sizeof(local)) < 0) {
319 SYS_ERR(DTUN, LOGL_ERROR, errno, "bind() failed");
320 close(fd);
321 return -1;
322 }
323
324 addr_len = sizeof(local);
325 if (getsockname(fd, (struct sockaddr *)&local, &addr_len) < 0) {
326 SYS_ERR(DTUN, LOGL_ERROR, errno,
327 "getsockname() failed");
328 close(fd);
329 return -1;
330 }
331
332 if (addr_len != sizeof(local)) {
333 SYS_ERR(DTUN, LOGL_ERROR, 0,
334 "Wrong address length %d", addr_len);
335 close(fd);
336 return -1;
337 }
338
339 if (local.nl_family != AF_NETLINK) {
340 SYS_ERR(DTUN, LOGL_ERROR, 0,
341 "Wrong address family %d", local.nl_family);
342 close(fd);
343 return -1;
344 }
345
346 iov.iov_base = (void *)&req.n;
347 iov.iov_len = req.n.nlmsg_len;
348
349 msg.msg_name = (void *)&nladdr;
350 msg.msg_namelen = sizeof(nladdr);
351 msg.msg_iov = &iov;
352 msg.msg_iovlen = 1;
353 msg.msg_control = NULL;
354 msg.msg_controllen = 0;
355 msg.msg_flags = 0;
356
357 memset(&nladdr, 0, sizeof(nladdr));
358 nladdr.nl_family = AF_NETLINK;
359 nladdr.nl_pid = 0;
360 nladdr.nl_groups = 0;
361
362 req.n.nlmsg_seq = 0;
363 req.n.nlmsg_flags |= NLM_F_ACK;
364
365 status = sendmsg(fd, &msg, 0);
366 if (status != req.n.nlmsg_len) {
367 SYS_ERR(DTUN, LOGL_ERROR, errno, "sendmsg() failed, returned %d", status);
368 close(fd);
369 return -1;
370 }
371
372 status = netdev_sifflags(devname, IFF_UP | IFF_RUNNING);
373 if (status == -1) {
374 close(fd);
375 return -1;
376 }
377
378
379 close(fd);
380 return 0;
381
382#elif defined (__FreeBSD__) || defined (__APPLE__)
383
384 int fd;
385 struct ifaliasreq areq;
386
387 memset(&areq, 0, sizeof(areq));
388
389 /* Set up interface name */
390 strncpy(areq.ifra_name, devname, IFNAMSIZ);
391 areq.ifra_name[IFNAMSIZ - 1] = 0; /* Make sure to terminate */
392
393 ((struct sockaddr_in *)&areq.ifra_addr)->sin_family = AF_INET;
394 ((struct sockaddr_in *)&areq.ifra_addr)->sin_len =
395 sizeof(areq.ifra_addr);
396 ((struct sockaddr_in *)&areq.ifra_addr)->sin_addr.s_addr = addr->s_addr;
397
398 ((struct sockaddr_in *)&areq.ifra_mask)->sin_family = AF_INET;
399 ((struct sockaddr_in *)&areq.ifra_mask)->sin_len =
400 sizeof(areq.ifra_mask);
401 ((struct sockaddr_in *)&areq.ifra_mask)->sin_addr.s_addr =
402 netmask->s_addr;
403
404 /* For some reason FreeBSD uses ifra_broadcast for specifying dstaddr */
405 ((struct sockaddr_in *)&areq.ifra_broadaddr)->sin_family = AF_INET;
406 ((struct sockaddr_in *)&areq.ifra_broadaddr)->sin_len =
407 sizeof(areq.ifra_broadaddr);
408 ((struct sockaddr_in *)&areq.ifra_broadaddr)->sin_addr.s_addr =
409 dstaddr->s_addr;
410
411 /* Create a channel to the NET kernel. */
412 if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
413 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
414 return -1;
415 }
416
417 if (ioctl(fd, SIOCAIFADDR, (void *)&areq) < 0) {
418 SYS_ERR(DTUN, LOGL_ERROR, errno,
419 "ioctl(SIOCAIFADDR) failed");
420 close(fd);
421 return -1;
422 }
423
424 close(fd);
425 return 0;
426
427#endif
428
429}
430
431int netdev_addaddr6(const char *devname, struct in6_addr *addr,
432 struct in6_addr *dstaddr, int prefixlen)
433{
434
435#if defined(__linux__)
436 struct {
437 struct nlmsghdr n;
438 struct ifaddrmsg i;
439 char buf[TUN_NLBUFSIZE];
440 } req;
441
442 struct sockaddr_nl local;
443 socklen_t addr_len;
444 int fd;
445 int status;
446
447 struct sockaddr_nl nladdr;
448 struct iovec iov;
449 struct msghdr msg;
450
451 memset(&req, 0, sizeof(req));
452 req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifaddrmsg));
453 req.n.nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE;
454 req.n.nlmsg_type = RTM_NEWADDR;
455 req.i.ifa_family = AF_INET6;
456 req.i.ifa_prefixlen = 64; /* 64 FOR IPv6 */
457 req.i.ifa_flags = 0;
458 req.i.ifa_scope = RT_SCOPE_HOST; /* TODO or 0 */
459 req.i.ifa_index = if_nametoindex(devname);
460 if (!req.i.ifa_index) {
461 SYS_ERR(DTUN, LOGL_ERROR, errno, "Unable to get ifindex for %s", devname);
462 return -1;
463 }
464
465 netdev_nlattr(&req.n, sizeof(req), IFA_ADDRESS, addr, sizeof(*addr));
466 if (dstaddr)
467 netdev_nlattr(&req.n, sizeof(req), IFA_LOCAL, dstaddr, sizeof(*dstaddr));
468
469 if ((fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE)) < 0) {
470 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
471 return -1;
472 }
473
474 memset(&local, 0, sizeof(local));
475 local.nl_family = AF_NETLINK;
476 local.nl_groups = 0;
477
478 if (bind(fd, (struct sockaddr *)&local, sizeof(local)) < 0) {
479 SYS_ERR(DTUN, LOGL_ERROR, errno, "bind() failed");
480 close(fd);
481 return -1;
482 }
483
484 addr_len = sizeof(local);
485 if (getsockname(fd, (struct sockaddr *)&local, &addr_len) < 0) {
486 SYS_ERR(DTUN, LOGL_ERROR, errno,
487 "getsockname() failed");
488 close(fd);
489 return -1;
490 }
491
492 if (addr_len != sizeof(local)) {
493 SYS_ERR(DTUN, LOGL_ERROR, 0,
494 "Wrong address length %d", addr_len);
495 close(fd);
496 return -1;
497 }
498
499 if (local.nl_family != AF_NETLINK) {
500 SYS_ERR(DTUN, LOGL_ERROR, 0,
501 "Wrong address family %d", local.nl_family);
502 close(fd);
503 return -1;
504 }
505
506 iov.iov_base = (void *)&req.n;
507 iov.iov_len = req.n.nlmsg_len;
508
509 msg.msg_name = (void *)&nladdr;
510 msg.msg_namelen = sizeof(nladdr);
511 msg.msg_iov = &iov;
512 msg.msg_iovlen = 1;
513 msg.msg_control = NULL;
514 msg.msg_controllen = 0;
515 msg.msg_flags = 0;
516
517 memset(&nladdr, 0, sizeof(nladdr));
518 nladdr.nl_family = AF_NETLINK;
519 nladdr.nl_pid = 0;
520 nladdr.nl_groups = 0;
521
522 req.n.nlmsg_seq = 0;
523 req.n.nlmsg_flags |= NLM_F_ACK;
524
525 status = sendmsg(fd, &msg, 0);
526 if (status != req.n.nlmsg_len) {
527 SYS_ERR(DTUN, LOGL_ERROR, errno, "sendmsg() failed, returned %d", status);
528 close(fd);
529 return -1;
530 }
531
532 status = netdev_sifflags(devname, IFF_UP | IFF_RUNNING);
533 if (status == -1) {
534 close(fd);
535 return -1;
536 }
537
538
539 close(fd);
540 return 0;
541
542#elif defined (__FreeBSD__) || defined (__APPLE__)
543
544 int fd;
545 struct ifaliasreq areq;
546
547 memset(&areq, 0, sizeof(areq));
548
549 /* Set up interface name */
550 strncpy(areq.ifra_name, devname, IFNAMSIZ);
551 areq.ifra_name[IFNAMSIZ - 1] = 0; /* Make sure to terminate */
552
553 ((struct sockaddr_in6 *)&areq.ifra_addr)->sin6_family = AF_INET6;
554 ((struct sockaddr_in6 *)&areq.ifra_addr)->sin6_len = sizeof(areq.ifra_addr);
555 ((struct sockaddr_in6 *)&areq.ifra_addr)->sin6_addr.s6_addr = addr->s6_addr;
556
557 ((struct sockaddr_in6 *)&areq.ifra_mask)->sin6_family = AF_INET6;
558 ((struct sockaddr_in6 *)&areq.ifra_mask)->sin6_len = sizeof(areq.ifra_mask);
559 ((struct sockaddr_in6 *)&areq.ifra_mask)->sin6_addr.s6_addr = netmask->s6_addr;
560
561 /* For some reason FreeBSD uses ifra_broadcast for specifying dstaddr */
562 ((struct sockaddr_in6 *)&areq.ifra_broadaddr)->sin6_family = AF_INET6;
563 ((struct sockaddr_in6 *)&areq.ifra_broadaddr)->sin6_len = sizeof(areq.ifra_broadaddr);
564 ((struct sockaddr_in6 *)&areq.ifra_broadaddr)->sin6_addr.s6_addr = dstaddr->s6_addr;
565
566 /* Create a channel to the NET kernel. */
567 if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
568 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
569 return -1;
570 }
571
572 if (ioctl(fd, SIOCAIFADDR, (void *)&areq) < 0) {
573 SYS_ERR(DTUN, LOGL_ERROR, errno,
574 "ioctl(SIOCAIFADDR) failed");
575 close(fd);
576 return -1;
577 }
578
579 close(fd);
580 return 0;
581
582#endif
583
584}
585
586static int netdev_route(struct in_addr *dst, struct in_addr *gateway, struct in_addr *mask, int delete)
587{
588
589#if defined(__linux__)
590
591 struct rtentry r;
592 int fd;
593
594 memset(&r, '\0', sizeof(r));
595 r.rt_flags = RTF_UP | RTF_GATEWAY; /* RTF_HOST not set */
596
597 /* Create a channel to the NET kernel. */
598 if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
599 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
600 return -1;
601 }
602
603 r.rt_dst.sa_family = AF_INET;
604 r.rt_gateway.sa_family = AF_INET;
605 r.rt_genmask.sa_family = AF_INET;
606 memcpy(&((struct sockaddr_in *)&r.rt_dst)->sin_addr, dst, sizeof(*dst));
607 memcpy(&((struct sockaddr_in *)&r.rt_gateway)->sin_addr, gateway,
608 sizeof(*gateway));
609 memcpy(&((struct sockaddr_in *)&r.rt_genmask)->sin_addr, mask,
610 sizeof(*mask));
611
612 if (delete) {
613 if (ioctl(fd, SIOCDELRT, (void *)&r) < 0) {
614 SYS_ERR(DTUN, LOGL_ERROR, errno,
615 "ioctl(SIOCDELRT) failed");
616 close(fd);
617 return -1;
618 }
619 } else {
620 if (ioctl(fd, SIOCADDRT, (void *)&r) < 0) {
621 SYS_ERR(DTUN, LOGL_ERROR, errno,
622 "ioctl(SIOCADDRT) failed");
623 close(fd);
624 return -1;
625 }
626 }
627 close(fd);
628 return 0;
629
630#elif defined(__FreeBSD__) || defined (__APPLE__)
631
632 struct {
633 struct rt_msghdr rt;
634 struct sockaddr_in dst;
635 struct sockaddr_in gate;
636 struct sockaddr_in mask;
637 } req;
638
639 int fd;
640 struct rt_msghdr *rtm;
641
642 if ((fd = socket(AF_ROUTE, SOCK_RAW, 0)) == -1) {
643 SYS_ERR(DTUN, LOGL_ERROR, errno, "socket() failed");
644 return -1;
645 }
646
647 memset(&req, 0x00, sizeof(req));
648
649 rtm = &req.rt;
650
651 rtm->rtm_msglen = sizeof(req);
652 rtm->rtm_version = RTM_VERSION;
653 if (delete) {
654 rtm->rtm_type = RTM_DELETE;
655 } else {
656 rtm->rtm_type = RTM_ADD;
657 }
658 rtm->rtm_flags = RTF_UP | RTF_GATEWAY | RTF_STATIC; /* TODO */
659 rtm->rtm_addrs = RTA_DST | RTA_GATEWAY | RTA_NETMASK;
660 rtm->rtm_pid = getpid();
661 rtm->rtm_seq = 0044; /* TODO */
662
663 req.dst.sin_family = AF_INET;
664 req.dst.sin_len = sizeof(req.dst);
665 req.mask.sin_family = AF_INET;
666 req.mask.sin_len = sizeof(req.mask);
667 req.gate.sin_family = AF_INET;
668 req.gate.sin_len = sizeof(req.gate);
669
670 req.dst.sin_addr.s_addr = dst->s_addr;
671 req.mask.sin_addr.s_addr = mask->s_addr;
672 req.gate.sin_addr.s_addr = gateway->s_addr;
673
674 if (write(fd, rtm, rtm->rtm_msglen) < 0) {
675 SYS_ERR(DTUN, LOGL_ERROR, errno, "write() failed");
676 close(fd);
677 return -1;
678 }
679 close(fd);
680 return 0;
681#endif
682
683}
684
685int netdev_addroute(struct in_addr *dst, struct in_addr *gateway, struct in_addr *mask)
686{
687 return netdev_route(dst, gateway, mask, 0);
688}
689
690int netdev_delroute(struct in_addr *dst, struct in_addr *gateway, struct in_addr *mask)
691{
692 return netdev_route(dst, gateway, mask, 1);
693}
694
695#include <ifaddrs.h>
696
697/*! Obtain the local address of a network device
698 * \param[in] devname Target device owning the IP
699 * \param[out] prefix_list List of prefix structures to fill with each IPv4/6 and prefix length found.
700 * \param[in] prefix_size Amount of elements allowed to be fill in the prefix_list array.
701 * \param[in] flags Specify which kind of IP to look for: IP_TYPE_IPv4, IP_TYPE_IPv6_LINK, IP_TYPE_IPv6_NONLINK
702 * \returns The number of ips found following the criteria specified by flags, -1 on error.
703 *
704 * This function will fill prefix_list with up to prefix_size IPs following the
705 * criteria specified by flags parameter. It returns the number of IPs matching
706 * the criteria. As a result, the number returned can be bigger than
707 * prefix_size. It can be used with prefix_size=0 to get an estimate of the size
708 * needed for prefix_list.
709 */
710int netdev_ip_local_get(const char *devname, struct in46_prefix *prefix_list, size_t prefix_size, int flags)
711{
712 static const uint8_t ll_prefix[] = { 0xfe,0x80, 0,0, 0,0, 0,0 };
713 struct ifaddrs *ifaddr, *ifa;
714 struct in46_addr netmask;
715 size_t count = 0;
716 bool is_ipv6_ll;
717
718 if (getifaddrs(&ifaddr) == -1) {
719 return -1;
720 }
721
722 for (ifa = ifaddr; ifa != NULL; ifa = ifa->ifa_next) {
723 if (ifa->ifa_addr == NULL)
724 continue;
725
726 if (strcmp(ifa->ifa_name, devname))
727 continue;
728
729 if (ifa->ifa_addr->sa_family == AF_INET && (flags & IP_TYPE_IPv4)) {
730 struct sockaddr_in *sin4 = (struct sockaddr_in *) ifa->ifa_addr;
731 struct sockaddr_in *netmask4 = (struct sockaddr_in *) ifa->ifa_netmask;
732
733 if (count < prefix_size) {
734 netmask.len = sizeof(netmask4->sin_addr);
735 netmask.v4 = netmask4->sin_addr;
736 prefix_list[count].addr.len = sizeof(sin4->sin_addr);
737 prefix_list[count].addr.v4 = sin4->sin_addr;
738 prefix_list[count].prefixlen = in46a_netmasklen(&netmask);
739 }
740 count++;
741 }
742
743 if (ifa->ifa_addr->sa_family == AF_INET6 && (flags & IP_TYPE_IPv6)) {
744 struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *) ifa->ifa_addr;
745 struct sockaddr_in6 *netmask6 = (struct sockaddr_in6 *) ifa->ifa_netmask;
746
747 is_ipv6_ll = !memcmp(sin6->sin6_addr.s6_addr, ll_prefix, sizeof(ll_prefix));
748 if ((flags & IP_TYPE_IPv6_NONLINK) && is_ipv6_ll)
749 continue;
750 if ((flags & IP_TYPE_IPv6_LINK) && !is_ipv6_ll)
751 continue;
752
753 if (count < prefix_size) {
754 netmask.len = sizeof(netmask6->sin6_addr);
755 netmask.v6 = netmask6->sin6_addr;
756 prefix_list[count].addr.len = sizeof(sin6->sin6_addr);
757 prefix_list[count].addr.v6 = sin6->sin6_addr;
758 prefix_list[count].prefixlen = in46a_netmasklen(&netmask);
759 }
760 count++;
761 }
762 }
763
764 freeifaddrs(ifaddr);
765 return count;
766}