[deliverable/linux.git] / net / mac802154 / mib.c

/*
 * Copyright 2007-2012 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.
 *
 * Written by:
 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
 * Sergey Lapin <slapin@ossfans.org>
 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
 */

#include <linux/if_arp.h>

#include <net/mac802154.h>
#include <net/ieee802154_netdev.h>
#include <net/cfg802154.h>

#include "ieee802154_i.h"
#include "driver-ops.h"

void mac802154_dev_set_short_addr(struct net_device *dev, __le16 val)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	spin_lock_bh(&sdata->mib_lock);
	sdata->wpan_dev.short_addr = val;
	spin_unlock_bh(&sdata->mib_lock);
}

__le16 mac802154_dev_get_short_addr(const struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	__le16 ret;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	spin_lock_bh(&sdata->mib_lock);
	ret = sdata->wpan_dev.short_addr;
	spin_unlock_bh(&sdata->mib_lock);

	return ret;
}

__le16 mac802154_dev_get_pan_id(const struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	__le16 ret;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	spin_lock_bh(&sdata->mib_lock);
	ret = sdata->wpan_dev.pan_id;
	spin_unlock_bh(&sdata->mib_lock);

	return ret;
}

void mac802154_dev_set_pan_id(struct net_device *dev, __le16 val)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	spin_lock_bh(&sdata->mib_lock);
	sdata->wpan_dev.pan_id = val;
	spin_unlock_bh(&sdata->mib_lock);
}

u8 mac802154_dev_get_dsn(const struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	return sdata->wpan_dev.dsn++;
}

void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct ieee802154_local *local = sdata->local;
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	res = drv_set_channel(local, page, chan);
	if (res) {
		pr_debug("set_channel failed\n");
	} else {
		mutex_lock(&local->phy->pib_lock);
		local->phy->current_channel = chan;
		local->phy->current_page = page;
		mutex_unlock(&local->phy->pib_lock);
	}
}

int mac802154_get_params(struct net_device *dev,
			 struct ieee802154_llsec_params *params)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_get_params(&sdata->sec, params);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_set_params(struct net_device *dev,
			 const struct ieee802154_llsec_params *params,
			 int changed)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_set_params(&sdata->sec, params, changed);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_add_key(struct net_device *dev,
		      const struct ieee802154_llsec_key_id *id,
		      const struct ieee802154_llsec_key *key)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_key_add(&sdata->sec, id, key);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_del_key(struct net_device *dev,
		      const struct ieee802154_llsec_key_id *id)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_key_del(&sdata->sec, id);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_add_dev(struct net_device *dev,
		      const struct ieee802154_llsec_device *llsec_dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_del_dev(struct net_device *dev, __le64 dev_addr)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_dev_del(&sdata->sec, dev_addr);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_add_devkey(struct net_device *dev,
			 __le64 device_addr,
			 const struct ieee802154_llsec_device_key *key)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_del_devkey(struct net_device *dev,
			 __le64 device_addr,
			 const struct ieee802154_llsec_device_key *key)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_add_seclevel(struct net_device *dev,
			   const struct ieee802154_llsec_seclevel *sl)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_seclevel_add(&sdata->sec, sl);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

int mac802154_del_seclevel(struct net_device *dev,
			   const struct ieee802154_llsec_seclevel *sl)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	int res;

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
	res = mac802154_llsec_seclevel_del(&sdata->sec, sl);
	mutex_unlock(&sdata->sec_mtx);

	return res;
}

void mac802154_lock_table(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_lock(&sdata->sec_mtx);
}

void mac802154_get_table(struct net_device *dev,
			 struct ieee802154_llsec_table **t)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	*t = &sdata->sec.table;
}

void mac802154_unlock_table(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	BUG_ON(dev->type != ARPHRD_IEEE802154);

	mutex_unlock(&sdata->sec_mtx);
}
Commit	Line	Data
ef2486f5	1	/*
	2	* Copyright 2007-2012 Siemens AG
	3	*
	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.
	7	*
	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.
	12	*
ef2486f5	13	* Written by:
	14	* Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
	15	* Sergey Lapin <slapin@ossfans.org>
	16	* Maxim Gorbachyov <maxim.gorbachev@siemens.com>
	17	* Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
	18	*/
	19
	20	#include <linux/if_arp.h>
	21
	22	#include <net/mac802154.h>
b70ab2e8	23	#include <net/ieee802154_netdev.h>
5ad60d36	24	#include <net/cfg802154.h>
ef2486f5	25
0f1556bc	26	#include "ieee802154_i.h"
59cb300f	27	#include "driver-ops.h"
ef2486f5	28
b70ab2e8	29	void mac802154_dev_set_short_addr(struct net_device *dev, __le16 val)
48e44d50	30	{
59d19cd7	31	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
48e44d50	32
	33	BUG_ON(dev->type != ARPHRD_IEEE802154);
	34
036562f9	35	spin_lock_bh(&sdata->mib_lock);
863e88f2	36	sdata->wpan_dev.short_addr = val;
036562f9	37	spin_unlock_bh(&sdata->mib_lock);
48e44d50	38	}
48e44d50	39
b70ab2e8	40	__le16 mac802154_dev_get_short_addr(const struct net_device *dev)
e885a47a	41	{
59d19cd7	42	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
b70ab2e8	43	__le16 ret;
e885a47a	44
	45	BUG_ON(dev->type != ARPHRD_IEEE802154);
	46
036562f9	47	spin_lock_bh(&sdata->mib_lock);
863e88f2	48	ret = sdata->wpan_dev.short_addr;
036562f9	49	spin_unlock_bh(&sdata->mib_lock);
e885a47a	50
	51	return ret;
	52	}
	53
b70ab2e8	54	__le16 mac802154_dev_get_pan_id(const struct net_device *dev)
dcbe4f93	55	{
59d19cd7	56	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
b70ab2e8	57	__le16 ret;
dcbe4f93	58
	59	BUG_ON(dev->type != ARPHRD_IEEE802154);
	60
036562f9	61	spin_lock_bh(&sdata->mib_lock);
863e88f2	62	ret = sdata->wpan_dev.pan_id;
036562f9	63	spin_unlock_bh(&sdata->mib_lock);
dcbe4f93	64
	65	return ret;
	66	}
	67
b70ab2e8	68	void mac802154_dev_set_pan_id(struct net_device *dev, __le16 val)
dcbe4f93	69	{
59d19cd7	70	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
dcbe4f93	71
	72	BUG_ON(dev->type != ARPHRD_IEEE802154);
	73
036562f9	74	spin_lock_bh(&sdata->mib_lock);
863e88f2	75	sdata->wpan_dev.pan_id = val;
036562f9	76	spin_unlock_bh(&sdata->mib_lock);
dcbe4f93	77	}
66b69d4d	78
0483546a TC	79	u8 mac802154_dev_get_dsn(const struct net_device *dev)
0483546a TC	80	{
59d19cd7	81	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
0483546a TC	82
	83	BUG_ON(dev->type != ARPHRD_IEEE802154);
	84
863e88f2	85	return sdata->wpan_dev.dsn++;
0483546a TC	86	}
0483546a TC	87
66b69d4d	88	void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan)
66b69d4d	89	{
59d19cd7	90	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
12439a53 AA	91	struct ieee802154_local *local = sdata->local;
12439a53 AA	92	int res;
66b69d4d	93
	94	BUG_ON(dev->type != ARPHRD_IEEE802154);
	95
12439a53 AA	96	res = drv_set_channel(local, page, chan);
	97	if (res) {
	98	pr_debug("set_channel failed\n");
4710d806	99	} else {
12439a53 AA	100	mutex_lock(&local->phy->pib_lock);
	101	local->phy->current_channel = chan;
	102	local->phy->current_page = page;
	103	mutex_unlock(&local->phy->pib_lock);
4710d806	104	}
66b69d4d	105	}
29e02374	106
29e02374 PB	107	int mac802154_get_params(struct net_device *dev,
	108	struct ieee802154_llsec_params *params)
	109	{
59d19cd7	110	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	111	int res;
	112
	113	BUG_ON(dev->type != ARPHRD_IEEE802154);
	114
036562f9 AA	115	mutex_lock(&sdata->sec_mtx);
	116	res = mac802154_llsec_get_params(&sdata->sec, params);
	117	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	118
	119	return res;
	120	}
	121
	122	int mac802154_set_params(struct net_device *dev,
	123	const struct ieee802154_llsec_params *params,
	124	int changed)
	125	{
59d19cd7	126	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	127	int res;
	128
	129	BUG_ON(dev->type != ARPHRD_IEEE802154);
	130
036562f9 AA	131	mutex_lock(&sdata->sec_mtx);
	132	res = mac802154_llsec_set_params(&sdata->sec, params, changed);
	133	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	134
	135	return res;
	136	}
	137
29e02374 PB	138	int mac802154_add_key(struct net_device *dev,
	139	const struct ieee802154_llsec_key_id *id,
	140	const struct ieee802154_llsec_key *key)
	141	{
59d19cd7	142	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	143	int res;
	144
	145	BUG_ON(dev->type != ARPHRD_IEEE802154);
	146
036562f9 AA	147	mutex_lock(&sdata->sec_mtx);
	148	res = mac802154_llsec_key_add(&sdata->sec, id, key);
	149	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	150
	151	return res;
	152	}
	153
	154	int mac802154_del_key(struct net_device *dev,
	155	const struct ieee802154_llsec_key_id *id)
	156	{
59d19cd7	157	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	158	int res;
	159
	160	BUG_ON(dev->type != ARPHRD_IEEE802154);
	161
036562f9 AA	162	mutex_lock(&sdata->sec_mtx);
	163	res = mac802154_llsec_key_del(&sdata->sec, id);
	164	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	165
	166	return res;
	167	}
	168
29e02374 PB	169	int mac802154_add_dev(struct net_device *dev,
	170	const struct ieee802154_llsec_device *llsec_dev)
	171	{
59d19cd7	172	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	173	int res;
	174
	175	BUG_ON(dev->type != ARPHRD_IEEE802154);
	176
036562f9 AA	177	mutex_lock(&sdata->sec_mtx);
	178	res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev);
	179	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	180
	181	return res;
	182	}
	183
	184	int mac802154_del_dev(struct net_device *dev, __le64 dev_addr)
	185	{
59d19cd7	186	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	187	int res;
	188
	189	BUG_ON(dev->type != ARPHRD_IEEE802154);
	190
036562f9 AA	191	mutex_lock(&sdata->sec_mtx);
	192	res = mac802154_llsec_dev_del(&sdata->sec, dev_addr);
	193	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	194
	195	return res;
	196	}
	197
29e02374 PB	198	int mac802154_add_devkey(struct net_device *dev,
	199	__le64 device_addr,
	200	const struct ieee802154_llsec_device_key *key)
	201	{
59d19cd7	202	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	203	int res;
	204
	205	BUG_ON(dev->type != ARPHRD_IEEE802154);
	206
036562f9 AA	207	mutex_lock(&sdata->sec_mtx);
	208	res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key);
	209	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	210
	211	return res;
	212	}
	213
	214	int mac802154_del_devkey(struct net_device *dev,
	215	__le64 device_addr,
	216	const struct ieee802154_llsec_device_key *key)
	217	{
59d19cd7	218	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	219	int res;
	220
	221	BUG_ON(dev->type != ARPHRD_IEEE802154);
	222
036562f9 AA	223	mutex_lock(&sdata->sec_mtx);
	224	res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key);
	225	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	226
	227	return res;
	228	}
	229
29e02374 PB	230	int mac802154_add_seclevel(struct net_device *dev,
	231	const struct ieee802154_llsec_seclevel *sl)
	232	{
59d19cd7	233	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	234	int res;
	235
	236	BUG_ON(dev->type != ARPHRD_IEEE802154);
	237
036562f9 AA	238	mutex_lock(&sdata->sec_mtx);
	239	res = mac802154_llsec_seclevel_add(&sdata->sec, sl);
	240	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	241
	242	return res;
	243	}
	244
	245	int mac802154_del_seclevel(struct net_device *dev,
	246	const struct ieee802154_llsec_seclevel *sl)
	247	{
59d19cd7	248	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	249	int res;
	250
	251	BUG_ON(dev->type != ARPHRD_IEEE802154);
	252
036562f9 AA	253	mutex_lock(&sdata->sec_mtx);
	254	res = mac802154_llsec_seclevel_del(&sdata->sec, sl);
	255	mutex_unlock(&sdata->sec_mtx);
29e02374 PB	256
	257	return res;
	258	}
	259
29e02374 PB	260	void mac802154_lock_table(struct net_device *dev)
29e02374 PB	261	{
59d19cd7	262	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	263
	264	BUG_ON(dev->type != ARPHRD_IEEE802154);
	265
036562f9	266	mutex_lock(&sdata->sec_mtx);
29e02374 PB	267	}
	268
	269	void mac802154_get_table(struct net_device *dev,
	270	struct ieee802154_llsec_table **t)
	271	{
59d19cd7	272	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	273
	274	BUG_ON(dev->type != ARPHRD_IEEE802154);
	275
036562f9	276	*t = &sdata->sec.table;
29e02374 PB	277	}
	278
	279	void mac802154_unlock_table(struct net_device *dev)
	280	{
59d19cd7	281	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
29e02374 PB	282
	283	BUG_ON(dev->type != ARPHRD_IEEE802154);
	284
036562f9	285	mutex_unlock(&sdata->sec_mtx);
29e02374	286	}