2 * Copyright (C) 2007, 2008, 2009 Siemens AG
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2
6 * as published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
15 #include <linux/slab.h>
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/device.h>
20 #include <net/cfg802154.h>
21 #include <net/rtnetlink.h>
23 #include "ieee802154.h"
28 /* name for sysfs, %d is appended */
29 #define PHY_NAME "phy"
31 /* RCU-protected (and RTNL for writers) */
32 LIST_HEAD(cfg802154_rdev_list);
33 int cfg802154_rdev_list_generation;
35 static int wpan_phy_match(struct device *dev, const void *data)
37 return !strcmp(dev_name(dev), (const char *)data);
40 struct wpan_phy *wpan_phy_find(const char *str)
47 dev = class_find_device(&wpan_phy_class, NULL, str, wpan_phy_match);
51 return container_of(dev, struct wpan_phy, dev);
53 EXPORT_SYMBOL(wpan_phy_find);
55 struct wpan_phy_iter_data {
56 int (*fn)(struct wpan_phy *phy, void *data);
60 static int wpan_phy_iter(struct device *dev, void *_data)
62 struct wpan_phy_iter_data *wpid = _data;
63 struct wpan_phy *phy = container_of(dev, struct wpan_phy, dev);
65 return wpid->fn(phy, wpid->data);
68 int wpan_phy_for_each(int (*fn)(struct wpan_phy *phy, void *data),
71 struct wpan_phy_iter_data wpid = {
76 return class_for_each_device(&wpan_phy_class, NULL,
77 &wpid, wpan_phy_iter);
79 EXPORT_SYMBOL(wpan_phy_for_each);
81 struct cfg802154_registered_device *
82 cfg802154_rdev_by_wpan_phy_idx(int wpan_phy_idx)
84 struct cfg802154_registered_device *result = NULL, *rdev;
88 list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
89 if (rdev->wpan_phy_idx == wpan_phy_idx) {
98 struct wpan_phy *wpan_phy_idx_to_wpan_phy(int wpan_phy_idx)
100 struct cfg802154_registered_device *rdev;
104 rdev = cfg802154_rdev_by_wpan_phy_idx(wpan_phy_idx);
107 return &rdev->wpan_phy;
111 wpan_phy_new(const struct cfg802154_ops *ops, size_t priv_size)
113 static atomic_t wpan_phy_counter = ATOMIC_INIT(0);
114 struct cfg802154_registered_device *rdev;
117 alloc_size = sizeof(*rdev) + priv_size;
118 rdev = kzalloc(alloc_size, GFP_KERNEL);
124 rdev->wpan_phy_idx = atomic_inc_return(&wpan_phy_counter);
126 if (unlikely(rdev->wpan_phy_idx < 0)) {
128 atomic_dec(&wpan_phy_counter);
133 /* atomic_inc_return makes it start at 1, make it start at 0 */
134 rdev->wpan_phy_idx--;
136 INIT_LIST_HEAD(&rdev->wpan_dev_list);
137 device_initialize(&rdev->wpan_phy.dev);
138 dev_set_name(&rdev->wpan_phy.dev, PHY_NAME "%d", rdev->wpan_phy_idx);
140 rdev->wpan_phy.dev.class = &wpan_phy_class;
141 rdev->wpan_phy.dev.platform_data = rdev;
143 init_waitqueue_head(&rdev->dev_wait);
145 return &rdev->wpan_phy;
147 EXPORT_SYMBOL(wpan_phy_new);
149 int wpan_phy_register(struct wpan_phy *phy)
151 struct cfg802154_registered_device *rdev = wpan_phy_to_rdev(phy);
155 ret = device_add(&phy->dev);
161 list_add_rcu(&rdev->list, &cfg802154_rdev_list);
162 cfg802154_rdev_list_generation++;
164 /* TODO phy registered lock */
167 /* TODO nl802154 phy notify */
171 EXPORT_SYMBOL(wpan_phy_register);
173 void wpan_phy_unregister(struct wpan_phy *phy)
175 struct cfg802154_registered_device *rdev = wpan_phy_to_rdev(phy);
177 wait_event(rdev->dev_wait, ({
180 __count = rdev->opencount;
185 /* TODO nl802154 phy notify */
186 /* TODO phy registered lock */
188 WARN_ON(!list_empty(&rdev->wpan_dev_list));
190 /* First remove the hardware from everywhere, this makes
191 * it impossible to find from userspace.
193 list_del_rcu(&rdev->list);
196 cfg802154_rdev_list_generation++;
198 device_del(&phy->dev);
202 EXPORT_SYMBOL(wpan_phy_unregister);
204 void wpan_phy_free(struct wpan_phy *phy)
206 put_device(&phy->dev);
208 EXPORT_SYMBOL(wpan_phy_free);
210 void cfg802154_dev_free(struct cfg802154_registered_device *rdev)
216 cfg802154_update_iface_num(struct cfg802154_registered_device *rdev,
221 rdev->num_running_ifaces += num;
224 static int cfg802154_netdev_notifier_call(struct notifier_block *nb,
225 unsigned long state, void *ptr)
227 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
228 struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
229 struct cfg802154_registered_device *rdev;
234 rdev = wpan_phy_to_rdev(wpan_dev->wpan_phy);
236 /* TODO WARN_ON unspec type */
239 /* TODO NETDEV_DEVTYPE */
240 case NETDEV_REGISTER:
241 dev->features |= NETIF_F_NETNS_LOCAL;
242 wpan_dev->identifier = ++rdev->wpan_dev_id;
243 list_add_rcu(&wpan_dev->list, &rdev->wpan_dev_list);
244 rdev->devlist_generation++;
246 wpan_dev->netdev = dev;
249 cfg802154_update_iface_num(rdev, wpan_dev->iftype, -1);
252 wake_up(&rdev->dev_wait);
255 cfg802154_update_iface_num(rdev, wpan_dev->iftype, 1);
259 case NETDEV_UNREGISTER:
260 /* It is possible to get NETDEV_UNREGISTER
261 * multiple times. To detect that, check
262 * that the interface is still on the list
263 * of registered interfaces, and only then
264 * remove and clean it up.
266 if (!list_empty(&wpan_dev->list)) {
267 list_del_rcu(&wpan_dev->list);
268 rdev->devlist_generation++;
270 /* synchronize (so that we won't find this netdev
271 * from other code any more) and then clear the list
272 * head so that the above code can safely check for
273 * !list_empty() to avoid double-cleanup.
276 INIT_LIST_HEAD(&wpan_dev->list);
285 static struct notifier_block cfg802154_netdev_notifier = {
286 .notifier_call = cfg802154_netdev_notifier_call,
289 static int __init wpan_phy_class_init(void)
293 rc = wpan_phy_sysfs_init();
297 rc = register_netdevice_notifier(&cfg802154_netdev_notifier);
301 rc = ieee802154_nl_init();
305 rc = nl802154_init();
307 goto err_ieee802154_nl;
312 ieee802154_nl_exit();
315 unregister_netdevice_notifier(&cfg802154_netdev_notifier);
317 wpan_phy_sysfs_exit();
321 subsys_initcall(wpan_phy_class_init);
323 static void __exit wpan_phy_class_exit(void)
326 ieee802154_nl_exit();
327 unregister_netdevice_notifier(&cfg802154_netdev_notifier);
328 wpan_phy_sysfs_exit();
330 module_exit(wpan_phy_class_exit);
332 MODULE_LICENSE("GPL v2");
333 MODULE_DESCRIPTION("IEEE 802.15.4 configuration interface");
334 MODULE_AUTHOR("Dmitry Eremin-Solenikov");