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