Commit | Line | Data |
---|---|---|
2a7305c8 AK |
1 | /* |
2 | * Marvell Wireless LAN device driver: 802.11h | |
3 | * | |
65da33f5 | 4 | * Copyright (C) 2013-2014, Marvell International Ltd. |
2a7305c8 AK |
5 | * |
6 | * This software file (the "File") is distributed by Marvell International | |
7 | * Ltd. under the terms of the GNU General Public License Version 2, June 1991 | |
8 | * (the "License"). You may use, redistribute and/or modify this File in | |
9 | * accordance with the terms and conditions of the License, a copy of which | |
10 | * is available by writing to the Free Software Foundation, Inc., | |
11 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the | |
12 | * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt. | |
13 | * | |
14 | * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE | |
15 | * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE | |
16 | * ARE EXPRESSLY DISCLAIMED. The License provides additional details about | |
17 | * this warranty disclaimer. | |
18 | */ | |
19 | ||
20 | #include "main.h" | |
21 | #include "fw.h" | |
22 | ||
23 | ||
cf075eac AP |
24 | void mwifiex_init_11h_params(struct mwifiex_private *priv) |
25 | { | |
26 | priv->state_11h.is_11h_enabled = true; | |
27 | priv->state_11h.is_11h_active = false; | |
28 | } | |
29 | ||
30 | inline int mwifiex_is_11h_active(struct mwifiex_private *priv) | |
31 | { | |
32 | return priv->state_11h.is_11h_active; | |
33 | } | |
2a7305c8 AK |
34 | /* This function appends 11h info to a buffer while joining an |
35 | * infrastructure BSS | |
36 | */ | |
37 | static void | |
38 | mwifiex_11h_process_infra_join(struct mwifiex_private *priv, u8 **buffer, | |
39 | struct mwifiex_bssdescriptor *bss_desc) | |
40 | { | |
41 | struct mwifiex_ie_types_header *ie_header; | |
42 | struct mwifiex_ie_types_pwr_capability *cap; | |
43 | struct mwifiex_ie_types_local_pwr_constraint *constraint; | |
44 | struct ieee80211_supported_band *sband; | |
45 | u8 radio_type; | |
46 | int i; | |
47 | ||
48 | if (!buffer || !(*buffer)) | |
49 | return; | |
50 | ||
51 | radio_type = mwifiex_band_to_radio_type((u8) bss_desc->bss_band); | |
4facc34a | 52 | sband = priv->wdev.wiphy->bands[radio_type]; |
2a7305c8 AK |
53 | |
54 | cap = (struct mwifiex_ie_types_pwr_capability *)*buffer; | |
55 | cap->header.type = cpu_to_le16(WLAN_EID_PWR_CAPABILITY); | |
56 | cap->header.len = cpu_to_le16(2); | |
57 | cap->min_pwr = 0; | |
58 | cap->max_pwr = 0; | |
59 | *buffer += sizeof(*cap); | |
60 | ||
61 | constraint = (struct mwifiex_ie_types_local_pwr_constraint *)*buffer; | |
62 | constraint->header.type = cpu_to_le16(WLAN_EID_PWR_CONSTRAINT); | |
63 | constraint->header.len = cpu_to_le16(2); | |
64 | constraint->chan = bss_desc->channel; | |
65 | constraint->constraint = bss_desc->local_constraint; | |
66 | *buffer += sizeof(*constraint); | |
67 | ||
68 | ie_header = (struct mwifiex_ie_types_header *)*buffer; | |
69 | ie_header->type = cpu_to_le16(TLV_TYPE_PASSTHROUGH); | |
70 | ie_header->len = cpu_to_le16(2 * sband->n_channels + 2); | |
71 | *buffer += sizeof(*ie_header); | |
72 | *(*buffer)++ = WLAN_EID_SUPPORTED_CHANNELS; | |
73 | *(*buffer)++ = 2 * sband->n_channels; | |
74 | for (i = 0; i < sband->n_channels; i++) { | |
75 | *(*buffer)++ = ieee80211_frequency_to_channel( | |
76 | sband->channels[i].center_freq); | |
77 | *(*buffer)++ = 1; /* one channel in the subband */ | |
78 | } | |
79 | } | |
80 | ||
81 | /* Enable or disable the 11h extensions in the firmware */ | |
cf075eac | 82 | int mwifiex_11h_activate(struct mwifiex_private *priv, bool flag) |
2a7305c8 AK |
83 | { |
84 | u32 enable = flag; | |
85 | ||
cf075eac AP |
86 | /* enable master mode radar detection on AP interface */ |
87 | if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) && enable) | |
88 | enable |= MWIFIEX_MASTER_RADAR_DET_MASK; | |
89 | ||
fa0ecbb9 BZ |
90 | return mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB, |
91 | HostCmd_ACT_GEN_SET, DOT11H_I, &enable, true); | |
2a7305c8 AK |
92 | } |
93 | ||
94 | /* This functions processes TLV buffer for a pending BSS Join command. | |
95 | * | |
96 | * Activate 11h functionality in the firmware if the spectrum management | |
97 | * capability bit is found in the network we are joining. Also, necessary | |
98 | * TLVs are set based on requested network's 11h capability. | |
99 | */ | |
100 | void mwifiex_11h_process_join(struct mwifiex_private *priv, u8 **buffer, | |
101 | struct mwifiex_bssdescriptor *bss_desc) | |
102 | { | |
103 | if (bss_desc->sensed_11h) { | |
104 | /* Activate 11h functions in firmware, turns on capability | |
105 | * bit | |
106 | */ | |
107 | mwifiex_11h_activate(priv, true); | |
cf075eac | 108 | priv->state_11h.is_11h_active = true; |
2a7305c8 AK |
109 | bss_desc->cap_info_bitmap |= WLAN_CAPABILITY_SPECTRUM_MGMT; |
110 | mwifiex_11h_process_infra_join(priv, buffer, bss_desc); | |
111 | } else { | |
112 | /* Deactivate 11h functions in the firmware */ | |
113 | mwifiex_11h_activate(priv, false); | |
cf075eac | 114 | priv->state_11h.is_11h_active = false; |
2a7305c8 AK |
115 | bss_desc->cap_info_bitmap &= ~WLAN_CAPABILITY_SPECTRUM_MGMT; |
116 | } | |
117 | } | |
85afb186 AP |
118 | |
119 | /* This is DFS CAC work queue function. | |
120 | * This delayed work emits CAC finished event for cfg80211 if | |
121 | * CAC was started earlier. | |
122 | */ | |
123 | void mwifiex_dfs_cac_work_queue(struct work_struct *work) | |
124 | { | |
125 | struct cfg80211_chan_def chandef; | |
8dd37c7c | 126 | struct delayed_work *delayed_work = to_delayed_work(work); |
85afb186 AP |
127 | struct mwifiex_private *priv = |
128 | container_of(delayed_work, struct mwifiex_private, | |
129 | dfs_cac_work); | |
130 | ||
131 | if (WARN_ON(!priv)) | |
132 | return; | |
133 | ||
134 | chandef = priv->dfs_chandef; | |
135 | if (priv->wdev.cac_started) { | |
acebe8c1 ZL |
136 | mwifiex_dbg(priv->adapter, MSG, |
137 | "CAC timer finished; No radar detected\n"); | |
85afb186 AP |
138 | cfg80211_cac_event(priv->netdev, &chandef, |
139 | NL80211_RADAR_CAC_FINISHED, | |
140 | GFP_KERNEL); | |
141 | } | |
142 | } | |
143 | ||
144 | /* This function prepares channel report request command to FW for | |
145 | * starting radar detection. | |
146 | */ | |
147 | int mwifiex_cmd_issue_chan_report_request(struct mwifiex_private *priv, | |
148 | struct host_cmd_ds_command *cmd, | |
149 | void *data_buf) | |
150 | { | |
151 | struct host_cmd_ds_chan_rpt_req *cr_req = &cmd->params.chan_rpt_req; | |
152 | struct mwifiex_radar_params *radar_params = (void *)data_buf; | |
153 | ||
154 | cmd->command = cpu_to_le16(HostCmd_CMD_CHAN_REPORT_REQUEST); | |
155 | cmd->size = cpu_to_le16(S_DS_GEN); | |
156 | le16_add_cpu(&cmd->size, sizeof(struct host_cmd_ds_chan_rpt_req)); | |
157 | ||
158 | cr_req->chan_desc.start_freq = cpu_to_le16(MWIFIEX_A_BAND_START_FREQ); | |
159 | cr_req->chan_desc.chan_num = radar_params->chandef->chan->hw_value; | |
160 | cr_req->chan_desc.chan_width = radar_params->chandef->width; | |
161 | cr_req->msec_dwell_time = cpu_to_le32(radar_params->cac_time_ms); | |
162 | ||
511c8989 AP |
163 | if (radar_params->cac_time_ms) |
164 | mwifiex_dbg(priv->adapter, MSG, | |
165 | "11h: issuing DFS Radar check for channel=%d\n", | |
166 | radar_params->chandef->chan->hw_value); | |
167 | else | |
168 | mwifiex_dbg(priv->adapter, MSG, "cancelling CAC\n"); | |
85afb186 AP |
169 | |
170 | return 0; | |
171 | } | |
172 | ||
511c8989 AP |
173 | int mwifiex_stop_radar_detection(struct mwifiex_private *priv, |
174 | struct cfg80211_chan_def *chandef) | |
175 | { | |
176 | struct mwifiex_radar_params radar_params; | |
177 | ||
178 | memset(&radar_params, 0, sizeof(struct mwifiex_radar_params)); | |
179 | radar_params.chandef = chandef; | |
180 | radar_params.cac_time_ms = 0; | |
181 | ||
182 | return mwifiex_send_cmd(priv, HostCmd_CMD_CHAN_REPORT_REQUEST, | |
183 | HostCmd_ACT_GEN_SET, 0, &radar_params, true); | |
184 | } | |
185 | ||
85afb186 AP |
186 | /* This function is to abort ongoing CAC upon stopping AP operations |
187 | * or during unload. | |
188 | */ | |
189 | void mwifiex_abort_cac(struct mwifiex_private *priv) | |
190 | { | |
191 | if (priv->wdev.cac_started) { | |
511c8989 AP |
192 | if (mwifiex_stop_radar_detection(priv, &priv->dfs_chandef)) |
193 | mwifiex_dbg(priv->adapter, ERROR, | |
194 | "failed to stop CAC in FW\n"); | |
acebe8c1 ZL |
195 | mwifiex_dbg(priv->adapter, MSG, |
196 | "Aborting delayed work for CAC.\n"); | |
85afb186 AP |
197 | cancel_delayed_work_sync(&priv->dfs_cac_work); |
198 | cfg80211_cac_event(priv->netdev, &priv->dfs_chandef, | |
199 | NL80211_RADAR_CAC_ABORTED, GFP_KERNEL); | |
200 | } | |
201 | } | |
0a694d68 AP |
202 | |
203 | /* This function handles channel report event from FW during CAC period. | |
204 | * If radar is detected during CAC, driver indicates the same to cfg80211 | |
205 | * and also cancels ongoing delayed work. | |
206 | */ | |
207 | int mwifiex_11h_handle_chanrpt_ready(struct mwifiex_private *priv, | |
208 | struct sk_buff *skb) | |
209 | { | |
210 | struct host_cmd_ds_chan_rpt_event *rpt_event; | |
211 | struct mwifiex_ie_types_chan_rpt_data *rpt; | |
212 | u8 *evt_buf; | |
213 | u16 event_len, tlv_len; | |
214 | ||
215 | rpt_event = (void *)(skb->data + sizeof(u32)); | |
216 | event_len = skb->len - (sizeof(struct host_cmd_ds_chan_rpt_event)+ | |
217 | sizeof(u32)); | |
218 | ||
219 | if (le32_to_cpu(rpt_event->result) != HostCmd_RESULT_OK) { | |
acebe8c1 ZL |
220 | mwifiex_dbg(priv->adapter, ERROR, |
221 | "Error in channel report event\n"); | |
0a694d68 AP |
222 | return -1; |
223 | } | |
224 | ||
225 | evt_buf = (void *)&rpt_event->tlvbuf; | |
226 | ||
227 | while (event_len >= sizeof(struct mwifiex_ie_types_header)) { | |
228 | rpt = (void *)&rpt_event->tlvbuf; | |
229 | tlv_len = le16_to_cpu(rpt->header.len); | |
230 | ||
231 | switch (le16_to_cpu(rpt->header.type)) { | |
232 | case TLV_TYPE_CHANRPT_11H_BASIC: | |
233 | if (rpt->map.radar) { | |
acebe8c1 ZL |
234 | mwifiex_dbg(priv->adapter, MSG, |
235 | "RADAR Detected on channel %d!\n", | |
0a694d68 AP |
236 | priv->dfs_chandef.chan->hw_value); |
237 | cancel_delayed_work_sync(&priv->dfs_cac_work); | |
238 | cfg80211_cac_event(priv->netdev, | |
239 | &priv->dfs_chandef, | |
240 | NL80211_RADAR_DETECTED, | |
241 | GFP_KERNEL); | |
242 | } | |
243 | break; | |
244 | default: | |
245 | break; | |
246 | } | |
247 | ||
248 | evt_buf += (tlv_len + sizeof(rpt->header)); | |
249 | event_len -= (tlv_len + sizeof(rpt->header)); | |
250 | } | |
251 | ||
252 | return 0; | |
253 | } | |
3b57c1a7 AP |
254 | |
255 | /* Handler for radar detected event from FW.*/ | |
256 | int mwifiex_11h_handle_radar_detected(struct mwifiex_private *priv, | |
257 | struct sk_buff *skb) | |
258 | { | |
259 | struct mwifiex_radar_det_event *rdr_event; | |
260 | ||
261 | rdr_event = (void *)(skb->data + sizeof(u32)); | |
262 | ||
263 | if (le32_to_cpu(rdr_event->passed)) { | |
acebe8c1 ZL |
264 | mwifiex_dbg(priv->adapter, MSG, |
265 | "radar detected; indicating kernel\n"); | |
511c8989 AP |
266 | if (mwifiex_stop_radar_detection(priv, &priv->dfs_chandef)) |
267 | mwifiex_dbg(priv->adapter, ERROR, | |
268 | "Failed to stop CAC in FW\n"); | |
3b57c1a7 AP |
269 | cfg80211_radar_event(priv->adapter->wiphy, &priv->dfs_chandef, |
270 | GFP_KERNEL); | |
acebe8c1 ZL |
271 | mwifiex_dbg(priv->adapter, MSG, "regdomain: %d\n", |
272 | rdr_event->reg_domain); | |
273 | mwifiex_dbg(priv->adapter, MSG, "radar detection type: %d\n", | |
274 | rdr_event->det_type); | |
3b57c1a7 | 275 | } else { |
511c8989 | 276 | mwifiex_dbg(priv->adapter, MSG, |
acebe8c1 | 277 | "false radar detection event!\n"); |
3b57c1a7 AP |
278 | } |
279 | ||
280 | return 0; | |
281 | } | |
7d652034 AP |
282 | |
283 | /* This is work queue function for channel switch handling. | |
284 | * This function takes care of updating new channel definitin to | |
285 | * bss config structure, restart AP and indicate channel switch success | |
286 | * to cfg80211. | |
287 | */ | |
288 | void mwifiex_dfs_chan_sw_work_queue(struct work_struct *work) | |
289 | { | |
290 | struct mwifiex_uap_bss_param *bss_cfg; | |
8dd37c7c | 291 | struct delayed_work *delayed_work = to_delayed_work(work); |
7d652034 AP |
292 | struct mwifiex_private *priv = |
293 | container_of(delayed_work, struct mwifiex_private, | |
294 | dfs_chan_sw_work); | |
295 | ||
296 | if (WARN_ON(!priv)) | |
297 | return; | |
298 | ||
299 | bss_cfg = &priv->bss_cfg; | |
300 | if (!bss_cfg->beacon_period) { | |
acebe8c1 ZL |
301 | mwifiex_dbg(priv->adapter, ERROR, |
302 | "channel switch: AP already stopped\n"); | |
7d652034 AP |
303 | return; |
304 | } | |
305 | ||
7ee38bf4 | 306 | mwifiex_uap_set_channel(priv, bss_cfg, priv->dfs_chandef); |
7d652034 AP |
307 | |
308 | if (mwifiex_config_start_uap(priv, bss_cfg)) { | |
acebe8c1 ZL |
309 | mwifiex_dbg(priv->adapter, ERROR, |
310 | "Failed to start AP after channel switch\n"); | |
7d652034 AP |
311 | return; |
312 | } | |
313 | ||
acebe8c1 ZL |
314 | mwifiex_dbg(priv->adapter, MSG, |
315 | "indicating channel switch completion to kernel\n"); | |
7d652034 AP |
316 | cfg80211_ch_switch_notify(priv->netdev, &priv->dfs_chandef); |
317 | } |