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) {
99 wpan_phy_new(const struct cfg802154_ops *ops, size_t priv_size)
101 static atomic_t wpan_phy_counter = ATOMIC_INIT(0);
102 struct cfg802154_registered_device *rdev;
105 alloc_size = sizeof(*rdev) + priv_size;
106 rdev = kzalloc(alloc_size, GFP_KERNEL);
112 rdev->wpan_phy_idx = atomic_inc_return(&wpan_phy_counter);
114 if (unlikely(rdev->wpan_phy_idx < 0)) {
116 atomic_dec(&wpan_phy_counter);
121 /* atomic_inc_return makes it start at 1, make it start at 0 */
122 rdev->wpan_phy_idx--;
124 INIT_LIST_HEAD(&rdev->wpan_dev_list);
125 device_initialize(&rdev->wpan_phy.dev);
126 dev_set_name(&rdev->wpan_phy.dev, PHY_NAME "%d", rdev->wpan_phy_idx);
128 rdev->wpan_phy.dev.class = &wpan_phy_class;
129 rdev->wpan_phy.dev.platform_data = rdev;
131 init_waitqueue_head(&rdev->dev_wait);
133 return &rdev->wpan_phy;
135 EXPORT_SYMBOL(wpan_phy_new);
137 int wpan_phy_register(struct wpan_phy *phy)
139 struct cfg802154_registered_device *rdev = wpan_phy_to_rdev(phy);
143 ret = device_add(&phy->dev);
149 list_add_rcu(&rdev->list, &cfg802154_rdev_list);
150 cfg802154_rdev_list_generation++;
152 /* TODO phy registered lock */
155 /* TODO nl802154 phy notify */
159 EXPORT_SYMBOL(wpan_phy_register);
161 void wpan_phy_unregister(struct wpan_phy *phy)
163 struct cfg802154_registered_device *rdev = wpan_phy_to_rdev(phy);
165 wait_event(rdev->dev_wait, ({
168 __count = rdev->opencount;
173 /* TODO nl802154 phy notify */
174 /* TODO phy registered lock */
176 WARN_ON(!list_empty(&rdev->wpan_dev_list));
178 /* First remove the hardware from everywhere, this makes
179 * it impossible to find from userspace.
181 list_del_rcu(&rdev->list);
184 cfg802154_rdev_list_generation++;
186 device_del(&phy->dev);
190 EXPORT_SYMBOL(wpan_phy_unregister);
192 void wpan_phy_free(struct wpan_phy *phy)
194 put_device(&phy->dev);
196 EXPORT_SYMBOL(wpan_phy_free);
198 void cfg802154_dev_free(struct cfg802154_registered_device *rdev)
204 cfg802154_update_iface_num(struct cfg802154_registered_device *rdev,
209 rdev->num_running_ifaces += num;
212 static int cfg802154_netdev_notifier_call(struct notifier_block *nb,
213 unsigned long state, void *ptr)
215 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
216 struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
217 struct cfg802154_registered_device *rdev;
222 rdev = wpan_phy_to_rdev(wpan_dev->wpan_phy);
224 /* TODO WARN_ON unspec type */
227 /* TODO NETDEV_DEVTYPE */
228 case NETDEV_REGISTER:
229 dev->features |= NETIF_F_NETNS_LOCAL;
230 wpan_dev->identifier = ++rdev->wpan_dev_id;
231 list_add_rcu(&wpan_dev->list, &rdev->wpan_dev_list);
232 rdev->devlist_generation++;
234 wpan_dev->netdev = dev;
237 cfg802154_update_iface_num(rdev, wpan_dev->iftype, -1);
240 wake_up(&rdev->dev_wait);
243 cfg802154_update_iface_num(rdev, wpan_dev->iftype, 1);
247 case NETDEV_UNREGISTER:
248 /* It is possible to get NETDEV_UNREGISTER
249 * multiple times. To detect that, check
250 * that the interface is still on the list
251 * of registered interfaces, and only then
252 * remove and clean it up.
254 if (!list_empty(&wpan_dev->list)) {
255 list_del_rcu(&wpan_dev->list);
256 rdev->devlist_generation++;
258 /* synchronize (so that we won't find this netdev
259 * from other code any more) and then clear the list
260 * head so that the above code can safely check for
261 * !list_empty() to avoid double-cleanup.
264 INIT_LIST_HEAD(&wpan_dev->list);
273 static struct notifier_block cfg802154_netdev_notifier = {
274 .notifier_call = cfg802154_netdev_notifier_call,
277 static int __init wpan_phy_class_init(void)
281 rc = wpan_phy_sysfs_init();
285 rc = register_netdevice_notifier(&cfg802154_netdev_notifier);
289 rc = ieee802154_nl_init();
293 rc = nl802154_init();
295 goto err_ieee802154_nl;
300 ieee802154_nl_exit();
303 unregister_netdevice_notifier(&cfg802154_netdev_notifier);
305 wpan_phy_sysfs_exit();
309 subsys_initcall(wpan_phy_class_init);
311 static void __exit wpan_phy_class_exit(void)
314 ieee802154_nl_exit();
315 unregister_netdevice_notifier(&cfg802154_netdev_notifier);
316 wpan_phy_sysfs_exit();
318 module_exit(wpan_phy_class_exit);
320 MODULE_LICENSE("GPL v2");
321 MODULE_DESCRIPTION("IEEE 802.15.4 configuration interface");
322 MODULE_AUTHOR("Dmitry Eremin-Solenikov");