#include "netifd.h"
#include "system.h"
+static struct blob_buf b;
+
struct vlan_device {
struct device dev;
struct device_user dep;
free(vldev);
}
+static int
+__vlan_hotplug_op(struct device *dev, struct device *member, struct blob_attr *vlan, bool add)
+{
+ struct vlan_device *vldev = container_of(dev, struct vlan_device, dev);
+ void *a;
+
+ dev = vldev->dep.dev;
+ if (!dev || !dev->hotplug_ops)
+ return UBUS_STATUS_NOT_SUPPORTED;
+
+ blob_buf_init(&b, 0);
+ a = blobmsg_open_array(&b, "vlans");
+ blobmsg_printf(&b, NULL, "%d", vldev->id);
+ blobmsg_close_array(&b, a);
+
+ if (add)
+ return dev->hotplug_ops->add(dev, member, blobmsg_data(b.head));
+ else
+ return dev->hotplug_ops->del(dev, member, blobmsg_data(b.head));
+}
+
+static int
+vlan_hotplug_add(struct device *dev, struct device *member, struct blob_attr *vlan)
+{
+ return __vlan_hotplug_op(dev, member, vlan, true);
+}
+
+static int
+vlan_hotplug_del(struct device *dev, struct device *member, struct blob_attr *vlan)
+{
+ return __vlan_hotplug_op(dev, member, vlan, false);
+}
+
+static int
+vlan_hotplug_prepare(struct device *dev, struct device **bridge_dev)
+{
+ struct vlan_device *vldev = container_of(dev, struct vlan_device, dev);
+
+ dev = vldev->dep.dev;
+ if (!dev || !dev->hotplug_ops)
+ return UBUS_STATUS_NOT_SUPPORTED;
+
+ return dev->hotplug_ops->prepare(dev, bridge_dev);
+}
+
+static void vlan_hotplug_check(struct vlan_device *vldev, struct device *dev)
+{
+ static const struct device_hotplug_ops hotplug_ops = {
+ .prepare = vlan_hotplug_prepare,
+ .add = vlan_hotplug_add,
+ .del = vlan_hotplug_del
+ };
+
+ if (!dev || !dev->hotplug_ops || avl_is_empty(&dev->vlans.avl)) {
+ vldev->dev.hotplug_ops = NULL;
+ return;
+ }
+
+ vldev->dev.hotplug_ops = &hotplug_ops;
+}
+
+
static int vlan_set_device_state(struct device *dev, bool up)
{
struct vlan_device *vldev;
}
ret = device_claim(&vldev->dep);
- if (ret)
+ if (ret < 0)
return ret;
system_vlan_add(vldev->dep.dev, vldev->id);
return ret;
}
-static void vlan_dev_set_name(struct vlan_device *vldev, struct device *dev)
-{
- vldev->dev.hidden = dev->hidden;
- snprintf(vldev->dev.ifname, IFNAMSIZ, "%s.%d", dev->ifname, vldev->id);
-}
-
static void vlan_dev_cb(struct device_user *dep, enum device_event ev)
{
+ char name[IFNAMSIZ + 1];
struct vlan_device *vldev;
vldev = container_of(dep, struct vlan_device, dep);
device_set_present(&vldev->dev, false);
break;
case DEV_EVENT_UPDATE_IFNAME:
- vlan_dev_set_name(vldev, dep->dev);
- device_broadcast_event(&vldev->dev, ev);
+ vlan_hotplug_check(vldev, dep->dev);
+ vldev->dev.hidden = dep->dev->hidden;
+ if (snprintf(name, sizeof(name), "%s.%d", dep->dev->ifname,
+ vldev->id) >= sizeof(name) - 1 ||
+ device_set_ifname(&vldev->dev, name))
+ free_vlan_if(&vldev->dev);
+ break;
+ case DEV_EVENT_TOPO_CHANGE:
+ /* Propagate topo changes */
+ device_broadcast_event(&vldev->dev, DEV_EVENT_TOPO_CHANGE);
break;
default:
break;
}
}
-static struct device *get_vlan_device(struct device *dev, int id, bool create)
+static void
+vlan_config_init(struct device *dev)
+{
+ struct vlan_device *vldev;
+
+ vldev = container_of(dev, struct vlan_device, dev);
+ vlan_hotplug_check(vldev, vldev->dep.dev);
+}
+
+static struct device *get_vlan_device(struct device *dev, char *id_str, bool create)
{
- static const struct device_type vlan_type = {
+ static struct device_type vlan_type = {
.name = "VLAN",
.config_params = &device_attr_list,
+ .config_init = vlan_config_init,
.free = free_vlan_if,
};
struct vlan_device *vldev;
struct device_user *dep;
+ char name[IFNAMSIZ + 1];
+ char *err = NULL;
+ int id, *alias_id;
+
+ id = strtoul(id_str, &err, 10);
+ if (err && *err) {
+ alias_id = kvlist_get(&dev->vlan_aliases, id_str);
+ if (!alias_id)
+ return NULL;
+
+ id = *alias_id;
+ }
/* look for an existing interface before creating a new one */
list_for_each_entry(dep, &dev->users.list, list.list) {
if (!create)
return NULL;
+ if (snprintf(name, sizeof(name), "%s.%d", dev->ifname, id) >= sizeof(name) - 1)
+ return NULL;
+
+ D(DEVICE, "Create vlan device '%s'\n", name);
+
vldev = calloc(1, sizeof(*vldev));
+ if (!vldev)
+ return NULL;
+
+ vldev->id = id;
+ vldev->dev.hidden = dev->hidden;
+ strcpy(vldev->dev.ifname, name);
+
+ if (device_init(&vldev->dev, &vlan_type, NULL) < 0)
+ goto error;
- device_init_virtual(&vldev->dev, &vlan_type, NULL);
vldev->dev.default_config = true;
+ vldev->dev.config_pending = true;
vldev->set_state = vldev->dev.set_state;
vldev->dev.set_state = vlan_set_device_state;
- vldev->id = id;
- vlan_dev_set_name(vldev, dev);
-
vldev->dep.cb = vlan_dev_cb;
+ vlan_hotplug_check(vldev, vldev->dep.dev);
device_add_user(&vldev->dep, dev);
return &vldev->dev;
+
+error:
+ device_cleanup(&vldev->dev);
+ free(vldev);
+ return NULL;
}
static char *split_vlan(char *s)
struct device *get_vlan_device_chain(const char *ifname, bool create)
{
struct device *dev = NULL;
- char *buf, *s, *next, *err = NULL;
- int id;
+ char *buf, *s, *next;
buf = strdup(ifname);
if (!buf)
do {
next = split_vlan(s);
- id = strtoul(s, &err, 10);
- if (err && *err)
- goto error;
-
- dev = get_vlan_device(dev, id, create);
+ dev = get_vlan_device(dev, s, create);
if (!dev)
goto error;
projects / project / netifd.git / blobdiff