1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright 2007-2012 Siemens AG
4 *
5 * Written by:
6 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
7 * Sergey Lapin <slapin@ossfans.org>
8 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
9 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
10 */
11
12#include <linux/if_arp.h>
13
14#include <net/mac802154.h>
15#include <net/ieee802154_netdev.h>
16#include <net/cfg802154.h>
17
18#include "ieee802154_i.h"
19#include "driver-ops.h"
20
21void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan)
22{
23	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
24	struct ieee802154_local *local = sdata->local;
25	int res;
26
27	ASSERT_RTNL();
28
29	BUG_ON(dev->type != ARPHRD_IEEE802154);
30
31	res = drv_set_channel(local, page, chan);
32	if (res) {
33		pr_debug("set_channel failed\n");
34	} else {
35		local->phy->current_channel = chan;
36		local->phy->current_page = page;
37	}
38}
39
40int mac802154_get_params(struct net_device *dev,
41			 struct ieee802154_llsec_params *params)
42{
43	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
44	int res;
45
46	BUG_ON(dev->type != ARPHRD_IEEE802154);
47
48	mutex_lock(&sdata->sec_mtx);
49	res = mac802154_llsec_get_params(&sdata->sec, params);
50	mutex_unlock(&sdata->sec_mtx);
51
52	return res;
53}
54
55int mac802154_set_params(struct net_device *dev,
56			 const struct ieee802154_llsec_params *params,
57			 int changed)
58{
59	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
60	int res;
61
62	BUG_ON(dev->type != ARPHRD_IEEE802154);
63
64	mutex_lock(&sdata->sec_mtx);
65	res = mac802154_llsec_set_params(&sdata->sec, params, changed);
66	mutex_unlock(&sdata->sec_mtx);
67
68	return res;
69}
70
71int mac802154_add_key(struct net_device *dev,
72		      const struct ieee802154_llsec_key_id *id,
73		      const struct ieee802154_llsec_key *key)
74{
75	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
76	int res;
77
78	BUG_ON(dev->type != ARPHRD_IEEE802154);
79
80	mutex_lock(&sdata->sec_mtx);
81	res = mac802154_llsec_key_add(&sdata->sec, id, key);
82	mutex_unlock(&sdata->sec_mtx);
83
84	return res;
85}
86
87int mac802154_del_key(struct net_device *dev,
88		      const struct ieee802154_llsec_key_id *id)
89{
90	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
91	int res;
92
93	BUG_ON(dev->type != ARPHRD_IEEE802154);
94
95	mutex_lock(&sdata->sec_mtx);
96	res = mac802154_llsec_key_del(&sdata->sec, id);
97	mutex_unlock(&sdata->sec_mtx);
98
99	return res;
100}
101
102int mac802154_add_dev(struct net_device *dev,
103		      const struct ieee802154_llsec_device *llsec_dev)
104{
105	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
106	int res;
107
108	BUG_ON(dev->type != ARPHRD_IEEE802154);
109
110	mutex_lock(&sdata->sec_mtx);
111	res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev);
112	mutex_unlock(&sdata->sec_mtx);
113
114	return res;
115}
116
117int mac802154_del_dev(struct net_device *dev, __le64 dev_addr)
118{
119	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
120	int res;
121
122	BUG_ON(dev->type != ARPHRD_IEEE802154);
123
124	mutex_lock(&sdata->sec_mtx);
125	res = mac802154_llsec_dev_del(&sdata->sec, dev_addr);
126	mutex_unlock(&sdata->sec_mtx);
127
128	return res;
129}
130
131int mac802154_add_devkey(struct net_device *dev,
132			 __le64 device_addr,
133			 const struct ieee802154_llsec_device_key *key)
134{
135	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
136	int res;
137
138	BUG_ON(dev->type != ARPHRD_IEEE802154);
139
140	mutex_lock(&sdata->sec_mtx);
141	res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key);
142	mutex_unlock(&sdata->sec_mtx);
143
144	return res;
145}
146
147int mac802154_del_devkey(struct net_device *dev,
148			 __le64 device_addr,
149			 const struct ieee802154_llsec_device_key *key)
150{
151	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
152	int res;
153
154	BUG_ON(dev->type != ARPHRD_IEEE802154);
155
156	mutex_lock(&sdata->sec_mtx);
157	res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key);
158	mutex_unlock(&sdata->sec_mtx);
159
160	return res;
161}
162
163int mac802154_add_seclevel(struct net_device *dev,
164			   const struct ieee802154_llsec_seclevel *sl)
165{
166	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
167	int res;
168
169	BUG_ON(dev->type != ARPHRD_IEEE802154);
170
171	mutex_lock(&sdata->sec_mtx);
172	res = mac802154_llsec_seclevel_add(&sdata->sec, sl);
173	mutex_unlock(&sdata->sec_mtx);
174
175	return res;
176}
177
178int mac802154_del_seclevel(struct net_device *dev,
179			   const struct ieee802154_llsec_seclevel *sl)
180{
181	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
182	int res;
183
184	BUG_ON(dev->type != ARPHRD_IEEE802154);
185
186	mutex_lock(&sdata->sec_mtx);
187	res = mac802154_llsec_seclevel_del(&sdata->sec, sl);
188	mutex_unlock(&sdata->sec_mtx);
189
190	return res;
191}
192
193void mac802154_lock_table(struct net_device *dev)
194{
195	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
196
197	BUG_ON(dev->type != ARPHRD_IEEE802154);
198
199	mutex_lock(&sdata->sec_mtx);
200}
201
202void mac802154_get_table(struct net_device *dev,
203			 struct ieee802154_llsec_table **t)
204{
205	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
206
207	BUG_ON(dev->type != ARPHRD_IEEE802154);
208
209	*t = &sdata->sec.table;
210}
211
212void mac802154_unlock_table(struct net_device *dev)
213{
214	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
215
216	BUG_ON(dev->type != ARPHRD_IEEE802154);
217
218	mutex_unlock(&sdata->sec_mtx);
219}
220