[GitHub/exynos8895/android_kernel_samsung_universal8895.git] / net / wireless / core.c

/*
 * This is the linux wireless configuration interface.
 *
 * Copyright 2006, 2007		Johannes Berg <johannes@sipsolutions.net>
 */

#include <linux/if.h>
#include <linux/module.h>
#include <linux/err.h>
#include <linux/mutex.h>
#include <linux/list.h>
#include <linux/nl80211.h>
#include <linux/debugfs.h>
#include <linux/notifier.h>
#include <linux/device.h>
#include <net/genetlink.h>
#include <net/cfg80211.h>
#include <net/wireless.h>
#include "core.h"
#include "sysfs.h"

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

MODULE_AUTHOR("Johannes Berg");
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("wireless configuration support");

/* RCU might be appropriate here since we usually
 * only read the list, and that can happen quite
 * often because we need to do it for each command */
LIST_HEAD(cfg80211_drv_list);
DEFINE_MUTEX(cfg80211_drv_mutex);
static int wiphy_counter;

/* for debugfs */
static struct dentry *ieee80211_debugfs_dir;

/* exported functions */

struct wiphy *wiphy_new(struct cfg80211_ops *ops, int sizeof_priv)
{
	struct cfg80211_registered_device *drv;
	int alloc_size;

	alloc_size = sizeof(*drv) + sizeof_priv;

	drv = kzalloc(alloc_size, GFP_KERNEL);
	if (!drv)
		return NULL;

	drv->ops = ops;

	mutex_lock(&cfg80211_drv_mutex);

	drv->idx = wiphy_counter;

	/* now increase counter for the next device unless
	 * it has wrapped previously */
	if (wiphy_counter >= 0)
		wiphy_counter++;

	mutex_unlock(&cfg80211_drv_mutex);

	if (unlikely(drv->idx < 0)) {
		/* ugh, wrapped! */
		kfree(drv);
		return NULL;
	}

	/* give it a proper name */
	snprintf(drv->wiphy.dev.bus_id, BUS_ID_SIZE,
		 PHY_NAME "%d", drv->idx);

	mutex_init(&drv->mtx);
	mutex_init(&drv->devlist_mtx);
	INIT_LIST_HEAD(&drv->netdev_list);

	device_initialize(&drv->wiphy.dev);
	drv->wiphy.dev.class = &ieee80211_class;
	drv->wiphy.dev.platform_data = drv;

	return &drv->wiphy;
}
EXPORT_SYMBOL(wiphy_new);

int wiphy_register(struct wiphy *wiphy)
{
	struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
	int res;

	mutex_lock(&cfg80211_drv_mutex);

	res = device_add(&drv->wiphy.dev);
	if (res)
		goto out_unlock;

	list_add(&drv->list, &cfg80211_drv_list);

	/* add to debugfs */
	drv->wiphy.debugfsdir =
		debugfs_create_dir(wiphy_name(&drv->wiphy),
				   ieee80211_debugfs_dir);

	res = 0;
out_unlock:
	mutex_unlock(&cfg80211_drv_mutex);
	return res;
}
EXPORT_SYMBOL(wiphy_register);

void wiphy_unregister(struct wiphy *wiphy)
{
	struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);

	/* protect the device list */
	mutex_lock(&cfg80211_drv_mutex);

	BUG_ON(!list_empty(&drv->netdev_list));

	/*
	 * Try to grab drv->mtx. If a command is still in progress,
	 * hopefully the driver will refuse it since it's tearing
	 * down the device already. We wait for this command to complete
	 * before unlinking the item from the list.
	 * Note: as codified by the BUG_ON above we cannot get here if
	 * a virtual interface is still associated. Hence, we can only
	 * get to lock contention here if userspace issues a command
	 * that identified the hardware by wiphy index.
	 */
	mutex_lock(&drv->mtx);
	/* unlock again before freeing */
	mutex_unlock(&drv->mtx);

	list_del(&drv->list);
	device_del(&drv->wiphy.dev);
	debugfs_remove(drv->wiphy.debugfsdir);

	mutex_unlock(&cfg80211_drv_mutex);
}
EXPORT_SYMBOL(wiphy_unregister);

void cfg80211_dev_free(struct cfg80211_registered_device *drv)
{
	mutex_destroy(&drv->mtx);
	mutex_destroy(&drv->devlist_mtx);
	kfree(drv);
}

void wiphy_free(struct wiphy *wiphy)
{
	put_device(&wiphy->dev);
}
EXPORT_SYMBOL(wiphy_free);

static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
					 unsigned long state,
					 void *ndev)
{
	struct net_device *dev = ndev;
	struct cfg80211_registered_device *rdev;

	if (!dev->ieee80211_ptr)
		return 0;

	rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);

	switch (state) {
	case NETDEV_REGISTER:
		mutex_lock(&rdev->devlist_mtx);
		list_add(&dev->ieee80211_ptr->list, &rdev->netdev_list);
		if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
				      "phy80211")) {
			printk(KERN_ERR "wireless: failed to add phy80211 "
				"symlink to netdev!\n");
		}
		dev->ieee80211_ptr->netdev = dev;
		mutex_unlock(&rdev->devlist_mtx);
		break;
	case NETDEV_UNREGISTER:
		mutex_lock(&rdev->devlist_mtx);
		if (!list_empty(&dev->ieee80211_ptr->list)) {
			sysfs_remove_link(&dev->dev.kobj, "phy80211");
			list_del_init(&dev->ieee80211_ptr->list);
		}
		mutex_unlock(&rdev->devlist_mtx);
		break;
	}

	return 0;
}

static struct notifier_block cfg80211_netdev_notifier = {
	.notifier_call = cfg80211_netdev_notifier_call,
};

static int cfg80211_init(void)
{
	int err = wiphy_sysfs_init();
	if (err)
		goto out_fail_sysfs;

	err = register_netdevice_notifier(&cfg80211_netdev_notifier);
	if (err)
		goto out_fail_notifier;

	ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);

	return 0;

out_fail_notifier:
	wiphy_sysfs_exit();
out_fail_sysfs:
	return err;
}
subsys_initcall(cfg80211_init);

static void cfg80211_exit(void)
{
	debugfs_remove(ieee80211_debugfs_dir);
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
	wiphy_sysfs_exit();
}
module_exit(cfg80211_exit);
Commit	Line	Data
704232c2 JB	1	/*
	2	* This is the linux wireless configuration interface.
	3	*
	4	* Copyright 2006, 2007 Johannes Berg <johannes@sipsolutions.net>
	5	*/
	6
	7	#include <linux/if.h>
	8	#include <linux/module.h>
	9	#include <linux/err.h>
	10	#include <linux/mutex.h>
	11	#include <linux/list.h>
	12	#include <linux/nl80211.h>
	13	#include <linux/debugfs.h>
	14	#include <linux/notifier.h>
	15	#include <linux/device.h>
	16	#include <net/genetlink.h>
	17	#include <net/cfg80211.h>
	18	#include <net/wireless.h>
	19	#include "core.h"
	20	#include "sysfs.h"
	21
	22	/* name for sysfs, %d is appended */
	23	#define PHY_NAME "phy"
	24
	25	MODULE_AUTHOR("Johannes Berg");
	26	MODULE_LICENSE("GPL");
	27	MODULE_DESCRIPTION("wireless configuration support");
	28
	29	/* RCU might be appropriate here since we usually
	30	* only read the list, and that can happen quite
	31	* often because we need to do it for each command */
	32	LIST_HEAD(cfg80211_drv_list);
	33	DEFINE_MUTEX(cfg80211_drv_mutex);
	34	static int wiphy_counter;
	35
	36	/* for debugfs */
	37	static struct dentry *ieee80211_debugfs_dir;
	38
	39	/* exported functions */
	40
	41	struct wiphy wiphy_new(struct cfg80211_ops ops, int sizeof_priv)
	42	{
	43	struct cfg80211_registered_device *drv;
	44	int alloc_size;
	45
	46	alloc_size = sizeof(*drv) + sizeof_priv;
	47
	48	drv = kzalloc(alloc_size, GFP_KERNEL);
	49	if (!drv)
	50	return NULL;
	51
	52	drv->ops = ops;
	53
	54	mutex_lock(&cfg80211_drv_mutex);
	55
a4d73ee1 JB	56	drv->idx = wiphy_counter;
	57
	58	/* now increase counter for the next device unless
	59	* it has wrapped previously */
	60	if (wiphy_counter >= 0)
	61	wiphy_counter++;
	62
	63	mutex_unlock(&cfg80211_drv_mutex);
	64
	65	if (unlikely(drv->idx < 0)) {
704232c2 JB	66	/* ugh, wrapped! */
	67	kfree(drv);
	68	return NULL;
	69	}
704232c2 JB	70
	71	/* give it a proper name */
	72	snprintf(drv->wiphy.dev.bus_id, BUS_ID_SIZE,
	73	PHY_NAME "%d", drv->idx);
	74
704232c2 JB	75	mutex_init(&drv->mtx);
	76	mutex_init(&drv->devlist_mtx);
	77	INIT_LIST_HEAD(&drv->netdev_list);
	78
	79	device_initialize(&drv->wiphy.dev);
	80	drv->wiphy.dev.class = &ieee80211_class;
	81	drv->wiphy.dev.platform_data = drv;
	82
	83	return &drv->wiphy;
	84	}
	85	EXPORT_SYMBOL(wiphy_new);
	86
	87	int wiphy_register(struct wiphy *wiphy)
	88	{
	89	struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
	90	int res;
	91
	92	mutex_lock(&cfg80211_drv_mutex);
	93
704232c2 JB	94	res = device_add(&drv->wiphy.dev);
	95	if (res)
	96	goto out_unlock;
	97
	98	list_add(&drv->list, &cfg80211_drv_list);
	99
	100	/* add to debugfs */
	101	drv->wiphy.debugfsdir =
	102	debugfs_create_dir(wiphy_name(&drv->wiphy),
	103	ieee80211_debugfs_dir);
	104
	105	res = 0;
	106	out_unlock:
	107	mutex_unlock(&cfg80211_drv_mutex);
	108	return res;
	109	}
	110	EXPORT_SYMBOL(wiphy_register);
	111
	112	void wiphy_unregister(struct wiphy *wiphy)
	113	{
	114	struct cfg80211_registered_device *drv = wiphy_to_dev(wiphy);
	115
f16bfc1c	116	/* protect the device list */
704232c2 JB	117	mutex_lock(&cfg80211_drv_mutex);
704232c2 JB	118
f16bfc1c JB	119	BUG_ON(!list_empty(&drv->netdev_list));
	120
	121	/*
	122	* Try to grab drv->mtx. If a command is still in progress,
	123	* hopefully the driver will refuse it since it's tearing
	124	* down the device already. We wait for this command to complete
	125	* before unlinking the item from the list.
	126	* Note: as codified by the BUG_ON above we cannot get here if
	127	* a virtual interface is still associated. Hence, we can only
	128	* get to lock contention here if userspace issues a command
	129	* that identified the hardware by wiphy index.
	130	*/
704232c2	131	mutex_lock(&drv->mtx);
f16bfc1c	132	/* unlock again before freeing */
704232c2 JB	133	mutex_unlock(&drv->mtx);
704232c2 JB	134
f16bfc1c	135	list_del(&drv->list);
704232c2 JB	136	device_del(&drv->wiphy.dev);
	137	debugfs_remove(drv->wiphy.debugfsdir);
	138
	139	mutex_unlock(&cfg80211_drv_mutex);
	140	}
	141	EXPORT_SYMBOL(wiphy_unregister);
	142
	143	void cfg80211_dev_free(struct cfg80211_registered_device *drv)
	144	{
	145	mutex_destroy(&drv->mtx);
	146	mutex_destroy(&drv->devlist_mtx);
	147	kfree(drv);
	148	}
	149
	150	void wiphy_free(struct wiphy *wiphy)
	151	{
	152	put_device(&wiphy->dev);
	153	}
	154	EXPORT_SYMBOL(wiphy_free);
	155
	156	static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
	157	unsigned long state,
	158	void *ndev)
	159	{
	160	struct net_device *dev = ndev;
	161	struct cfg80211_registered_device *rdev;
	162
	163	if (!dev->ieee80211_ptr)
	164	return 0;
	165
	166	rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
	167
	168	switch (state) {
	169	case NETDEV_REGISTER:
	170	mutex_lock(&rdev->devlist_mtx);
	171	list_add(&dev->ieee80211_ptr->list, &rdev->netdev_list);
	172	if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
	173	"phy80211")) {
	174	printk(KERN_ERR "wireless: failed to add phy80211 "
	175	"symlink to netdev!\n");
	176	}
	177	dev->ieee80211_ptr->netdev = dev;
	178	mutex_unlock(&rdev->devlist_mtx);
	179	break;
	180	case NETDEV_UNREGISTER:
	181	mutex_lock(&rdev->devlist_mtx);
	182	if (!list_empty(&dev->ieee80211_ptr->list)) {
	183	sysfs_remove_link(&dev->dev.kobj, "phy80211");
	184	list_del_init(&dev->ieee80211_ptr->list);
	185	}
	186	mutex_unlock(&rdev->devlist_mtx);
	187	break;
	188	}
	189
	190	return 0;
	191	}
	192
	193	static struct notifier_block cfg80211_netdev_notifier = {
	194	.notifier_call = cfg80211_netdev_notifier_call,
	195	};
	196
	197	static int cfg80211_init(void)
	198	{
	199	int err = wiphy_sysfs_init();
200	if (err)
201	goto out_fail_sysfs;
202
203	err = register_netdevice_notifier(&cfg80211_netdev_notifier);
204	if (err)
205	goto out_fail_notifier;
206
207	ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
208
209	return 0;
210
211	out_fail_notifier:
212	wiphy_sysfs_exit();
213	out_fail_sysfs:
214	return err;
215	}
3a462465	216	subsys_initcall(cfg80211_init);
704232c2 JB	217
	218	static void cfg80211_exit(void)
	219	{
	220	debugfs_remove(ieee80211_debugfs_dir);
	221	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
	222	wiphy_sysfs_exit();
	223	}
	224	module_exit(cfg80211_exit);