blob: c865ebb2ace2b0b74cf3ba994c085790cde83da6 [file] [log] [blame]
Alexander Aring1201cd22014-11-02 04:18:36 +01001/* This program is free software; you can redistribute it and/or modify
2 * it under the terms of the GNU General Public License version 2
3 * as published by the Free Software Foundation.
4 *
5 * This program is distributed in the hope that it will be useful,
6 * but WITHOUT ANY WARRANTY; without even the implied warranty of
7 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
8 * GNU General Public License for more details.
9 *
10 * Authors:
11 * Alexander Aring <aar@pengutronix.de>
12 *
13 * Based on: net/mac80211/cfg.c
14 */
15
Alexander Aringd5ae67b2014-11-05 20:51:17 +010016#include <net/rtnetlink.h>
Alexander Aring1201cd22014-11-02 04:18:36 +010017#include <net/cfg802154.h>
18
Alexander Aring4a9a8162014-11-02 04:18:38 +010019#include "ieee802154_i.h"
Alexander Aringab0bd562014-11-12 03:36:55 +010020#include "driver-ops.h"
Alexander Aringfdd20682014-11-02 21:43:05 +010021#include "cfg.h"
Alexander Aring4a9a8162014-11-02 04:18:38 +010022
23static struct net_device *
24ieee802154_add_iface_deprecated(struct wpan_phy *wpan_phy,
Varka Bhadram5b4a10392015-04-30 17:44:57 +020025 const char *name,
26 unsigned char name_assign_type, int type)
Alexander Aring4a9a8162014-11-02 04:18:38 +010027{
Alexander Aring986a8ab2014-11-05 20:51:15 +010028 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
Alexander Aringd5ae67b2014-11-05 20:51:17 +010029 struct net_device *dev;
Alexander Aring986a8ab2014-11-05 20:51:15 +010030
Alexander Aringd5ae67b2014-11-05 20:51:17 +010031 rtnl_lock();
Varka Bhadram5b4a10392015-04-30 17:44:57 +020032 dev = ieee802154_if_add(local, name, name_assign_type, type,
Alexander Aring0e575472014-11-17 08:20:52 +010033 cpu_to_le64(0x0000000000000000ULL));
Alexander Aringd5ae67b2014-11-05 20:51:17 +010034 rtnl_unlock();
35
36 return dev;
Alexander Aring4a9a8162014-11-02 04:18:38 +010037}
38
39static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy,
40 struct net_device *dev)
41{
Alexander Aringb210b182014-11-05 20:51:14 +010042 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
43
44 ieee802154_if_remove(sdata);
Alexander Aring4a9a8162014-11-02 04:18:38 +010045}
46
Alexander Aring3cf24cf2015-06-24 11:36:36 +020047#ifdef CONFIG_PM
48static int ieee802154_suspend(struct wpan_phy *wpan_phy)
49{
50 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
51
52 if (!local->open_count)
53 goto suspend;
54
55 ieee802154_stop_queue(&local->hw);
56 synchronize_net();
57
58 /* stop hardware - this must stop RX */
59 ieee802154_stop_device(local);
60
61suspend:
62 local->suspended = true;
63 return 0;
64}
65
66static int ieee802154_resume(struct wpan_phy *wpan_phy)
67{
68 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
69 int ret;
70
71 /* nothing to do if HW shouldn't run */
72 if (!local->open_count)
73 goto wake_up;
74
75 /* restart hardware */
76 ret = drv_start(local);
77 if (ret)
78 return ret;
79
80wake_up:
81 ieee802154_wake_queue(&local->hw);
82 local->suspended = false;
83 return 0;
84}
85#else
86#define ieee802154_suspend NULL
87#define ieee802154_resume NULL
88#endif
89
Alexander Aringab0bd562014-11-12 03:36:55 +010090static int
Alexander Aringf3ea5e42014-11-17 08:20:51 +010091ieee802154_add_iface(struct wpan_phy *phy, const char *name,
Varka Bhadram5b4a10392015-04-30 17:44:57 +020092 unsigned char name_assign_type,
Alexander Aring0e575472014-11-17 08:20:52 +010093 enum nl802154_iftype type, __le64 extended_addr)
Alexander Aringf3ea5e42014-11-17 08:20:51 +010094{
95 struct ieee802154_local *local = wpan_phy_priv(phy);
96 struct net_device *err;
97
Varka Bhadram5b4a10392015-04-30 17:44:57 +020098 err = ieee802154_if_add(local, name, name_assign_type, type,
99 extended_addr);
Alexander Aring36cf9422015-01-02 15:49:41 +0100100 return PTR_ERR_OR_ZERO(err);
Alexander Aringf3ea5e42014-11-17 08:20:51 +0100101}
102
103static int
Alexander Aringb821ecd2014-11-17 08:20:53 +0100104ieee802154_del_iface(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev)
105{
106 ieee802154_if_remove(IEEE802154_WPAN_DEV_TO_SUB_IF(wpan_dev));
107
108 return 0;
109}
110
111static int
Alexander Aring6d5fb872014-11-17 08:20:46 +0100112ieee802154_set_channel(struct wpan_phy *wpan_phy, u8 page, u8 channel)
Alexander Aringab0bd562014-11-12 03:36:55 +0100113{
114 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
115 int ret;
116
117 ASSERT_RTNL();
118
Alexander Aring791021b2015-05-17 21:44:44 +0200119 if (wpan_phy->current_page == page &&
120 wpan_phy->current_channel == channel)
121 return 0;
122
Alexander Aringab0bd562014-11-12 03:36:55 +0100123 ret = drv_set_channel(local, page, channel);
124 if (!ret) {
125 wpan_phy->current_page = page;
126 wpan_phy->current_channel = channel;
127 }
128
129 return ret;
130}
131
Alexander Aring6d5fb872014-11-17 08:20:46 +0100132static int
Alexander Aringba2a9502014-12-10 15:33:13 +0100133ieee802154_set_cca_mode(struct wpan_phy *wpan_phy,
134 const struct wpan_phy_cca *cca)
135{
136 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
137 int ret;
138
139 ASSERT_RTNL();
140
Alexander Aring791021b2015-05-17 21:44:44 +0200141 if (wpan_phy_cca_cmp(&wpan_phy->cca, cca))
142 return 0;
143
Alexander Aringba2a9502014-12-10 15:33:13 +0100144 ret = drv_set_cca_mode(local, cca);
145 if (!ret)
146 wpan_phy->cca = *cca;
147
148 return ret;
149}
150
151static int
Alexander Aringb69644c2015-05-27 13:42:10 +0200152ieee802154_set_cca_ed_level(struct wpan_phy *wpan_phy, s32 ed_level)
153{
154 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
155 int ret;
156
157 ASSERT_RTNL();
158
159 if (wpan_phy->cca_ed_level == ed_level)
160 return 0;
161
162 ret = drv_set_cca_ed_level(local, ed_level);
163 if (!ret)
164 wpan_phy->cca_ed_level = ed_level;
165
166 return ret;
167}
168
169static int
Varka Bhadram0f999b02015-05-27 09:10:54 +0530170ieee802154_set_tx_power(struct wpan_phy *wpan_phy, s32 power)
171{
172 struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
173 int ret;
174
175 ASSERT_RTNL();
176
177 if (wpan_phy->transmit_power == power)
178 return 0;
179
180 ret = drv_set_tx_power(local, power);
181 if (!ret)
182 wpan_phy->transmit_power = power;
183
184 return ret;
185}
186
187static int
Alexander Aring6d5fb872014-11-17 08:20:46 +0100188ieee802154_set_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
Alexander Aringee7b9052014-11-17 08:20:55 +0100189 __le16 pan_id)
Alexander Aring702bf372014-11-12 03:36:57 +0100190{
Alexander Aringd77b4852015-06-21 16:45:20 +0200191 int ret;
192
Alexander Aring702bf372014-11-12 03:36:57 +0100193 ASSERT_RTNL();
194
Alexander Aring791021b2015-05-17 21:44:44 +0200195 if (wpan_dev->pan_id == pan_id)
196 return 0;
197
Alexander Aringd77b4852015-06-21 16:45:20 +0200198 ret = mac802154_wpan_update_llsec(wpan_dev->netdev);
199 if (!ret)
200 wpan_dev->pan_id = pan_id;
201
202 return ret;
Alexander Aring702bf372014-11-12 03:36:57 +0100203}
204
Alexander Aring9830c622014-11-12 03:36:58 +0100205static int
Alexander Aring656a9992014-11-12 03:36:59 +0100206ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy,
207 struct wpan_dev *wpan_dev,
Alexander Aring6d5fb872014-11-17 08:20:46 +0100208 u8 min_be, u8 max_be)
Alexander Aring656a9992014-11-12 03:36:59 +0100209{
Alexander Aring656a9992014-11-12 03:36:59 +0100210 ASSERT_RTNL();
211
Alexander Aring656a9992014-11-12 03:36:59 +0100212 wpan_dev->min_be = min_be;
213 wpan_dev->max_be = max_be;
214 return 0;
215}
216
217static int
Alexander Aring9830c622014-11-12 03:36:58 +0100218ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
Alexander Aringee7b9052014-11-17 08:20:55 +0100219 __le16 short_addr)
Alexander Aring9830c622014-11-12 03:36:58 +0100220{
221 ASSERT_RTNL();
222
Alexander Aringee7b9052014-11-17 08:20:55 +0100223 wpan_dev->short_addr = short_addr;
Alexander Aring9830c622014-11-12 03:36:58 +0100224 return 0;
225}
226
Alexander Aring6d5fb872014-11-17 08:20:46 +0100227static int
228ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy,
229 struct wpan_dev *wpan_dev,
230 u8 max_csma_backoffs)
Alexander Aringa01ba762014-11-12 03:37:01 +0100231{
Alexander Aringa01ba762014-11-12 03:37:01 +0100232 ASSERT_RTNL();
233
Alexander Aringa01ba762014-11-12 03:37:01 +0100234 wpan_dev->csma_retries = max_csma_backoffs;
235 return 0;
236}
237
Alexander Aring6d5fb872014-11-17 08:20:46 +0100238static int
239ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy,
240 struct wpan_dev *wpan_dev,
241 s8 max_frame_retries)
Alexander Aring17a3a462014-11-12 03:37:03 +0100242{
Alexander Aring17a3a462014-11-12 03:37:03 +0100243 ASSERT_RTNL();
244
Alexander Aring17a3a462014-11-12 03:37:03 +0100245 wpan_dev->frame_retries = max_frame_retries;
246 return 0;
247}
248
Alexander Aring6d5fb872014-11-17 08:20:46 +0100249static int
250ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
251 bool mode)
Alexander Aringc8937a1d2014-11-12 03:37:05 +0100252{
Alexander Aringc8937a1d2014-11-12 03:37:05 +0100253 ASSERT_RTNL();
254
Alexander Aringc8937a1d2014-11-12 03:37:05 +0100255 wpan_dev->lbt = mode;
256 return 0;
257}
258
Alexander Aringc91208d2015-08-10 21:15:58 +0200259static int
260ieee802154_set_ackreq_default(struct wpan_phy *wpan_phy,
261 struct wpan_dev *wpan_dev, bool ackreq)
262{
263 ASSERT_RTNL();
264
265 wpan_dev->ackreq = ackreq;
266 return 0;
267}
268
Alexander Aring1201cd22014-11-02 04:18:36 +0100269const struct cfg802154_ops mac802154_config_ops = {
Alexander Aring4a9a8162014-11-02 04:18:38 +0100270 .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
271 .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
Alexander Aring3cf24cf2015-06-24 11:36:36 +0200272 .suspend = ieee802154_suspend,
273 .resume = ieee802154_resume,
Alexander Aringf3ea5e42014-11-17 08:20:51 +0100274 .add_virtual_intf = ieee802154_add_iface,
Alexander Aringb821ecd2014-11-17 08:20:53 +0100275 .del_virtual_intf = ieee802154_del_iface,
Alexander Aringab0bd562014-11-12 03:36:55 +0100276 .set_channel = ieee802154_set_channel,
Alexander Aringba2a9502014-12-10 15:33:13 +0100277 .set_cca_mode = ieee802154_set_cca_mode,
Alexander Aringb69644c2015-05-27 13:42:10 +0200278 .set_cca_ed_level = ieee802154_set_cca_ed_level,
Varka Bhadram0f999b02015-05-27 09:10:54 +0530279 .set_tx_power = ieee802154_set_tx_power,
Alexander Aring702bf372014-11-12 03:36:57 +0100280 .set_pan_id = ieee802154_set_pan_id,
Alexander Aring9830c622014-11-12 03:36:58 +0100281 .set_short_addr = ieee802154_set_short_addr,
Alexander Aring656a9992014-11-12 03:36:59 +0100282 .set_backoff_exponent = ieee802154_set_backoff_exponent,
Alexander Aringa01ba762014-11-12 03:37:01 +0100283 .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs,
Alexander Aring17a3a462014-11-12 03:37:03 +0100284 .set_max_frame_retries = ieee802154_set_max_frame_retries,
Alexander Aringc8937a1d2014-11-12 03:37:05 +0100285 .set_lbt_mode = ieee802154_set_lbt_mode,
Alexander Aringc91208d2015-08-10 21:15:58 +0200286 .set_ackreq_default = ieee802154_set_ackreq_default,
Alexander Aring1201cd22014-11-02 04:18:36 +0100287};