1 /* 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.
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.
11 * Alexander Aring <aar@pengutronix.de>
13 * Based on: net/mac80211/cfg.c
16 #include <net/rtnetlink.h>
17 #include <net/cfg802154.h>
19 #include "ieee802154_i.h"
20 #include "driver-ops.h"
23 static struct net_device
*
24 ieee802154_add_iface_deprecated(struct wpan_phy
*wpan_phy
,
26 unsigned char name_assign_type
, int type
)
28 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
29 struct net_device
*dev
;
32 dev
= ieee802154_if_add(local
, name
, name_assign_type
, type
,
33 cpu_to_le64(0x0000000000000000ULL
));
39 static void ieee802154_del_iface_deprecated(struct wpan_phy
*wpan_phy
,
40 struct net_device
*dev
)
42 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
44 ieee802154_if_remove(sdata
);
48 static int ieee802154_suspend(struct wpan_phy
*wpan_phy
)
50 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
52 if (!local
->open_count
)
55 ieee802154_stop_queue(&local
->hw
);
58 /* stop hardware - this must stop RX */
59 ieee802154_stop_device(local
);
62 local
->suspended
= true;
66 static int ieee802154_resume(struct wpan_phy
*wpan_phy
)
68 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
71 /* nothing to do if HW shouldn't run */
72 if (!local
->open_count
)
75 /* restart hardware */
76 ret
= drv_start(local
);
81 ieee802154_wake_queue(&local
->hw
);
82 local
->suspended
= false;
86 #define ieee802154_suspend NULL
87 #define ieee802154_resume NULL
91 ieee802154_add_iface(struct wpan_phy
*phy
, const char *name
,
92 unsigned char name_assign_type
,
93 enum nl802154_iftype type
, __le64 extended_addr
)
95 struct ieee802154_local
*local
= wpan_phy_priv(phy
);
96 struct net_device
*err
;
98 err
= ieee802154_if_add(local
, name
, name_assign_type
, type
,
100 return PTR_ERR_OR_ZERO(err
);
104 ieee802154_del_iface(struct wpan_phy
*wpan_phy
, struct wpan_dev
*wpan_dev
)
106 ieee802154_if_remove(IEEE802154_WPAN_DEV_TO_SUB_IF(wpan_dev
));
112 ieee802154_set_channel(struct wpan_phy
*wpan_phy
, u8 page
, u8 channel
)
114 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
119 if (wpan_phy
->current_page
== page
&&
120 wpan_phy
->current_channel
== channel
)
123 ret
= drv_set_channel(local
, page
, channel
);
125 wpan_phy
->current_page
= page
;
126 wpan_phy
->current_channel
= channel
;
133 ieee802154_set_cca_mode(struct wpan_phy
*wpan_phy
,
134 const struct wpan_phy_cca
*cca
)
136 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
141 if (wpan_phy_cca_cmp(&wpan_phy
->cca
, cca
))
144 ret
= drv_set_cca_mode(local
, cca
);
146 wpan_phy
->cca
= *cca
;
152 ieee802154_set_cca_ed_level(struct wpan_phy
*wpan_phy
, s32 ed_level
)
154 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
159 if (wpan_phy
->cca_ed_level
== ed_level
)
162 ret
= drv_set_cca_ed_level(local
, ed_level
);
164 wpan_phy
->cca_ed_level
= ed_level
;
170 ieee802154_set_tx_power(struct wpan_phy
*wpan_phy
, s32 power
)
172 struct ieee802154_local
*local
= wpan_phy_priv(wpan_phy
);
177 if (wpan_phy
->transmit_power
== power
)
180 ret
= drv_set_tx_power(local
, power
);
182 wpan_phy
->transmit_power
= power
;
188 ieee802154_set_pan_id(struct wpan_phy
*wpan_phy
, struct wpan_dev
*wpan_dev
,
195 if (wpan_dev
->pan_id
== pan_id
)
198 ret
= mac802154_wpan_update_llsec(wpan_dev
->netdev
);
200 wpan_dev
->pan_id
= pan_id
;
206 ieee802154_set_backoff_exponent(struct wpan_phy
*wpan_phy
,
207 struct wpan_dev
*wpan_dev
,
208 u8 min_be
, u8 max_be
)
212 wpan_dev
->min_be
= min_be
;
213 wpan_dev
->max_be
= max_be
;
218 ieee802154_set_short_addr(struct wpan_phy
*wpan_phy
, struct wpan_dev
*wpan_dev
,
223 wpan_dev
->short_addr
= short_addr
;
228 ieee802154_set_max_csma_backoffs(struct wpan_phy
*wpan_phy
,
229 struct wpan_dev
*wpan_dev
,
230 u8 max_csma_backoffs
)
234 wpan_dev
->csma_retries
= max_csma_backoffs
;
239 ieee802154_set_max_frame_retries(struct wpan_phy
*wpan_phy
,
240 struct wpan_dev
*wpan_dev
,
241 s8 max_frame_retries
)
245 wpan_dev
->frame_retries
= max_frame_retries
;
250 ieee802154_set_lbt_mode(struct wpan_phy
*wpan_phy
, struct wpan_dev
*wpan_dev
,
255 wpan_dev
->lbt
= mode
;
260 ieee802154_set_ackreq_default(struct wpan_phy
*wpan_phy
,
261 struct wpan_dev
*wpan_dev
, bool ackreq
)
265 wpan_dev
->ackreq
= ackreq
;
269 const struct cfg802154_ops mac802154_config_ops
= {
270 .add_virtual_intf_deprecated
= ieee802154_add_iface_deprecated
,
271 .del_virtual_intf_deprecated
= ieee802154_del_iface_deprecated
,
272 .suspend
= ieee802154_suspend
,
273 .resume
= ieee802154_resume
,
274 .add_virtual_intf
= ieee802154_add_iface
,
275 .del_virtual_intf
= ieee802154_del_iface
,
276 .set_channel
= ieee802154_set_channel
,
277 .set_cca_mode
= ieee802154_set_cca_mode
,
278 .set_cca_ed_level
= ieee802154_set_cca_ed_level
,
279 .set_tx_power
= ieee802154_set_tx_power
,
280 .set_pan_id
= ieee802154_set_pan_id
,
281 .set_short_addr
= ieee802154_set_short_addr
,
282 .set_backoff_exponent
= ieee802154_set_backoff_exponent
,
283 .set_max_csma_backoffs
= ieee802154_set_max_csma_backoffs
,
284 .set_max_frame_retries
= ieee802154_set_max_frame_retries
,
285 .set_lbt_mode
= ieee802154_set_lbt_mode
,
286 .set_ackreq_default
= ieee802154_set_ackreq_default
,