3 #include <sys/socket.h>
6 #include <sys/syscall.h>
9 #include <net/if_arp.h>
11 #include <arpa/inet.h>
12 #include <netinet/in.h>
14 #include <linux/rtnetlink.h>
15 #include <linux/sockios.h>
17 #include <linux/if_vlan.h>
18 #include <linux/if_bridge.h>
19 #include <linux/if_tunnel.h>
20 #include <linux/ethtool.h>
28 #include <netlink/msg.h>
29 #include <netlink/attr.h>
30 #include <netlink/socket.h>
31 #include <libubox/uloop.h>
38 struct uloop_fd uloop;
43 static int sock_ioctl = -1;
44 static struct nl_sock *sock_rtnl = NULL;
46 static int cb_rtnl_event(struct nl_msg *msg, void *arg);
47 static void handle_hotplug_event(struct uloop_fd *u, unsigned int events);
49 static char dev_buf[256];
52 handler_nl_event(struct uloop_fd *u, unsigned int events)
54 struct event_socket *ev = container_of(u, struct event_socket, uloop);
55 nl_recvmsgs(ev->sock, ev->cb);
58 static struct nl_sock *
59 create_socket(int protocol, int groups)
63 sock = nl_socket_alloc();
68 nl_join_groups(sock, groups);
70 if (nl_connect(sock, protocol))
77 create_raw_event_socket(struct event_socket *ev, int protocol, int groups,
80 ev->sock = create_socket(protocol, groups);
84 ev->uloop.fd = nl_socket_get_fd(ev->sock);
86 uloop_fd_add(&ev->uloop, ULOOP_READ | ULOOP_EDGE_TRIGGER);
91 create_event_socket(struct event_socket *ev, int protocol,
92 int (*cb)(struct nl_msg *msg, void *arg))
94 // Prepare socket for link events
95 ev->cb = nl_cb_alloc(NL_CB_DEFAULT);
99 nl_cb_set(ev->cb, NL_CB_VALID, NL_CB_CUSTOM, cb, NULL);
101 return create_raw_event_socket(ev, protocol, 0, handler_nl_event);
104 int system_init(void)
106 static struct event_socket rtnl_event;
107 static struct event_socket hotplug_event;
109 sock_ioctl = socket(AF_LOCAL, SOCK_DGRAM, 0);
110 fcntl(sock_ioctl, F_SETFD, fcntl(sock_ioctl, F_GETFD) | FD_CLOEXEC);
112 // Prepare socket for routing / address control
113 sock_rtnl = create_socket(NETLINK_ROUTE, 0);
117 if (!create_event_socket(&rtnl_event, NETLINK_ROUTE, cb_rtnl_event))
120 if (!create_raw_event_socket(&hotplug_event, NETLINK_KOBJECT_UEVENT, 1,
121 handle_hotplug_event))
124 // Receive network link events form kernel
125 nl_socket_add_membership(rtnl_event.sock, RTNLGRP_LINK);
130 static void system_set_sysctl(const char *path, const char *val)
134 fd = open(path, O_WRONLY);
138 write(fd, val, strlen(val));
142 static void system_set_dev_sysctl(const char *path, const char *device, const char *val)
144 snprintf(dev_buf, sizeof(dev_buf), path, val);
145 system_set_sysctl(dev_buf, val);
148 static void system_set_disable_ipv6(struct device *dev, const char *val)
150 system_set_dev_sysctl("/proc/sys/net/ipv6/conf/%s/disable_ipv6", dev->ifname, val);
153 // Evaluate netlink messages
154 static int cb_rtnl_event(struct nl_msg *msg, void *arg)
156 struct nlmsghdr *nh = nlmsg_hdr(msg);
157 struct ifinfomsg *ifi = NLMSG_DATA(nh);
158 struct nlattr *nla[__IFLA_MAX];
160 if (nh->nlmsg_type != RTM_DELLINK && nh->nlmsg_type != RTM_NEWLINK)
163 nlmsg_parse(nh, sizeof(*ifi), nla, __IFLA_MAX - 1, NULL);
164 if (!nla[IFLA_IFNAME])
167 struct device *dev = device_get(RTA_DATA(nla[IFLA_IFNAME]), false);
171 dev->ifindex = ifi->ifi_index;
172 /* TODO: parse link status */
179 handle_hotplug_msg(char *data, int size)
181 const char *subsystem = NULL, *interface = NULL;
182 char *cur, *end, *sep;
187 if (!strncmp(data, "add@", 4))
189 else if (!strncmp(data, "remove@", 7))
194 skip = strlen(data) + 1;
197 for (cur = data + skip; cur < end; cur += skip) {
198 skip = strlen(cur) + 1;
200 sep = strchr(cur, '=');
205 if (!strcmp(cur, "INTERFACE"))
207 else if (!strcmp(cur, "SUBSYSTEM")) {
209 if (strcmp(subsystem, "net") != 0)
212 if (subsystem && interface)
218 dev = device_get(interface, false);
222 if (dev->type != &simple_device_type)
225 device_set_present(dev, add);
229 handle_hotplug_event(struct uloop_fd *u, unsigned int events)
231 struct event_socket *ev = container_of(u, struct event_socket, uloop);
232 struct sockaddr_nl nla;
233 unsigned char *buf = NULL;
236 while ((size = nl_recv(ev->sock, &nla, &buf, NULL)) > 0) {
238 handle_hotplug_msg((char *) buf, size);
244 static int system_rtnl_call(struct nl_msg *msg)
248 ret = nl_send_auto_complete(sock_rtnl, msg);
254 return nl_wait_for_ack(sock_rtnl);
257 int system_bridge_delbr(struct device *bridge)
259 return ioctl(sock_ioctl, SIOCBRDELBR, bridge->ifname);
262 static int system_bridge_if(const char *bridge, struct device *dev, int cmd, void *data)
266 ifr.ifr_ifindex = dev->ifindex;
269 strncpy(ifr.ifr_name, bridge, sizeof(ifr.ifr_name));
270 return ioctl(sock_ioctl, cmd, &ifr);
273 static bool system_is_bridge(const char *name, char *buf, int buflen)
277 snprintf(buf, buflen, "/sys/devices/virtual/net/%s/bridge", name);
278 if (stat(buf, &st) < 0)
284 static char *system_get_bridge(const char *name, char *buf, int buflen)
290 snprintf(buf, buflen, "/sys/devices/virtual/net/*/brif/%s/bridge", name);
291 if (glob(buf, GLOB_NOSORT, NULL, &gl) < 0)
294 if (gl.gl_pathc == 0)
297 len = readlink(gl.gl_pathv[0], buf, buflen);
302 path = strrchr(buf, '/');
309 int system_bridge_addif(struct device *bridge, struct device *dev)
313 system_set_disable_ipv6(dev, "1");
314 oldbr = system_get_bridge(dev->ifname, dev_buf, sizeof(dev_buf));
315 if (oldbr && !strcmp(oldbr, bridge->ifname))
318 return system_bridge_if(bridge->ifname, dev, SIOCBRADDIF, NULL);
321 int system_bridge_delif(struct device *bridge, struct device *dev)
323 system_set_disable_ipv6(dev, "0");
324 return system_bridge_if(bridge->ifname, dev, SIOCBRDELIF, NULL);
327 static int system_if_resolve(struct device *dev)
330 strncpy(ifr.ifr_name, dev->ifname, sizeof(ifr.ifr_name));
331 if (!ioctl(sock_ioctl, SIOCGIFINDEX, &ifr))
332 return ifr.ifr_ifindex;
337 static int system_if_flags(const char *ifname, unsigned add, unsigned rem)
340 strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
341 ioctl(sock_ioctl, SIOCGIFFLAGS, &ifr);
342 ifr.ifr_flags |= add;
343 ifr.ifr_flags &= ~rem;
344 return ioctl(sock_ioctl, SIOCSIFFLAGS, &ifr);
356 static bool check_ifaddr(struct nlmsghdr *hdr, int ifindex)
358 struct ifaddrmsg *ifa = NLMSG_DATA(hdr);
360 return ifa->ifa_index == ifindex;
363 static bool check_route(struct nlmsghdr *hdr, int ifindex)
365 struct nlattr *tb[__RTA_MAX];
367 nlmsg_parse(hdr, sizeof(struct rtmsg), tb, __RTA_MAX - 1, NULL);
371 return *(int *)RTA_DATA(tb[RTA_OIF]) == ifindex;
374 static int cb_clear_event(struct nl_msg *msg, void *arg)
376 struct clear_data *clr = arg;
377 struct nlmsghdr *hdr = nlmsg_hdr(msg);
378 bool (*cb)(struct nlmsghdr *, int ifindex);
384 if (hdr->nlmsg_type != RTM_NEWADDR)
391 if (hdr->nlmsg_type != RTM_NEWROUTE)
400 if (!cb(hdr, clr->dev->ifindex))
403 D(SYSTEM, "Remove %s from device %s\n",
404 type == RTM_DELADDR ? "an address" : "a route",
406 memcpy(nlmsg_hdr(clr->msg), hdr, hdr->nlmsg_len);
407 hdr = nlmsg_hdr(clr->msg);
408 hdr->nlmsg_type = type;
409 hdr->nlmsg_flags = NLM_F_REQUEST;
411 if (!nl_send_auto_complete(sock_rtnl, clr->msg))
412 nl_wait_for_ack(sock_rtnl);
418 cb_finish_event(struct nl_msg *msg, void *arg)
426 error_handler(struct sockaddr_nl *nla, struct nlmsgerr *err, void *arg)
429 *pending = err->error;
434 system_if_clear_entries(struct device *dev, int type, int af)
436 struct clear_data clr;
437 struct nl_cb *cb = nl_cb_alloc(NL_CB_DEFAULT);
440 .rtm_flags = RTM_F_CLONED,
442 int flags = NLM_F_DUMP;
450 clr.size = sizeof(struct rtgenmsg);
453 clr.size = sizeof(struct rtmsg);
462 clr.msg = nlmsg_alloc_simple(type, flags);
466 nlmsg_append(clr.msg, &rtm, clr.size, 0);
467 nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, cb_clear_event, &clr);
468 nl_cb_set(cb, NL_CB_FINISH, NL_CB_CUSTOM, cb_finish_event, &pending);
469 nl_cb_err(cb, NL_CB_CUSTOM, error_handler, &pending);
471 nl_send_auto_complete(sock_rtnl, clr.msg);
473 nl_recvmsgs(sock_rtnl, cb);
481 * Clear bridge (membership) state and bring down device
483 void system_if_clear_state(struct device *dev)
485 static char buf[256];
491 dev->ifindex = system_if_resolve(dev);
495 system_if_flags(dev->ifname, 0, IFF_UP);
497 if (system_is_bridge(dev->ifname, buf, sizeof(buf))) {
498 D(SYSTEM, "Delete existing bridge named '%s'\n", dev->ifname);
499 system_bridge_delbr(dev);
503 bridge = system_get_bridge(dev->ifname, buf, sizeof(buf));
505 D(SYSTEM, "Remove device '%s' from bridge '%s'\n", dev->ifname, bridge);
506 system_bridge_if(bridge, dev, SIOCBRDELIF, NULL);
509 system_if_clear_entries(dev, RTM_GETROUTE, AF_INET);
510 system_if_clear_entries(dev, RTM_GETADDR, AF_INET);
511 system_if_clear_entries(dev, RTM_GETROUTE, AF_INET6);
512 system_if_clear_entries(dev, RTM_GETADDR, AF_INET6);
513 system_set_disable_ipv6(dev, "0");
516 static inline unsigned long
517 sec_to_jiffies(int val)
519 return (unsigned long) val * 100;
522 int system_bridge_addbr(struct device *bridge, struct bridge_config *cfg)
524 unsigned long args[4] = {};
526 if (ioctl(sock_ioctl, SIOCBRADDBR, bridge->ifname) < 0)
529 args[0] = BRCTL_SET_BRIDGE_STP_STATE;
530 args[1] = !!cfg->stp;
531 system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args);
533 args[0] = BRCTL_SET_BRIDGE_FORWARD_DELAY;
534 args[1] = sec_to_jiffies(cfg->forward_delay);
535 system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args);
537 system_set_dev_sysctl("/sys/devices/virtual/net/%s/bridge/multicast_snooping",
538 bridge->ifname, cfg->igmp_snoop ? "1" : "0");
540 if (cfg->flags & BRIDGE_OPT_AGEING_TIME) {
541 args[0] = BRCTL_SET_AGEING_TIME;
542 args[1] = sec_to_jiffies(cfg->ageing_time);
543 system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args);
546 if (cfg->flags & BRIDGE_OPT_HELLO_TIME) {
547 args[0] = BRCTL_SET_BRIDGE_HELLO_TIME;
548 args[1] = sec_to_jiffies(cfg->hello_time);
549 system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args);
552 if (cfg->flags & BRIDGE_OPT_MAX_AGE) {
553 args[0] = BRCTL_SET_BRIDGE_MAX_AGE;
554 args[1] = sec_to_jiffies(cfg->max_age);
555 system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args);
561 static int system_vlan(struct device *dev, int id)
563 struct vlan_ioctl_args ifr = {
564 .cmd = SET_VLAN_NAME_TYPE_CMD,
565 .u.name_type = VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD,
568 ioctl(sock_ioctl, SIOCSIFVLAN, &ifr);
571 ifr.cmd = DEL_VLAN_CMD;
574 ifr.cmd = ADD_VLAN_CMD;
577 strncpy(ifr.device1, dev->ifname, sizeof(ifr.device1));
578 return ioctl(sock_ioctl, SIOCSIFVLAN, &ifr);
581 int system_vlan_add(struct device *dev, int id)
583 return system_vlan(dev, id);
586 int system_vlan_del(struct device *dev)
588 return system_vlan(dev, -1);
592 system_if_get_settings(struct device *dev, struct device_settings *s)
596 memset(&ifr, 0, sizeof(ifr));
597 strncpy(ifr.ifr_name, dev->ifname, sizeof(ifr.ifr_name));
599 if (ioctl(sock_ioctl, SIOCGIFMTU, &ifr) == 0) {
600 s->mtu = ifr.ifr_mtu;
601 s->flags |= DEV_OPT_MTU;
604 if (ioctl(sock_ioctl, SIOCGIFTXQLEN, &ifr) == 0) {
605 s->txqueuelen = ifr.ifr_qlen;
606 s->flags |= DEV_OPT_TXQUEUELEN;
609 if (ioctl(sock_ioctl, SIOCGIFHWADDR, &ifr) == 0) {
610 memcpy(s->macaddr, &ifr.ifr_hwaddr.sa_data, sizeof(s->macaddr));
611 s->flags |= DEV_OPT_MACADDR;
616 system_if_apply_settings(struct device *dev, struct device_settings *s)
620 memset(&ifr, 0, sizeof(ifr));
621 strncpy(ifr.ifr_name, dev->ifname, sizeof(ifr.ifr_name));
622 if (s->flags & DEV_OPT_MTU) {
623 ifr.ifr_mtu = s->mtu;
624 if (ioctl(sock_ioctl, SIOCSIFMTU, &ifr) < 0)
625 s->flags &= ~DEV_OPT_MTU;
627 if (s->flags & DEV_OPT_TXQUEUELEN) {
628 ifr.ifr_qlen = s->txqueuelen;
629 if (ioctl(sock_ioctl, SIOCSIFTXQLEN, &ifr) < 0)
630 s->flags &= ~DEV_OPT_TXQUEUELEN;
632 if (s->flags & DEV_OPT_MACADDR) {
633 ifr.ifr_hwaddr.sa_family = ARPHRD_ETHER;
634 memcpy(&ifr.ifr_hwaddr.sa_data, s->macaddr, sizeof(s->macaddr));
635 if (ioctl(sock_ioctl, SIOCSIFHWADDR, &ifr) < 0)
636 s->flags &= ~DEV_OPT_MACADDR;
640 int system_if_up(struct device *dev)
642 system_if_get_settings(dev, &dev->orig_settings);
643 system_if_apply_settings(dev, &dev->settings);
644 dev->ifindex = system_if_resolve(dev);
645 return system_if_flags(dev->ifname, IFF_UP, 0);
648 int system_if_down(struct device *dev)
650 int ret = system_if_flags(dev->ifname, 0, IFF_UP);
651 dev->orig_settings.flags &= dev->settings.flags;
652 system_if_apply_settings(dev, &dev->orig_settings);
656 int system_if_check(struct device *dev)
658 device_set_present(dev, (system_if_resolve(dev) > 0));
663 system_if_get_parent(struct device *dev)
665 char buf[64], *devname;
666 int ifindex, iflink, len;
669 snprintf(buf, sizeof(buf), "/sys/class/net/%s/iflink", dev->ifname);
674 len = fread(buf, 1, sizeof(buf) - 1, f);
681 iflink = strtoul(buf, NULL, 0);
682 ifindex = system_if_resolve(dev);
683 if (!iflink || iflink == ifindex)
686 devname = if_indextoname(iflink, buf);
690 return device_get(devname, true);
694 read_string_file(int dir_fd, const char *file, char *buf, int len)
700 fd = openat(dir_fd, file, O_RDONLY);
705 len = read(fd, buf, len - 1);
709 } else if (len > 0) {
712 c = strchr(buf, '\n');
725 read_int_file(int dir_fd, const char *file, int *val)
730 ret = read_string_file(dir_fd, file, buf, sizeof(buf));
732 *val = strtoul(buf, NULL, 0);
737 /* Assume advertised flags == supported flags */
738 static const struct {
741 } ethtool_link_modes[] = {
742 { ADVERTISED_10baseT_Half, "10H" },
743 { ADVERTISED_10baseT_Full, "10F" },
744 { ADVERTISED_100baseT_Half, "100H" },
745 { ADVERTISED_100baseT_Full, "100F" },
746 { ADVERTISED_1000baseT_Half, "1000H" },
747 { ADVERTISED_1000baseT_Full, "1000F" },
750 static void system_add_link_modes(struct blob_buf *b, __u32 mask)
753 for (i = 0; i < ARRAY_SIZE(ethtool_link_modes); i++) {
754 if (mask & ethtool_link_modes[i].mask)
755 blobmsg_add_string(b, NULL, ethtool_link_modes[i].name);
760 system_if_dump_info(struct device *dev, struct blob_buf *b)
762 struct ethtool_cmd ecmd;
768 snprintf(buf, sizeof(buf), "/sys/class/net/%s", dev->ifname);
769 dir_fd = open(buf, O_DIRECTORY);
771 if (read_int_file(dir_fd, "carrier", &val))
772 blobmsg_add_u8(b, "link", !!val);
774 memset(&ecmd, 0, sizeof(ecmd));
775 memset(&ifr, 0, sizeof(ifr));
776 strcpy(ifr.ifr_name, dev->ifname);
777 ifr.ifr_data = (caddr_t) &ecmd;
778 ecmd.cmd = ETHTOOL_GSET;
780 if (ioctl(sock_ioctl, SIOCETHTOOL, &ifr) == 0) {
781 c = blobmsg_open_array(b, "link-advertising");
782 system_add_link_modes(b, ecmd.advertising);
783 blobmsg_close_array(b, c);
785 c = blobmsg_open_array(b, "link-supported");
786 system_add_link_modes(b, ecmd.supported);
787 blobmsg_close_array(b, c);
789 s = blobmsg_alloc_string_buffer(b, "speed", 8);
790 snprintf(s, 8, "%d%c", ethtool_cmd_speed(&ecmd),
791 ecmd.duplex == DUPLEX_HALF ? 'H' : 'F');
792 blobmsg_add_string_buffer(b);
800 system_if_dump_stats(struct device *dev, struct blob_buf *b)
802 const char *const counters[] = {
803 "collisions", "rx_frame_errors", "tx_compressed",
804 "multicast", "rx_length_errors", "tx_dropped",
805 "rx_bytes", "rx_missed_errors", "tx_errors",
806 "rx_compressed", "rx_over_errors", "tx_fifo_errors",
807 "rx_crc_errors", "rx_packets", "tx_heartbeat_errors",
808 "rx_dropped", "tx_aborted_errors", "tx_packets",
809 "rx_errors", "tx_bytes", "tx_window_errors",
810 "rx_fifo_errors", "tx_carrier_errors",
816 snprintf(buf, sizeof(buf), "/sys/class/net/%s/statistics", dev->ifname);
817 stats_dir = open(buf, O_DIRECTORY);
821 for (i = 0; i < ARRAY_SIZE(counters); i++)
822 if (read_int_file(stats_dir, counters[i], &val))
823 blobmsg_add_u32(b, counters[i], val);
829 static int system_addr(struct device *dev, struct device_addr *addr, int cmd)
831 bool v4 = ((addr->flags & DEVADDR_FAMILY) == DEVADDR_INET4);
832 int alen = v4 ? 4 : 16;
833 struct ifaddrmsg ifa = {
834 .ifa_family = (alen == 4) ? AF_INET : AF_INET6,
835 .ifa_prefixlen = addr->mask,
836 .ifa_index = dev->ifindex,
841 msg = nlmsg_alloc_simple(cmd, 0);
845 nlmsg_append(msg, &ifa, sizeof(ifa), 0);
846 nla_put(msg, IFA_LOCAL, alen, &addr->addr);
848 nla_put_u32(msg, IFA_BROADCAST, addr->broadcast);
850 return system_rtnl_call(msg);
853 int system_add_address(struct device *dev, struct device_addr *addr)
855 return system_addr(dev, addr, RTM_NEWADDR);
858 int system_del_address(struct device *dev, struct device_addr *addr)
860 return system_addr(dev, addr, RTM_DELADDR);
863 static int system_rt(struct device *dev, struct device_route *route, int cmd)
865 int alen = ((route->flags & DEVADDR_FAMILY) == DEVADDR_INET4) ? 4 : 16;
867 unsigned int flags = 0;
868 int ifindex = dev->ifindex;
871 have_gw = !!route->nexthop.in.s_addr;
873 have_gw = route->nexthop.in6.s6_addr32[0] ||
874 route->nexthop.in6.s6_addr32[1] ||
875 route->nexthop.in6.s6_addr32[2] ||
876 route->nexthop.in6.s6_addr32[3];
878 unsigned char scope = (cmd == RTM_DELROUTE) ? RT_SCOPE_NOWHERE :
879 (have_gw) ? RT_SCOPE_UNIVERSE : RT_SCOPE_LINK;
882 .rtm_family = (alen == 4) ? AF_INET : AF_INET6,
883 .rtm_dst_len = route->mask,
884 .rtm_table = RT_TABLE_MAIN,
885 .rtm_protocol = RTPROT_BOOT,
887 .rtm_type = (cmd == RTM_DELROUTE) ? 0: RTN_UNICAST,
891 if (cmd == RTM_NEWROUTE)
892 flags |= NLM_F_CREATE | NLM_F_REPLACE;
894 msg = nlmsg_alloc_simple(cmd, flags);
898 nlmsg_append(msg, &rtm, sizeof(rtm), 0);
901 nla_put(msg, RTA_DST, alen, &route->addr);
903 if (route->metric > 0)
904 nla_put_u32(msg, RTA_PRIORITY, route->metric);
907 nla_put(msg, RTA_GATEWAY, alen, &route->nexthop);
909 nla_put_u32(msg, RTA_OIF, ifindex);
911 return system_rtnl_call(msg);
914 int system_add_route(struct device *dev, struct device_route *route)
916 return system_rt(dev, route, RTM_NEWROUTE);
919 int system_del_route(struct device *dev, struct device_route *route)
921 return system_rt(dev, route, RTM_DELROUTE);
924 int system_flush_routes(void)
926 const char *names[] = {
927 "/proc/sys/net/ipv4/route/flush",
928 "/proc/sys/net/ipv6/route/flush"
932 for (i = 0; i < ARRAY_SIZE(names); i++) {
933 fd = open(names[i], O_WRONLY);
943 time_t system_get_rtime(void)
948 if (syscall(__NR_clock_gettime, CLOCK_MONOTONIC, &ts) == 0)
951 if (gettimeofday(&tv, NULL) == 0)
961 static void tunnel_parm_init(struct ip_tunnel_parm *p)
963 memset(p, 0, sizeof(*p));
966 p->iph.frag_off = htons(IP_DF);
969 static int tunnel_ioctl(const char *name, int cmd, void *p)
973 memset(&ifr, 0, sizeof(ifr));
974 strncpy(ifr.ifr_name, name, sizeof(ifr.ifr_name));
975 ifr.ifr_ifru.ifru_data = p;
976 return ioctl(sock_ioctl, cmd, &ifr);
979 int system_del_ip_tunnel(const char *name)
981 struct ip_tunnel_parm p;
983 tunnel_parm_init(&p);
984 return tunnel_ioctl(name, SIOCDELTUNNEL, &p);
987 static int parse_ipaddr(struct blob_attr *attr, __be32 *addr)
992 return inet_pton(AF_INET, blobmsg_data(attr), (void *) addr);
996 int system_add_ip_tunnel(const char *name, struct blob_attr *attr)
998 struct blob_attr *tb[__TUNNEL_ATTR_MAX];
999 struct blob_attr *cur;
1000 struct ip_tunnel_parm p;
1001 const char *base, *str;
1002 int cmd = SIOCADDTUNNEL;
1004 system_del_ip_tunnel(name);
1006 tunnel_parm_init(&p);
1008 blobmsg_parse(tunnel_attr_list.params, __TUNNEL_ATTR_MAX, tb,
1009 blob_data(attr), blob_len(attr));
1011 cur = tb[TUNNEL_ATTR_TYPE];
1015 str = blobmsg_data(cur);
1016 if (!strcmp(str, "sit")) {
1017 p.iph.protocol = IPPROTO_IPV6;
1022 if (!parse_ipaddr(tb[TUNNEL_ATTR_LOCAL], &p.iph.saddr))
1025 if (!parse_ipaddr(tb[TUNNEL_ATTR_REMOTE], &p.iph.daddr))
1028 if ((cur = tb[TUNNEL_ATTR_TTL])) {
1029 unsigned int val = blobmsg_get_u32(cur);
1037 strncpy(p.name, name, sizeof(p.name));
1038 return tunnel_ioctl(base, cmd, &p);