| /* |
| * Marvell Wireless LAN device driver: 802.11h |
| * |
| * Copyright (C) 2013-2014, Marvell International Ltd. |
| * |
| * This software file (the "File") is distributed by Marvell International |
| * Ltd. under the terms of the GNU General Public License Version 2, June 1991 |
| * (the "License"). You may use, redistribute and/or modify this File in |
| * accordance with the terms and conditions of the License, a copy of which |
| * is available by writing to the Free Software Foundation, Inc., |
| * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the |
| * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt. |
| * |
| * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE |
| * ARE EXPRESSLY DISCLAIMED. The License provides additional details about |
| * this warranty disclaimer. |
| */ |
| |
| #include "main.h" |
| #include "fw.h" |
| |
| |
| void mwifiex_init_11h_params(struct mwifiex_private *priv) |
| { |
| priv->state_11h.is_11h_enabled = true; |
| priv->state_11h.is_11h_active = false; |
| } |
| |
| inline int mwifiex_is_11h_active(struct mwifiex_private *priv) |
| { |
| return priv->state_11h.is_11h_active; |
| } |
| /* This function appends 11h info to a buffer while joining an |
| * infrastructure BSS |
| */ |
| static void |
| mwifiex_11h_process_infra_join(struct mwifiex_private *priv, u8 **buffer, |
| struct mwifiex_bssdescriptor *bss_desc) |
| { |
| struct mwifiex_ie_types_header *ie_header; |
| struct mwifiex_ie_types_pwr_capability *cap; |
| struct mwifiex_ie_types_local_pwr_constraint *constraint; |
| struct ieee80211_supported_band *sband; |
| u8 radio_type; |
| int i; |
| |
| if (!buffer || !(*buffer)) |
| return; |
| |
| radio_type = mwifiex_band_to_radio_type((u8) bss_desc->bss_band); |
| sband = priv->wdev.wiphy->bands[radio_type]; |
| |
| cap = (struct mwifiex_ie_types_pwr_capability *)*buffer; |
| cap->header.type = cpu_to_le16(WLAN_EID_PWR_CAPABILITY); |
| cap->header.len = cpu_to_le16(2); |
| cap->min_pwr = 0; |
| cap->max_pwr = 0; |
| *buffer += sizeof(*cap); |
| |
| constraint = (struct mwifiex_ie_types_local_pwr_constraint *)*buffer; |
| constraint->header.type = cpu_to_le16(WLAN_EID_PWR_CONSTRAINT); |
| constraint->header.len = cpu_to_le16(2); |
| constraint->chan = bss_desc->channel; |
| constraint->constraint = bss_desc->local_constraint; |
| *buffer += sizeof(*constraint); |
| |
| ie_header = (struct mwifiex_ie_types_header *)*buffer; |
| ie_header->type = cpu_to_le16(TLV_TYPE_PASSTHROUGH); |
| ie_header->len = cpu_to_le16(2 * sband->n_channels + 2); |
| *buffer += sizeof(*ie_header); |
| *(*buffer)++ = WLAN_EID_SUPPORTED_CHANNELS; |
| *(*buffer)++ = 2 * sband->n_channels; |
| for (i = 0; i < sband->n_channels; i++) { |
| *(*buffer)++ = ieee80211_frequency_to_channel( |
| sband->channels[i].center_freq); |
| *(*buffer)++ = 1; /* one channel in the subband */ |
| } |
| } |
| |
| /* Enable or disable the 11h extensions in the firmware */ |
| int mwifiex_11h_activate(struct mwifiex_private *priv, bool flag) |
| { |
| u32 enable = flag; |
| |
| /* enable master mode radar detection on AP interface */ |
| if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) && enable) |
| enable |= MWIFIEX_MASTER_RADAR_DET_MASK; |
| |
| return mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB, |
| HostCmd_ACT_GEN_SET, DOT11H_I, &enable, true); |
| } |
| |
| /* This functions processes TLV buffer for a pending BSS Join command. |
| * |
| * Activate 11h functionality in the firmware if the spectrum management |
| * capability bit is found in the network we are joining. Also, necessary |
| * TLVs are set based on requested network's 11h capability. |
| */ |
| void mwifiex_11h_process_join(struct mwifiex_private *priv, u8 **buffer, |
| struct mwifiex_bssdescriptor *bss_desc) |
| { |
| if (bss_desc->sensed_11h) { |
| /* Activate 11h functions in firmware, turns on capability |
| * bit |
| */ |
| mwifiex_11h_activate(priv, true); |
| priv->state_11h.is_11h_active = true; |
| bss_desc->cap_info_bitmap |= WLAN_CAPABILITY_SPECTRUM_MGMT; |
| mwifiex_11h_process_infra_join(priv, buffer, bss_desc); |
| } else { |
| /* Deactivate 11h functions in the firmware */ |
| mwifiex_11h_activate(priv, false); |
| priv->state_11h.is_11h_active = false; |
| bss_desc->cap_info_bitmap &= ~WLAN_CAPABILITY_SPECTRUM_MGMT; |
| } |
| } |
| |
| /* This is DFS CAC work queue function. |
| * This delayed work emits CAC finished event for cfg80211 if |
| * CAC was started earlier. |
| */ |
| void mwifiex_dfs_cac_work_queue(struct work_struct *work) |
| { |
| struct cfg80211_chan_def chandef; |
| struct delayed_work *delayed_work = |
| container_of(work, struct delayed_work, work); |
| struct mwifiex_private *priv = |
| container_of(delayed_work, struct mwifiex_private, |
| dfs_cac_work); |
| |
| if (WARN_ON(!priv)) |
| return; |
| |
| chandef = priv->dfs_chandef; |
| if (priv->wdev.cac_started) { |
| dev_dbg(priv->adapter->dev, |
| "CAC timer finished; No radar detected\n"); |
| cfg80211_cac_event(priv->netdev, &chandef, |
| NL80211_RADAR_CAC_FINISHED, |
| GFP_KERNEL); |
| } |
| } |
| |
| /* This function prepares channel report request command to FW for |
| * starting radar detection. |
| */ |
| int mwifiex_cmd_issue_chan_report_request(struct mwifiex_private *priv, |
| struct host_cmd_ds_command *cmd, |
| void *data_buf) |
| { |
| struct host_cmd_ds_chan_rpt_req *cr_req = &cmd->params.chan_rpt_req; |
| struct mwifiex_radar_params *radar_params = (void *)data_buf; |
| |
| cmd->command = cpu_to_le16(HostCmd_CMD_CHAN_REPORT_REQUEST); |
| cmd->size = cpu_to_le16(S_DS_GEN); |
| le16_add_cpu(&cmd->size, sizeof(struct host_cmd_ds_chan_rpt_req)); |
| |
| cr_req->chan_desc.start_freq = cpu_to_le16(MWIFIEX_A_BAND_START_FREQ); |
| cr_req->chan_desc.chan_num = radar_params->chandef->chan->hw_value; |
| cr_req->chan_desc.chan_width = radar_params->chandef->width; |
| cr_req->msec_dwell_time = cpu_to_le32(radar_params->cac_time_ms); |
| |
| dev_dbg(priv->adapter->dev, |
| "11h: issuing DFS Radar check for channel=%d\n", |
| radar_params->chandef->chan->hw_value); |
| |
| return 0; |
| } |
| |
| /* This function is to abort ongoing CAC upon stopping AP operations |
| * or during unload. |
| */ |
| void mwifiex_abort_cac(struct mwifiex_private *priv) |
| { |
| if (priv->wdev.cac_started) { |
| dev_dbg(priv->adapter->dev, |
| "Aborting delayed work for CAC.\n"); |
| cancel_delayed_work_sync(&priv->dfs_cac_work); |
| cfg80211_cac_event(priv->netdev, &priv->dfs_chandef, |
| NL80211_RADAR_CAC_ABORTED, GFP_KERNEL); |
| } |
| } |
| |
| /* This function handles channel report event from FW during CAC period. |
| * If radar is detected during CAC, driver indicates the same to cfg80211 |
| * and also cancels ongoing delayed work. |
| */ |
| int mwifiex_11h_handle_chanrpt_ready(struct mwifiex_private *priv, |
| struct sk_buff *skb) |
| { |
| struct host_cmd_ds_chan_rpt_event *rpt_event; |
| struct mwifiex_ie_types_chan_rpt_data *rpt; |
| u8 *evt_buf; |
| u16 event_len, tlv_len; |
| |
| rpt_event = (void *)(skb->data + sizeof(u32)); |
| event_len = skb->len - (sizeof(struct host_cmd_ds_chan_rpt_event)+ |
| sizeof(u32)); |
| |
| if (le32_to_cpu(rpt_event->result) != HostCmd_RESULT_OK) { |
| dev_err(priv->adapter->dev, "Error in channel report event\n"); |
| return -1; |
| } |
| |
| evt_buf = (void *)&rpt_event->tlvbuf; |
| |
| while (event_len >= sizeof(struct mwifiex_ie_types_header)) { |
| rpt = (void *)&rpt_event->tlvbuf; |
| tlv_len = le16_to_cpu(rpt->header.len); |
| |
| switch (le16_to_cpu(rpt->header.type)) { |
| case TLV_TYPE_CHANRPT_11H_BASIC: |
| if (rpt->map.radar) { |
| dev_notice(priv->adapter->dev, |
| "RADAR Detected on channel %d!\n", |
| priv->dfs_chandef.chan->hw_value); |
| cancel_delayed_work_sync(&priv->dfs_cac_work); |
| cfg80211_cac_event(priv->netdev, |
| &priv->dfs_chandef, |
| NL80211_RADAR_DETECTED, |
| GFP_KERNEL); |
| } |
| break; |
| default: |
| break; |
| } |
| |
| evt_buf += (tlv_len + sizeof(rpt->header)); |
| event_len -= (tlv_len + sizeof(rpt->header)); |
| } |
| |
| return 0; |
| } |
| |
| /* Handler for radar detected event from FW.*/ |
| int mwifiex_11h_handle_radar_detected(struct mwifiex_private *priv, |
| struct sk_buff *skb) |
| { |
| struct mwifiex_radar_det_event *rdr_event; |
| |
| rdr_event = (void *)(skb->data + sizeof(u32)); |
| |
| if (le32_to_cpu(rdr_event->passed)) { |
| dev_notice(priv->adapter->dev, |
| "radar detected; indicating kernel\n"); |
| cfg80211_radar_event(priv->adapter->wiphy, &priv->dfs_chandef, |
| GFP_KERNEL); |
| dev_dbg(priv->adapter->dev, "regdomain: %d\n", |
| rdr_event->reg_domain); |
| dev_dbg(priv->adapter->dev, "radar detection type: %d\n", |
| rdr_event->det_type); |
| } else { |
| dev_dbg(priv->adapter->dev, "false radar detection event!\n"); |
| } |
| |
| return 0; |
| } |
| |
| /* This is work queue function for channel switch handling. |
| * This function takes care of updating new channel definitin to |
| * bss config structure, restart AP and indicate channel switch success |
| * to cfg80211. |
| */ |
| void mwifiex_dfs_chan_sw_work_queue(struct work_struct *work) |
| { |
| struct mwifiex_uap_bss_param *bss_cfg; |
| struct delayed_work *delayed_work = |
| container_of(work, struct delayed_work, work); |
| struct mwifiex_private *priv = |
| container_of(delayed_work, struct mwifiex_private, |
| dfs_chan_sw_work); |
| |
| if (WARN_ON(!priv)) |
| return; |
| |
| bss_cfg = &priv->bss_cfg; |
| if (!bss_cfg->beacon_period) { |
| dev_err(priv->adapter->dev, |
| "channel switch: AP already stopped\n"); |
| return; |
| } |
| |
| mwifiex_uap_set_channel(bss_cfg, priv->dfs_chandef); |
| |
| if (mwifiex_config_start_uap(priv, bss_cfg)) { |
| dev_dbg(priv->adapter->dev, |
| "Failed to start AP after channel switch\n"); |
| return; |
| } |
| |
| dev_notice(priv->adapter->dev, |
| "indicating channel switch completion to kernel\n"); |
| cfg80211_ch_switch_notify(priv->netdev, &priv->dfs_chandef); |
| } |