X-Git-Url: http://git.archive.openwrt.org/?p=project%2Fnetifd.git;a=blobdiff_plain;f=system-linux.c;h=9f1aa9efb70e4903d3d1a85a3a8c8596f7c2860c;hp=158045a3487ed66776b165a42b3e567492b28153;hb=c1db77f01848b4da256426383559a553547a81d5;hpb=ce16f1212440e27c41eb9a98292dabe9ad366c67 diff --git a/system-linux.c b/system-linux.c index 158045a..9f1aa9e 100644 --- a/system-linux.c +++ b/system-linux.c @@ -1,12 +1,16 @@ #include #include +#include #include #include #include +#include +#include #include #include +#include #include #include @@ -60,7 +64,7 @@ int system_init(void) rtnl_event.fd = nl_socket_get_fd(sock_rtnl_event); uloop_fd_add(&rtnl_event, ULOOP_READ | ULOOP_EDGE_TRIGGER); - return -(sock_ioctl < 0 || !sock_rtnl); + return 0; error_free_event: nl_socket_free(sock_rtnl_event); @@ -113,83 +117,196 @@ static int system_rtnl_call(struct nl_msg *msg) return s; } -int system_bridge_addbr(struct device *bridge) -{ - return ioctl(sock_ioctl, SIOCBRADDBR, bridge->ifname); -} - int system_bridge_delbr(struct device *bridge) { return ioctl(sock_ioctl, SIOCBRDELBR, bridge->ifname); } -static int system_bridge_if(struct device *bridge, struct device *dev, int cmd) +static int system_bridge_if(const char *bridge, struct device *dev, int cmd, void *data) { struct ifreq ifr; - ifr.ifr_ifindex = dev->ifindex; - strncpy(ifr.ifr_name, bridge->ifname, sizeof(ifr.ifr_name)); + if (dev) + ifr.ifr_ifindex = dev->ifindex; + else + ifr.ifr_data = data; + strncpy(ifr.ifr_name, bridge, sizeof(ifr.ifr_name)); return ioctl(sock_ioctl, cmd, &ifr); } int system_bridge_addif(struct device *bridge, struct device *dev) { - return system_bridge_if(bridge, dev, SIOCBRADDIF); + return system_bridge_if(bridge->ifname, dev, SIOCBRADDIF, NULL); } int system_bridge_delif(struct device *bridge, struct device *dev) { - return system_bridge_if(bridge, dev, SIOCBRDELIF); + return system_bridge_if(bridge->ifname, dev, SIOCBRDELIF, NULL); } -static int system_vlan(struct device *dev, int id) +static bool system_is_bridge(const char *name, char *buf, int buflen) { - struct vlan_ioctl_args ifr = { - .cmd = (id == 0) ? DEL_VLAN_CMD : ADD_VLAN_CMD, - .u = {.VID = id}, - }; - strncpy(ifr.device1, dev->ifname, sizeof(ifr.device1)); - return ioctl(sock_ioctl, SIOCSIFVLAN, &ifr); + struct stat st; + + snprintf(buf, buflen, "/sys/devices/virtual/net/%s/bridge", name); + if (stat(buf, &st) < 0) + return false; + + return true; } -int system_vlan_add(struct device *dev, int id) +static char *system_get_bridge(const char *name, char *buf, int buflen) { - return system_vlan(dev, id); + char *path; + ssize_t len; + glob_t gl; + + snprintf(buf, buflen, "/sys/devices/virtual/net/*/brif/%s/bridge", name); + if (glob(buf, GLOB_NOSORT, NULL, &gl) < 0) + return NULL; + + if (gl.gl_pathc == 0) + return NULL; + + len = readlink(gl.gl_pathv[0], buf, buflen); + if (len < 0) + return NULL; + + buf[len] = 0; + path = strrchr(buf, '/'); + if (!path) + return NULL; + + return path + 1; } -int system_vlan_del(struct device *dev) +static int system_if_resolve(struct device *dev) { - return system_vlan(dev, 0); + struct ifreq ifr; + strncpy(ifr.ifr_name, dev->ifname, sizeof(ifr.ifr_name)); + if (!ioctl(sock_ioctl, SIOCGIFINDEX, &ifr)) + return ifr.ifr_ifindex; + else + return 0; } -static int system_if_flags(struct device *dev, unsigned add, unsigned rem) +static int system_if_flags(const char *ifname, unsigned add, unsigned rem) { struct ifreq ifr; - strncpy(ifr.ifr_name, dev->ifname, sizeof(ifr.ifr_name)); + strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name)); ioctl(sock_ioctl, SIOCGIFFLAGS, &ifr); ifr.ifr_flags |= add; ifr.ifr_flags &= ~rem; return ioctl(sock_ioctl, SIOCSIFFLAGS, &ifr); } -static int system_if_resolve(struct device *dev) +/* + * Clear bridge (membership) state and bring down device + */ +void system_if_clear_state(struct device *dev) { - struct ifreq ifr; - strncpy(ifr.ifr_name, dev->ifname, sizeof(ifr.ifr_name)); - if (!ioctl(sock_ioctl, SIOCGIFINDEX, &ifr)) - return ifr.ifr_ifindex; - else - return 0; + char buf[256]; + char *bridge; + + dev->ifindex = system_if_resolve(dev); + if (!dev->ifindex) + return; + + system_if_flags(dev->ifname, 0, IFF_UP); + + if (system_is_bridge(dev->ifname, buf, sizeof(buf))) { + D(SYSTEM, "Delete existing bridge named '%s'\n", dev->ifname); + system_bridge_delbr(dev); + return; + } + + bridge = system_get_bridge(dev->ifname, buf, sizeof(buf)); + if (bridge) { + D(SYSTEM, "Remove device '%s' from bridge '%s'\n", dev->ifname, bridge); + system_bridge_if(bridge, dev, SIOCBRDELIF, NULL); + } +} + +static inline unsigned long +sec_to_jiffies(int val) +{ + return (unsigned long) val * 100; +} + +int system_bridge_addbr(struct device *bridge, struct bridge_config *cfg) +{ + unsigned long args[4] = {}; + + if (ioctl(sock_ioctl, SIOCBRADDBR, bridge->ifname) < 0) + return -1; + + args[0] = BRCTL_SET_BRIDGE_STP_STATE; + args[1] = !!cfg->stp; + system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args); + + args[0] = BRCTL_SET_BRIDGE_FORWARD_DELAY; + args[1] = sec_to_jiffies(cfg->forward_delay); + system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args); + + if (cfg->flags & BRIDGE_OPT_AGEING_TIME) { + args[0] = BRCTL_SET_AGEING_TIME; + args[1] = sec_to_jiffies(cfg->ageing_time); + system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args); + } + + if (cfg->flags & BRIDGE_OPT_HELLO_TIME) { + args[0] = BRCTL_SET_BRIDGE_HELLO_TIME; + args[1] = sec_to_jiffies(cfg->hello_time); + system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args); + } + + if (cfg->flags & BRIDGE_OPT_MAX_AGE) { + args[0] = BRCTL_SET_BRIDGE_MAX_AGE; + args[1] = sec_to_jiffies(cfg->max_age); + system_bridge_if(bridge->ifname, NULL, SIOCDEVPRIVATE, &args); + } + + return 0; +} + +static int system_vlan(struct device *dev, int id) +{ + struct vlan_ioctl_args ifr = { + .cmd = SET_VLAN_NAME_TYPE_CMD, + .u.name_type = VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, + }; + + ioctl(sock_ioctl, SIOCSIFVLAN, &ifr); + + if (id < 0) { + ifr.cmd = DEL_VLAN_CMD; + ifr.u.VID = 0; + } else { + ifr.cmd = ADD_VLAN_CMD; + ifr.u.VID = id; + } + strncpy(ifr.device1, dev->ifname, sizeof(ifr.device1)); + return ioctl(sock_ioctl, SIOCSIFVLAN, &ifr); +} + +int system_vlan_add(struct device *dev, int id) +{ + return system_vlan(dev, id); +} + +int system_vlan_del(struct device *dev) +{ + return system_vlan(dev, -1); } int system_if_up(struct device *dev) { dev->ifindex = system_if_resolve(dev); - return system_if_flags(dev, IFF_UP, 0); + return system_if_flags(dev->ifname, IFF_UP, 0); } int system_if_down(struct device *dev) { - return system_if_flags(dev, 0, IFF_UP); + return system_if_flags(dev->ifname, 0, IFF_UP); } int system_if_check(struct device *dev)