7 #include <sys/socket.h>
8 #include <net/ethernet.h>
14 static struct avl_tree devices
;
25 static const struct blobmsg_policy dev_attrs
[__DEV_ATTR_MAX
] = {
26 [DEV_ATTR_NAME
] = { "name", BLOBMSG_TYPE_STRING
},
27 [DEV_ATTR_TYPE
] = { "type", BLOBMSG_TYPE_STRING
},
28 [DEV_ATTR_MTU
] = { "mtu", BLOBMSG_TYPE_INT32
},
29 [DEV_ATTR_MACADDR
] = { "macaddr", BLOBMSG_TYPE_STRING
},
30 [DEV_ATTR_TXQUEUELEN
] = { "txqueuelen", BLOBMSG_TYPE_INT32
},
33 const struct config_param_list device_attr_list
= {
34 .n_params
= __DEV_ATTR_MAX
,
39 device_init_settings(struct device
*dev
, struct blob_attr
**tb
)
41 struct blob_attr
*cur
;
42 struct ether_addr
*ea
;
46 if ((cur
= tb
[DEV_ATTR_MTU
])) {
47 dev
->mtu
= blobmsg_get_u32(cur
);
48 dev
->flags
|= DEV_OPT_MTU
;
51 if ((cur
= tb
[DEV_ATTR_TXQUEUELEN
])) {
52 dev
->txqueuelen
= blobmsg_get_u32(cur
);
53 dev
->flags
|= DEV_OPT_TXQUEUELEN
;
56 if ((cur
= tb
[DEV_ATTR_MACADDR
])) {
57 ea
= ether_aton(blob_data(cur
));
59 memcpy(dev
->macaddr
, ea
, sizeof(dev
->macaddr
));
60 dev
->flags
|= DEV_OPT_MACADDR
;
66 device_create(struct blob_attr
*attr
, struct uci_section
*s
)
68 struct blob_attr
*tb
[__DEV_ATTR_MAX
];
69 struct blob_attr
*cur
;
70 struct device
*dev
= NULL
;
73 blobmsg_parse(dev_attrs
, __DEV_ATTR_MAX
, tb
, blob_data(attr
), blob_len(attr
));
74 if (!tb
[DEV_ATTR_NAME
])
77 name
= blobmsg_data(tb
[DEV_ATTR_NAME
]);
78 if ((cur
= tb
[DEV_ATTR_TYPE
])) {
79 if (!strcmp(blobmsg_data(cur
), "bridge"))
80 dev
= bridge_create(name
, s
);
82 dev
= device_get(name
, true);
88 device_init_settings(dev
, tb
);
94 static void __init
dev_init(void)
96 avl_init(&devices
, avl_strcmp
, false, NULL
);
99 static void free_simple_device(struct device
*dev
)
105 static void broadcast_device_event(struct device
*dev
, enum device_event ev
)
107 struct device_user
*dep
, *tmp
;
109 list_for_each_entry_safe(dep
, tmp
, &dev
->users
, list
) {
117 static int set_device_state(struct device
*dev
, bool state
)
127 int claim_device(struct device
*dev
)
131 DPRINTF("claim device %s, new refcount: %d\n", dev
->ifname
, dev
->active
+ 1);
132 if (++dev
->active
!= 1)
135 broadcast_device_event(dev
, DEV_EVENT_SETUP
);
136 ret
= dev
->set_state(dev
, true);
138 broadcast_device_event(dev
, DEV_EVENT_UP
);
145 void release_device(struct device
*dev
)
148 DPRINTF("release device %s, new refcount: %d\n", dev
->ifname
, dev
->active
);
149 assert(dev
->active
>= 0);
154 broadcast_device_event(dev
, DEV_EVENT_TEARDOWN
);
155 dev
->set_state(dev
, false);
156 broadcast_device_event(dev
, DEV_EVENT_DOWN
);
159 int check_device_state(struct device
*dev
)
161 if (!dev
->type
->check_state
)
164 return dev
->type
->check_state(dev
);
167 void init_virtual_device(struct device
*dev
, const struct device_type
*type
, const char *name
)
173 strncpy(dev
->ifname
, name
, IFNAMSIZ
);
175 fprintf(stderr
, "Initialize device '%s'\n", dev
->ifname
);
176 INIT_LIST_HEAD(&dev
->users
);
180 int init_device(struct device
*dev
, const struct device_type
*type
, const char *ifname
)
184 init_virtual_device(dev
, type
, ifname
);
187 dev
->set_state
= set_device_state
;
189 dev
->avl
.key
= dev
->ifname
;
191 ret
= avl_insert(&devices
, &dev
->avl
);
195 check_device_state(dev
);
200 struct device
*device_get(const char *name
, bool create
)
202 static const struct device_type simple_type
= {
204 .check_state
= system_if_check
,
205 .free
= free_simple_device
,
210 if (strchr(name
, '.'))
211 return get_vlan_device_chain(name
, create
);
213 dev
= avl_find_element(&devices
, name
, dev
, avl
);
220 dev
= calloc(1, sizeof(*dev
));
221 init_device(dev
, &simple_type
, name
);
226 void device_cleanup(struct device
*dev
)
228 struct device_user
*dep
, *tmp
;
230 fprintf(stderr
, "Clean up device '%s'\n", dev
->ifname
);
231 list_for_each_entry_safe(dep
, tmp
, &dev
->users
, list
) {
235 dep
->cb(dep
, DEV_EVENT_REMOVE
);
239 avl_delete(&devices
, &dev
->avl
);
242 void device_set_present(struct device
*dev
, bool state
)
244 if (dev
->present
== state
)
247 DPRINTF("Device '%s' %s present\n", dev
->ifname
, state
? "is now" : "is no longer" );
248 dev
->present
= state
;
249 broadcast_device_event(dev
, state
? DEV_EVENT_ADD
: DEV_EVENT_REMOVE
);
252 void device_add_user(struct device_user
*dep
, struct device
*dev
)
255 list_add(&dep
->list
, &dev
->users
);
256 if (dep
->cb
&& dev
->present
) {
257 dep
->cb(dep
, DEV_EVENT_ADD
);
259 dep
->cb(dep
, DEV_EVENT_UP
);
263 void device_remove_user(struct device_user
*dep
)
265 struct device
*dev
= dep
->dev
;
267 list_del(&dep
->list
);
269 if (list_empty(&dev
->users
)) {
270 /* all references have gone away, remove this device */
278 device_free_all(void)
280 struct device
*dev
, *tmp
;
282 avl_for_each_element_safe(&devices
, dev
, avl
, tmp
) {
283 if (!list_empty(&dev
->users
))