1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * MAC commands interface |
4 | * |
5 | * Copyright 2007-2012 Siemens AG |
6 | * |
7 | * Written by: |
8 | * Sergey Lapin <slapin@ossfans.org> |
9 | * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> |
10 | * Alexander Smirnov <alex.bluesman.smirnov@gmail.com> |
11 | */ |
12 | |
13 | #include <linux/skbuff.h> |
14 | #include <linux/if_arp.h> |
15 | #include <linux/ieee802154.h> |
16 | |
17 | #include <net/ieee802154_netdev.h> |
18 | #include <net/cfg802154.h> |
19 | #include <net/mac802154.h> |
20 | |
21 | #include "ieee802154_i.h" |
22 | #include "driver-ops.h" |
23 | |
24 | static int mac802154_mlme_start_req(struct net_device *dev, |
25 | struct ieee802154_addr *addr, |
26 | u8 channel, u8 page, |
27 | u8 bcn_ord, u8 sf_ord, |
28 | u8 pan_coord, u8 blx, |
29 | u8 coord_realign) |
30 | { |
31 | struct ieee802154_llsec_params params; |
32 | int changed = 0; |
33 | |
34 | ASSERT_RTNL(); |
35 | |
36 | BUG_ON(addr->mode != IEEE802154_ADDR_SHORT); |
37 | |
38 | dev->ieee802154_ptr->pan_id = addr->pan_id; |
39 | dev->ieee802154_ptr->short_addr = addr->short_addr; |
40 | mac802154_dev_set_page_channel(dev, page, chan: channel); |
41 | |
42 | params.pan_id = addr->pan_id; |
43 | changed |= IEEE802154_LLSEC_PARAM_PAN_ID; |
44 | |
45 | params.hwaddr = ieee802154_devaddr_from_raw(raw: dev->dev_addr); |
46 | changed |= IEEE802154_LLSEC_PARAM_HWADDR; |
47 | |
48 | params.coord_hwaddr = params.hwaddr; |
49 | changed |= IEEE802154_LLSEC_PARAM_COORD_HWADDR; |
50 | |
51 | params.coord_shortaddr = addr->short_addr; |
52 | changed |= IEEE802154_LLSEC_PARAM_COORD_SHORTADDR; |
53 | |
54 | return mac802154_set_params(dev, params: ¶ms, changed); |
55 | } |
56 | |
57 | static int mac802154_set_mac_params(struct net_device *dev, |
58 | const struct ieee802154_mac_params *params) |
59 | { |
60 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
61 | struct ieee802154_local *local = sdata->local; |
62 | struct wpan_dev *wpan_dev = &sdata->wpan_dev; |
63 | int ret; |
64 | |
65 | ASSERT_RTNL(); |
66 | |
67 | /* PHY */ |
68 | wpan_dev->wpan_phy->transmit_power = params->transmit_power; |
69 | wpan_dev->wpan_phy->cca = params->cca; |
70 | wpan_dev->wpan_phy->cca_ed_level = params->cca_ed_level; |
71 | |
72 | /* MAC */ |
73 | wpan_dev->min_be = params->min_be; |
74 | wpan_dev->max_be = params->max_be; |
75 | wpan_dev->csma_retries = params->csma_retries; |
76 | wpan_dev->frame_retries = params->frame_retries; |
77 | wpan_dev->lbt = params->lbt; |
78 | |
79 | if (local->hw.phy->flags & WPAN_PHY_FLAG_TXPOWER) { |
80 | ret = drv_set_tx_power(local, mbm: params->transmit_power); |
81 | if (ret < 0) |
82 | return ret; |
83 | } |
84 | |
85 | if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_MODE) { |
86 | ret = drv_set_cca_mode(local, cca: ¶ms->cca); |
87 | if (ret < 0) |
88 | return ret; |
89 | } |
90 | |
91 | if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) { |
92 | ret = drv_set_cca_ed_level(local, mbm: params->cca_ed_level); |
93 | if (ret < 0) |
94 | return ret; |
95 | } |
96 | |
97 | return 0; |
98 | } |
99 | |
100 | static void mac802154_get_mac_params(struct net_device *dev, |
101 | struct ieee802154_mac_params *params) |
102 | { |
103 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
104 | struct wpan_dev *wpan_dev = &sdata->wpan_dev; |
105 | |
106 | ASSERT_RTNL(); |
107 | |
108 | /* PHY */ |
109 | params->transmit_power = wpan_dev->wpan_phy->transmit_power; |
110 | params->cca = wpan_dev->wpan_phy->cca; |
111 | params->cca_ed_level = wpan_dev->wpan_phy->cca_ed_level; |
112 | |
113 | /* MAC */ |
114 | params->min_be = wpan_dev->min_be; |
115 | params->max_be = wpan_dev->max_be; |
116 | params->csma_retries = wpan_dev->csma_retries; |
117 | params->frame_retries = wpan_dev->frame_retries; |
118 | params->lbt = wpan_dev->lbt; |
119 | } |
120 | |
121 | static const struct ieee802154_llsec_ops mac802154_llsec_ops = { |
122 | .get_params = mac802154_get_params, |
123 | .set_params = mac802154_set_params, |
124 | .add_key = mac802154_add_key, |
125 | .del_key = mac802154_del_key, |
126 | .add_dev = mac802154_add_dev, |
127 | .del_dev = mac802154_del_dev, |
128 | .add_devkey = mac802154_add_devkey, |
129 | .del_devkey = mac802154_del_devkey, |
130 | .add_seclevel = mac802154_add_seclevel, |
131 | .del_seclevel = mac802154_del_seclevel, |
132 | .lock_table = mac802154_lock_table, |
133 | .get_table = mac802154_get_table, |
134 | .unlock_table = mac802154_unlock_table, |
135 | }; |
136 | |
137 | struct ieee802154_mlme_ops mac802154_mlme_wpan = { |
138 | .start_req = mac802154_mlme_start_req, |
139 | |
140 | .llsec = &mac802154_llsec_ops, |
141 | |
142 | .set_mac_params = mac802154_set_mac_params, |
143 | .get_mac_params = mac802154_get_mac_params, |
144 | }; |
145 | |