2 * netifd - network interface daemon
3 * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2
7 * as published by the Free Software Foundation
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
23 struct device_user dep
;
25 device_state_cb set_state
;
29 static void free_vlan_if(struct device
*iface
)
31 struct vlan_device
*vldev
;
33 vldev
= container_of(iface
, struct vlan_device
, dev
);
34 device_remove_user(&vldev
->dep
);
35 device_cleanup(&vldev
->dev
);
39 static int vlan_set_device_state(struct device
*dev
, bool up
)
41 struct vlan_device
*vldev
;
44 vldev
= container_of(dev
, struct vlan_device
, dev
);
46 vldev
->set_state(dev
, false);
48 device_release(&vldev
->dep
);
52 ret
= device_claim(&vldev
->dep
);
56 system_vlan_add(vldev
->dep
.dev
, vldev
->id
);
57 ret
= vldev
->set_state(dev
, true);
59 device_release(&vldev
->dep
);
64 static void vlan_dev_cb(struct device_user
*dep
, enum device_event ev
)
66 char name
[IFNAMSIZ
+ 1];
67 struct vlan_device
*vldev
;
69 vldev
= container_of(dep
, struct vlan_device
, dep
);
72 device_set_present(&vldev
->dev
, true);
74 case DEV_EVENT_REMOVE
:
75 device_set_present(&vldev
->dev
, false);
77 case DEV_EVENT_UPDATE_IFNAME
:
78 vldev
->dev
.hidden
= dep
->dev
->hidden
;
79 if (snprintf(name
, sizeof(name
), "%s.%d", dep
->dev
->ifname
,
80 vldev
->id
) >= sizeof(name
) - 1 ||
81 device_set_ifname(&vldev
->dev
, name
))
82 free_vlan_if(&vldev
->dev
);
84 case DEV_EVENT_TOPO_CHANGE
:
85 /* Propagate topo changes */
86 device_broadcast_event(&vldev
->dev
, DEV_EVENT_TOPO_CHANGE
);
93 static struct device
*get_vlan_device(struct device
*dev
, int id
, bool create
)
95 static struct device_type vlan_type
= {
97 .config_params
= &device_attr_list
,
100 struct vlan_device
*vldev
;
101 struct device_user
*dep
;
102 char name
[IFNAMSIZ
+ 1];
104 /* look for an existing interface before creating a new one */
105 list_for_each_entry(dep
, &dev
->users
.list
, list
.list
) {
106 if (dep
->cb
!= vlan_dev_cb
)
109 vldev
= container_of(dep
, struct vlan_device
, dep
);
119 if (snprintf(name
, sizeof(name
), "%s.%d", dev
->ifname
, id
) >= sizeof(name
) - 1)
122 D(DEVICE
, "Create vlan device '%s'\n", name
);
124 vldev
= calloc(1, sizeof(*vldev
));
129 vldev
->dev
.hidden
= dev
->hidden
;
130 strcpy(vldev
->dev
.ifname
, name
);
132 if (device_init(&vldev
->dev
, &vlan_type
, NULL
) < 0)
135 vldev
->dev
.default_config
= true;
137 vldev
->set_state
= vldev
->dev
.set_state
;
138 vldev
->dev
.set_state
= vlan_set_device_state
;
140 vldev
->dep
.cb
= vlan_dev_cb
;
141 device_add_user(&vldev
->dep
, dev
);
146 device_cleanup(&vldev
->dev
);
151 static char *split_vlan(char *s
)
164 struct device
*get_vlan_device_chain(const char *ifname
, bool create
)
166 struct device
*dev
= NULL
;
167 char *buf
, *s
, *next
, *err
= NULL
;
170 buf
= strdup(ifname
);
175 dev
= device_get(buf
, create
);
180 next
= split_vlan(s
);
181 id
= strtoul(s
, &err
, 10);
185 dev
= get_vlan_device(dev
, id
, create
);