core.c 8.8 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14
/*
 * Copyright (C) 2007, 2008, 2009 Siemens AG
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2
 * as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 */

15
#include <linux/slab.h>
16 17 18 19
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/device.h>

20
#include <net/cfg802154.h>
21
#include <net/rtnetlink.h>
22

23
#include "ieee802154.h"
24
#include "nl802154.h"
A
Alexander Aring 已提交
25
#include "sysfs.h"
26
#include "core.h"
27

28 29 30
/* name for sysfs, %d is appended */
#define PHY_NAME "phy"

31
/* RCU-protected (and RTNL for writers) */
32
LIST_HEAD(cfg802154_rdev_list);
33
int cfg802154_rdev_list_generation;
34

35
static int wpan_phy_match(struct device *dev, const void *data)
36 37 38 39 40 41 42 43 44 45 46
{
	return !strcmp(dev_name(dev), (const char *)data);
}

struct wpan_phy *wpan_phy_find(const char *str)
{
	struct device *dev;

	if (WARN_ON(!str))
		return NULL;

47
	dev = class_find_device(&wpan_phy_class, NULL, str, wpan_phy_match);
48 49 50 51 52 53 54
	if (!dev)
		return NULL;

	return container_of(dev, struct wpan_phy, dev);
}
EXPORT_SYMBOL(wpan_phy_find);

55 56 57 58 59 60 61 62 63
struct wpan_phy_iter_data {
	int (*fn)(struct wpan_phy *phy, void *data);
	void *data;
};

static int wpan_phy_iter(struct device *dev, void *_data)
{
	struct wpan_phy_iter_data *wpid = _data;
	struct wpan_phy *phy = container_of(dev, struct wpan_phy, dev);
64

65 66 67 68
	return wpid->fn(phy, wpid->data);
}

int wpan_phy_for_each(int (*fn)(struct wpan_phy *phy, void *data),
69
		      void *data)
70 71 72 73 74 75 76 77 78 79 80
{
	struct wpan_phy_iter_data wpid = {
		.fn = fn,
		.data = data,
	};

	return class_for_each_device(&wpan_phy_class, NULL,
			&wpid, wpan_phy_iter);
}
EXPORT_SYMBOL(wpan_phy_for_each);

81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97
struct cfg802154_registered_device *
cfg802154_rdev_by_wpan_phy_idx(int wpan_phy_idx)
{
	struct cfg802154_registered_device *result = NULL, *rdev;

	ASSERT_RTNL();

	list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
		if (rdev->wpan_phy_idx == wpan_phy_idx) {
			result = rdev;
			break;
		}
	}

	return result;
}

98 99 100 101 102 103 104 105 106 107 108 109
struct wpan_phy *wpan_phy_idx_to_wpan_phy(int wpan_phy_idx)
{
	struct cfg802154_registered_device *rdev;

	ASSERT_RTNL();

	rdev = cfg802154_rdev_by_wpan_phy_idx(wpan_phy_idx);
	if (!rdev)
		return NULL;
	return &rdev->wpan_phy;
}

110
struct wpan_phy *
111
wpan_phy_new(const struct cfg802154_ops *ops, size_t priv_size)
112
{
113
	static atomic_t wpan_phy_counter = ATOMIC_INIT(0);
114 115 116 117 118 119 120 121 122
	struct cfg802154_registered_device *rdev;
	size_t alloc_size;

	alloc_size = sizeof(*rdev) + priv_size;
	rdev = kzalloc(alloc_size, GFP_KERNEL);
	if (!rdev)
		return NULL;

	rdev->ops = ops;
123

124 125 126 127 128
	rdev->wpan_phy_idx = atomic_inc_return(&wpan_phy_counter);

	if (unlikely(rdev->wpan_phy_idx < 0)) {
		/* ugh, wrapped! */
		atomic_dec(&wpan_phy_counter);
129
		kfree(rdev);
130
		return NULL;
131
	}
132 133 134

	/* atomic_inc_return makes it start at 1, make it start at 0 */
	rdev->wpan_phy_idx--;
135

A
Alexander Aring 已提交
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);
139

140 141
	rdev->wpan_phy.dev.class = &wpan_phy_class;
	rdev->wpan_phy.dev.platform_data = rdev;
142

A
Alexander Aring 已提交
143 144
	wpan_phy_net_set(&rdev->wpan_phy, &init_net);

A
Alexander Aring 已提交
145 146
	init_waitqueue_head(&rdev->dev_wait);

147
	return &rdev->wpan_phy;
148
}
149
EXPORT_SYMBOL(wpan_phy_new);
150

151
int wpan_phy_register(struct wpan_phy *phy)
152
{
153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
	struct cfg802154_registered_device *rdev = wpan_phy_to_rdev(phy);
	int ret;

	rtnl_lock();
	ret = device_add(&phy->dev);
	if (ret) {
		rtnl_unlock();
		return ret;
	}

	list_add_rcu(&rdev->list, &cfg802154_rdev_list);
	cfg802154_rdev_list_generation++;

	/* TODO phy registered lock */
	rtnl_unlock();

	/* TODO nl802154 phy notify */

	return 0;
172 173 174 175 176
}
EXPORT_SYMBOL(wpan_phy_register);

void wpan_phy_unregister(struct wpan_phy *phy)
{
177 178
	struct cfg802154_registered_device *rdev = wpan_phy_to_rdev(phy);

A
Alexander Aring 已提交
179 180 181 182 183 184
	wait_event(rdev->dev_wait, ({
		int __count;
		rtnl_lock();
		__count = rdev->opencount;
		rtnl_unlock();
		__count == 0; }));
185 186 187 188 189

	rtnl_lock();
	/* TODO nl802154 phy notify */
	/* TODO phy registered lock */

A
Alexander Aring 已提交
190
	WARN_ON(!list_empty(&rdev->wpan_dev_list));
191 192 193 194 195 196 197 198 199

	/* First remove the hardware from everywhere, this makes
	 * it impossible to find from userspace.
	 */
	list_del_rcu(&rdev->list);
	synchronize_rcu();

	cfg802154_rdev_list_generation++;

200
	device_del(&phy->dev);
201 202

	rtnl_unlock();
203 204 205 206 207 208 209 210 211
}
EXPORT_SYMBOL(wpan_phy_unregister);

void wpan_phy_free(struct wpan_phy *phy)
{
	put_device(&phy->dev);
}
EXPORT_SYMBOL(wpan_phy_free);

A
Alexander Aring 已提交
212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254
int cfg802154_switch_netns(struct cfg802154_registered_device *rdev,
			   struct net *net)
{
	struct wpan_dev *wpan_dev;
	int err = 0;

	list_for_each_entry(wpan_dev, &rdev->wpan_dev_list, list) {
		if (!wpan_dev->netdev)
			continue;
		wpan_dev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
		err = dev_change_net_namespace(wpan_dev->netdev, net, "wpan%d");
		if (err)
			break;
		wpan_dev->netdev->features |= NETIF_F_NETNS_LOCAL;
	}

	if (err) {
		/* failed -- clean up to old netns */
		net = wpan_phy_net(&rdev->wpan_phy);

		list_for_each_entry_continue_reverse(wpan_dev,
						     &rdev->wpan_dev_list,
						     list) {
			if (!wpan_dev->netdev)
				continue;
			wpan_dev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
			err = dev_change_net_namespace(wpan_dev->netdev, net,
						       "wpan%d");
			WARN_ON(err);
			wpan_dev->netdev->features |= NETIF_F_NETNS_LOCAL;
		}

		return err;
	}

	wpan_phy_net_set(&rdev->wpan_phy, net);

	err = device_rename(&rdev->wpan_phy.dev, dev_name(&rdev->wpan_phy.dev));
	WARN_ON(err);

	return 0;
}

255 256 257 258 259
void cfg802154_dev_free(struct cfg802154_registered_device *rdev)
{
	kfree(rdev);
}

A
Alexander Aring 已提交
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285
static void
cfg802154_update_iface_num(struct cfg802154_registered_device *rdev,
			   int iftype, int num)
{
	ASSERT_RTNL();

	rdev->num_running_ifaces += num;
}

static int cfg802154_netdev_notifier_call(struct notifier_block *nb,
					  unsigned long state, void *ptr)
{
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
	struct wpan_dev *wpan_dev = dev->ieee802154_ptr;
	struct cfg802154_registered_device *rdev;

	if (!wpan_dev)
		return NOTIFY_DONE;

	rdev = wpan_phy_to_rdev(wpan_dev->wpan_phy);

	/* TODO WARN_ON unspec type */

	switch (state) {
		/* TODO NETDEV_DEVTYPE */
	case NETDEV_REGISTER:
N
Nicolas Dichtel 已提交
286
		dev->features |= NETIF_F_NETNS_LOCAL;
A
Alexander Aring 已提交
287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
		wpan_dev->identifier = ++rdev->wpan_dev_id;
		list_add_rcu(&wpan_dev->list, &rdev->wpan_dev_list);
		rdev->devlist_generation++;

		wpan_dev->netdev = dev;
		break;
	case NETDEV_DOWN:
		cfg802154_update_iface_num(rdev, wpan_dev->iftype, -1);

		rdev->opencount--;
		wake_up(&rdev->dev_wait);
		break;
	case NETDEV_UP:
		cfg802154_update_iface_num(rdev, wpan_dev->iftype, 1);

		rdev->opencount++;
		break;
	case NETDEV_UNREGISTER:
		/* It is possible to get NETDEV_UNREGISTER
		 * multiple times. To detect that, check
		 * that the interface is still on the list
		 * of registered interfaces, and only then
		 * remove and clean it up.
		 */
		if (!list_empty(&wpan_dev->list)) {
			list_del_rcu(&wpan_dev->list);
			rdev->devlist_generation++;
		}
		/* synchronize (so that we won't find this netdev
		 * from other code any more) and then clear the list
		 * head so that the above code can safely check for
		 * !list_empty() to avoid double-cleanup.
		 */
		synchronize_rcu();
		INIT_LIST_HEAD(&wpan_dev->list);
		break;
	default:
		return NOTIFY_DONE;
	}

	return NOTIFY_OK;
}

static struct notifier_block cfg802154_netdev_notifier = {
	.notifier_call = cfg802154_netdev_notifier_call,
};

A
Alexander Aring 已提交
334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349
static void __net_exit cfg802154_pernet_exit(struct net *net)
{
	struct cfg802154_registered_device *rdev;

	rtnl_lock();
	list_for_each_entry(rdev, &cfg802154_rdev_list, list) {
		if (net_eq(wpan_phy_net(&rdev->wpan_phy), net))
			WARN_ON(cfg802154_switch_netns(rdev, &init_net));
	}
	rtnl_unlock();
}

static struct pernet_operations cfg802154_pernet_ops = {
	.exit = cfg802154_pernet_exit,
};

350 351
static int __init wpan_phy_class_init(void)
{
352
	int rc;
353

A
Alexander Aring 已提交
354
	rc = register_pernet_device(&cfg802154_pernet_ops);
355 356 357
	if (rc)
		goto err;

A
Alexander Aring 已提交
358 359 360 361
	rc = wpan_phy_sysfs_init();
	if (rc)
		goto err_sysfs;

A
Alexander Aring 已提交
362
	rc = register_netdevice_notifier(&cfg802154_netdev_notifier);
363 364 365
	if (rc)
		goto err_nl;

A
Alexander Aring 已提交
366 367 368 369
	rc = ieee802154_nl_init();
	if (rc)
		goto err_notifier;

370 371 372 373
	rc = nl802154_init();
	if (rc)
		goto err_ieee802154_nl;

374
	return 0;
A
Alexander Aring 已提交
375

376 377 378
err_ieee802154_nl:
	ieee802154_nl_exit();

A
Alexander Aring 已提交
379 380
err_notifier:
	unregister_netdevice_notifier(&cfg802154_netdev_notifier);
381
err_nl:
A
Alexander Aring 已提交
382
	wpan_phy_sysfs_exit();
A
Alexander Aring 已提交
383 384
err_sysfs:
	unregister_pernet_device(&cfg802154_pernet_ops);
385 386
err:
	return rc;
387
}
388
subsys_initcall(wpan_phy_class_init);
389 390 391

static void __exit wpan_phy_class_exit(void)
{
392
	nl802154_exit();
393
	ieee802154_nl_exit();
A
Alexander Aring 已提交
394
	unregister_netdevice_notifier(&cfg802154_netdev_notifier);
A
Alexander Aring 已提交
395
	wpan_phy_sysfs_exit();
A
Alexander Aring 已提交
396
	unregister_pernet_device(&cfg802154_pernet_ops);
397 398 399 400
}
module_exit(wpan_phy_class_exit);

MODULE_LICENSE("GPL v2");
401 402
MODULE_DESCRIPTION("IEEE 802.15.4 configuration interface");
MODULE_AUTHOR("Dmitry Eremin-Solenikov");