cfg80211: use wdev in mgmt-tx/ROC APIs
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / ath / ath6kl / cfg80211.c
index 28a65d3a03d0df49af91e92668b8099c966e5191..5f0c66bb6bdfd80b8886986bed198dc33685bd72 100644 (file)
 
 #define DEFAULT_BG_SCAN_PERIOD 60
 
+struct ath6kl_cfg80211_match_probe_ssid {
+       struct cfg80211_ssid ssid;
+       u8 flag;
+};
+
 static struct ieee80211_rate ath6kl_rates[] = {
        RATETAB_ENT(10, 0x1, 0),
        RATETAB_ENT(20, 0x2, 0),
@@ -576,6 +581,9 @@ static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
 
        vif->nw_type = vif->next_mode;
 
+       /* enable enhanced bmiss detection if applicable */
+       ath6kl_cfg80211_sta_bmiss_enhance(vif, true);
+
        if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT)
                nw_subtype = SUBTYPE_P2PCLIENT;
 
@@ -693,8 +701,8 @@ ath6kl_add_bss_if_needed(struct ath6kl_vif *vif,
                                          ie, 2 + vif->ssid_len + beacon_ie_len,
                                          0, GFP_KERNEL);
                if (bss)
-                       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to "
-                                  "cfg80211\n", bssid);
+                       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
+                                  "added bss %pM to cfg80211\n", bssid);
                kfree(ie);
        } else
                ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n");
@@ -852,20 +860,6 @@ void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason,
                }
        }
 
-       /*
-        * Send a disconnect command to target when a disconnect event is
-        * received with reason code other than 3 (DISCONNECT_CMD - disconnect
-        * request from host) to make the firmware stop trying to connect even
-        * after giving disconnect event. There will be one more disconnect
-        * event for this disconnect command with reason code DISCONNECT_CMD
-        * which will be notified to cfg80211.
-        */
-
-       if (reason != DISCONNECT_CMD) {
-               ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
-               return;
-       }
-
        clear_bit(CONNECT_PEND, &vif->flags);
 
        if (vif->sme_state == SME_CONNECTING) {
@@ -875,11 +869,101 @@ void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason,
                                        WLAN_STATUS_UNSPECIFIED_FAILURE,
                                        GFP_KERNEL);
        } else if (vif->sme_state == SME_CONNECTED) {
-               cfg80211_disconnected(vif->ndev, reason,
+               cfg80211_disconnected(vif->ndev, proto_reason,
                                      NULL, 0, GFP_KERNEL);
        }
 
        vif->sme_state = SME_DISCONNECTED;
+
+       /*
+        * Send a disconnect command to target when a disconnect event is
+        * received with reason code other than 3 (DISCONNECT_CMD - disconnect
+        * request from host) to make the firmware stop trying to connect even
+        * after giving disconnect event. There will be one more disconnect
+        * event for this disconnect command with reason code DISCONNECT_CMD
+        * which won't be notified to cfg80211.
+        */
+       if (reason != DISCONNECT_CMD)
+               ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
+}
+
+static int ath6kl_set_probed_ssids(struct ath6kl *ar,
+                                  struct ath6kl_vif *vif,
+                                  struct cfg80211_ssid *ssids, int n_ssids,
+                                  struct cfg80211_match_set *match_set,
+                                  int n_match_ssid)
+{
+       u8 i, j, index_to_add, ssid_found = false;
+       struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS];
+
+       memset(ssid_list, 0, sizeof(ssid_list));
+
+       if (n_ssids > MAX_PROBED_SSIDS ||
+           n_match_ssid > MAX_PROBED_SSIDS)
+               return -EINVAL;
+
+       for (i = 0; i < n_ssids; i++) {
+               memcpy(ssid_list[i].ssid.ssid,
+                      ssids[i].ssid,
+                      ssids[i].ssid_len);
+               ssid_list[i].ssid.ssid_len = ssids[i].ssid_len;
+
+               if (ssids[i].ssid_len)
+                       ssid_list[i].flag = SPECIFIC_SSID_FLAG;
+               else
+                       ssid_list[i].flag = ANY_SSID_FLAG;
+
+               if (n_match_ssid == 0)
+                       ssid_list[i].flag |= MATCH_SSID_FLAG;
+       }
+
+       index_to_add = i;
+
+       for (i = 0; i < n_match_ssid; i++) {
+               ssid_found = false;
+
+               for (j = 0; j < n_ssids; j++) {
+                       if ((match_set[i].ssid.ssid_len ==
+                            ssid_list[j].ssid.ssid_len) &&
+                           (!memcmp(ssid_list[j].ssid.ssid,
+                                    match_set[i].ssid.ssid,
+                                    match_set[i].ssid.ssid_len))) {
+                               ssid_list[j].flag |= MATCH_SSID_FLAG;
+                               ssid_found = true;
+                               break;
+                       }
+               }
+
+               if (ssid_found)
+                       continue;
+
+               if (index_to_add >= MAX_PROBED_SSIDS)
+                       continue;
+
+               ssid_list[index_to_add].ssid.ssid_len =
+                       match_set[i].ssid.ssid_len;
+               memcpy(ssid_list[index_to_add].ssid.ssid,
+                      match_set[i].ssid.ssid,
+                      match_set[i].ssid.ssid_len);
+               ssid_list[index_to_add].flag |= MATCH_SSID_FLAG;
+               index_to_add++;
+       }
+
+       for (i = 0; i < index_to_add; i++) {
+               ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i,
+                                         ssid_list[i].flag,
+                                         ssid_list[i].ssid.ssid_len,
+                                         ssid_list[i].ssid.ssid);
+
+       }
+
+       /* Make sure no old entries are left behind */
+       for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) {
+               ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i,
+                                         DISABLE_SSID_FLAG, 0, NULL);
+       }
+
+       return 0;
 }
 
 static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
@@ -899,36 +983,25 @@ static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
 
        if (!ar->usr_bss_filter) {
                clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
-               ret = ath6kl_wmi_bssfilter_cmd(
-                       ar->wmi, vif->fw_vif_idx,
-                       (test_bit(CONNECTED, &vif->flags) ?
-                        ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0);
+               ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
+                                              ALL_BSS_FILTER, 0);
                if (ret) {
                        ath6kl_err("couldn't set bss filtering\n");
                        return ret;
                }
        }
 
-       if (request->n_ssids && request->ssids[0].ssid_len) {
-               u8 i;
-
-               if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1))
-                       request->n_ssids = MAX_PROBED_SSID_INDEX - 1;
-
-               for (i = 0; i < request->n_ssids; i++)
-                       ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
-                                                 i + 1, SPECIFIC_SSID_FLAG,
-                                                 request->ssids[i].ssid_len,
-                                                 request->ssids[i].ssid);
-       }
+       ret = ath6kl_set_probed_ssids(ar, vif, request->ssids,
+                                     request->n_ssids, NULL, 0);
+       if (ret < 0)
+               return ret;
 
        /* this also clears IE in fw if it's not set */
        ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
                                       WMI_FRAME_PROBE_REQ,
                                       request->ie, request->ie_len);
        if (ret) {
-               ath6kl_err("failed to set Probe Request appie for "
-                          "scan");
+               ath6kl_err("failed to set Probe Request appie for scan\n");
                return ret;
        }
 
@@ -945,8 +1018,7 @@ static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
 
                channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL);
                if (channels == NULL) {
-                       ath6kl_warn("failed to set scan channels, "
-                                   "scan all channels");
+                       ath6kl_warn("failed to set scan channels, scan all channels");
                        n_channels = 0;
                }
 
@@ -1018,6 +1090,20 @@ out:
        vif->scan_req = NULL;
 }
 
+void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq,
+                                     enum wmi_phy_mode mode)
+{
+       enum nl80211_channel_type type;
+
+       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
+                  "channel switch notify nw_type %d freq %d mode %d\n",
+                  vif->nw_type, freq, mode);
+
+       type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT;
+
+       cfg80211_ch_switch_notify(vif->ndev, freq, type);
+}
+
 static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
                                   u8 key_index, bool pairwise,
                                   const u8 *mac_addr,
@@ -1111,9 +1197,8 @@ static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
                ar->ap_mode_bkey.key_len = key->key_len;
                memcpy(ar->ap_mode_bkey.key, key->key, key->key_len);
                if (!test_bit(CONNECTED, &vif->flags)) {
-                       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group "
-                                  "key configuration until AP mode has been "
-                                  "started\n");
+                       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
+                                  "Delay initial group key configuration until AP mode has been started\n");
                        /*
                         * The key will be set in ath6kl_connect_ap_mode() once
                         * the connected event is received from the target.
@@ -1129,8 +1214,8 @@ static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
                 * the AP mode has properly started
                 * (ath6kl_install_statioc_wep_keys).
                 */
-               ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration "
-                          "until AP mode has been started\n");
+               ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
+                          "Delay WEP key configuration until AP mode has been started\n");
                vif->wep_key_list[key_index].key_len = key->key_len;
                memcpy(vif->wep_key_list[key_index].key, key->key,
                       key->key_len);
@@ -1485,6 +1570,9 @@ static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy,
                }
        }
 
+       /* need to clean up enhanced bmiss detection fw state */
+       ath6kl_cfg80211_sta_bmiss_enhance(vif, false);
+
 set_iface_type:
        switch (type) {
        case NL80211_IFTYPE_STATION:
@@ -1962,8 +2050,7 @@ static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif)
                                sizeof(discvr_pattern), discvr_offset,
                                discvr_pattern, discvr_mask);
                if (ret) {
-                       ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR "
-                                  "pattern\n");
+                       ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n");
                        return ret;
                }
        }
@@ -2031,6 +2118,10 @@ static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow)
        u8 index = 0;
        __be32 ips[MAX_IP_ADDRS];
 
+       /* The FW currently can't support multi-vif WoW properly. */
+       if (ar->num_vif > 1)
+               return -EIO;
+
        vif = ath6kl_vif_first(ar);
        if (!vif)
                return -EIO;
@@ -2044,6 +2135,15 @@ static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow)
        if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST))
                return -EINVAL;
 
+       if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) &&
+           test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER,
+                    ar->fw_capabilities)) {
+               ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi,
+                                               vif->fw_vif_idx, false);
+               if (ret)
+                       return ret;
+       }
+
        /* Clear existing WOW patterns */
        for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++)
                ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx,
@@ -2147,8 +2247,8 @@ static int ath6kl_wow_resume(struct ath6kl *ar)
        ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
                                                 ATH6KL_HOST_MODE_AWAKE);
        if (ret) {
-               ath6kl_warn("Failed to configure host sleep mode for "
-                           "wow resume: %d\n", ret);
+               ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n",
+                           ret);
                ar->state = ATH6KL_STATE_WOW;
                return ret;
        }
@@ -2172,6 +2272,15 @@ static int ath6kl_wow_resume(struct ath6kl *ar)
 
        ar->state = ATH6KL_STATE_ON;
 
+       if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) &&
+           test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER,
+                    ar->fw_capabilities)) {
+               ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi,
+                                       vif->fw_vif_idx, true);
+               if (ret)
+                       return ret;
+       }
+
        netif_wake_queue(vif->ndev);
 
        return 0;
@@ -2186,8 +2295,10 @@ static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar)
        if (!vif)
                return -EIO;
 
-       if (!ath6kl_cfg80211_ready(vif))
+       if (!test_bit(WMI_READY, &ar->flag)) {
+               ath6kl_err("deepsleep failed as wmi is not ready\n");
                return -EIO;
+       }
 
        ath6kl_cfg80211_stop_all(ar);
 
@@ -2429,7 +2540,7 @@ void ath6kl_check_wow_status(struct ath6kl *ar)
 static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band,
                            bool ht_enable)
 {
-       struct ath6kl_htcap *htcap = &vif->htcap;
+       struct ath6kl_htcap *htcap = &vif->htcap[band];
 
        if (htcap->ht_enable == ht_enable)
                return 0;
@@ -2447,6 +2558,24 @@ static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band,
                                        band, htcap);
 }
 
+static int ath6kl_restore_htcap(struct ath6kl_vif *vif)
+{
+       struct wiphy *wiphy = vif->ar->wiphy;
+       int band, ret = 0;
+
+       for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
+               if (!wiphy->bands[band])
+                       continue;
+
+               ret = ath6kl_set_htcap(vif, band,
+                               wiphy->bands[band]->ht_cap.ht_supported);
+               if (ret)
+                       return ret;
+       }
+
+       return ret;
+}
+
 static bool ath6kl_is_p2p_ie(const u8 *pos)
 {
        return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
@@ -2521,33 +2650,28 @@ static int ath6kl_set_ies(struct ath6kl_vif *vif,
        return 0;
 }
 
-static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev,
-                             struct ieee80211_channel *chan,
-                             enum nl80211_channel_type channel_type)
+void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif, bool enable)
 {
-       struct ath6kl_vif *vif;
+       int err;
 
-       /*
-        * 'dev' could be NULL if a channel change is required for the hardware
-        * device itself, instead of a particular VIF.
-        *
-        * FIXME: To be handled properly when monitor mode is supported.
-        */
-       if (!dev)
-               return -EBUSY;
+       if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag)))
+               return;
 
-       vif = netdev_priv(dev);
+       if (vif->nw_type != INFRA_NETWORK)
+               return;
 
-       if (!ath6kl_cfg80211_ready(vif))
-               return -EIO;
+       if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE,
+                     vif->ar->fw_capabilities))
+               return;
 
-       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n",
-                  __func__, chan->center_freq, chan->hw_value);
-       vif->next_chan = chan->center_freq;
-       vif->next_ch_type = channel_type;
-       vif->next_ch_band = chan->band;
+       ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n",
+                  enable ? "enable" : "disable");
 
-       return 0;
+       err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi,
+                                              vif->fw_vif_idx, enable);
+       if (err)
+               ath6kl_err("failed to %s enhanced bmiss detection: %d\n",
+                          enable ? "enable" : "disable", err);
 }
 
 static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon,
@@ -2568,28 +2692,34 @@ static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon,
        /* skip element id and length */
        rsn_ie += 2;
 
-       /* skip version, group cipher */
-       if (rsn_ie_len < 6)
+       /* skip version */
+       if (rsn_ie_len < 2)
                return -EINVAL;
-       rsn_ie +=  6;
-       rsn_ie_len -= 6;
+       rsn_ie +=  2;
+       rsn_ie_len -= 2;
+
+       /* skip group cipher suite */
+       if (rsn_ie_len < 4)
+               return 0;
+       rsn_ie +=  4;
+       rsn_ie_len -= 4;
 
        /* skip pairwise cipher suite */
        if (rsn_ie_len < 2)
-               return -EINVAL;
-       cnt = *((u16 *) rsn_ie);
+               return 0;
+       cnt = get_unaligned_le16(rsn_ie);
        rsn_ie += (2 + cnt * 4);
        rsn_ie_len -= (2 + cnt * 4);
 
        /* skip akm suite */
        if (rsn_ie_len < 2)
-               return -EINVAL;
-       cnt = *((u16 *) rsn_ie);
+               return 0;
+       cnt = get_unaligned_le16(rsn_ie);
        rsn_ie += (2 + cnt * 4);
        rsn_ie_len -= (2 + cnt * 4);
 
        if (rsn_ie_len < 2)
-               return -EINVAL;
+               return 0;
 
        memcpy(rsn_capab, rsn_ie, 2);
 
@@ -2624,9 +2754,15 @@ static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev,
 
        /* TODO:
         * info->interval
-        * info->dtim_period
         */
 
+       ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx,
+                                        info->dtim_period);
+
+       /* ignore error, just print a warning and continue normally */
+       if (ret)
+               ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret);
+
        if (info->beacon.head == NULL)
                return -EINVAL;
        mgmt = (struct ieee80211_mgmt *) info->beacon.head;
@@ -2721,7 +2857,7 @@ static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev,
        p.ssid_len = vif->ssid_len;
        memcpy(p.ssid, vif->ssid, vif->ssid_len);
        p.dot11_auth_mode = vif->dot11_auth_mode;
-       p.ch = cpu_to_le16(vif->next_chan);
+       p.ch = cpu_to_le16(info->channel->center_freq);
 
        /* Enable uAPSD support by default */
        res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true);
@@ -2745,8 +2881,8 @@ static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev,
                        return res;
        }
 
-       if (ath6kl_set_htcap(vif, vif->next_ch_band,
-                            vif->next_ch_type != NL80211_CHAN_NO_HT))
+       if (ath6kl_set_htcap(vif, info->channel->band,
+                            info->channel_type != NL80211_CHAN_NO_HT))
                return -EIO;
 
        /*
@@ -2766,6 +2902,7 @@ static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev,
                        return res;
        }
 
+       memcpy(&vif->profile, &p, sizeof(p));
        res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p);
        if (res < 0)
                return res;
@@ -2801,13 +2938,7 @@ static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev)
        clear_bit(CONNECTED, &vif->flags);
 
        /* Restore ht setting in firmware */
-       if (ath6kl_set_htcap(vif, IEEE80211_BAND_2GHZ, true))
-               return -EIO;
-
-       if (ath6kl_set_htcap(vif, IEEE80211_BAND_5GHZ, true))
-               return -EIO;
-
-       return 0;
+       return ath6kl_restore_htcap(vif);
 }
 
 static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
@@ -2844,14 +2975,14 @@ static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev,
 }
 
 static int ath6kl_remain_on_channel(struct wiphy *wiphy,
-                                   struct net_device *dev,
+                                   struct wireless_dev *wdev,
                                    struct ieee80211_channel *chan,
                                    enum nl80211_channel_type channel_type,
                                    unsigned int duration,
                                    u64 *cookie)
 {
-       struct ath6kl *ar = ath6kl_priv(dev);
-       struct ath6kl_vif *vif = netdev_priv(dev);
+       struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
+       struct ath6kl *ar = ath6kl_priv(vif->ndev);
        u32 id;
 
        /* TODO: if already pending or ongoing remain-on-channel,
@@ -2868,11 +2999,11 @@ static int ath6kl_remain_on_channel(struct wiphy *wiphy,
 }
 
 static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy,
-                                          struct net_device *dev,
+                                          struct wireless_dev *wdev,
                                           u64 cookie)
 {
-       struct ath6kl *ar = ath6kl_priv(dev);
-       struct ath6kl_vif *vif = netdev_priv(dev);
+       struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
+       struct ath6kl *ar = ath6kl_priv(vif->ndev);
 
        if (cookie != vif->last_roc_id)
                return -ENOENT;
@@ -3003,15 +3134,15 @@ static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len)
        return false;
 }
 
-static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev,
+static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
                          struct ieee80211_channel *chan, bool offchan,
                          enum nl80211_channel_type channel_type,
                          bool channel_type_valid, unsigned int wait,
                          const u8 *buf, size_t len, bool no_cck,
                          bool dont_wait_for_ack, u64 *cookie)
 {
-       struct ath6kl *ar = ath6kl_priv(dev);
-       struct ath6kl_vif *vif = netdev_priv(dev);
+       struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
+       struct ath6kl *ar = ath6kl_priv(vif->ndev);
        u32 id;
        const struct ieee80211_mgmt *mgmt;
        bool more_data, queued;
@@ -3056,10 +3187,10 @@ static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev,
 }
 
 static void ath6kl_mgmt_frame_register(struct wiphy *wiphy,
-                                      struct net_device *dev,
+                                      struct wireless_dev *wdev,
                                       u16 frame_type, bool reg)
 {
-       struct ath6kl_vif *vif = netdev_priv(dev);
+       struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
 
        ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n",
                   __func__, frame_type, reg);
@@ -3081,7 +3212,6 @@ static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
        struct ath6kl_vif *vif = netdev_priv(dev);
        u16 interval;
        int ret;
-       u8 i;
 
        if (ar->state != ATH6KL_STATE_ON)
                return -EIO;
@@ -3089,12 +3219,29 @@ static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
        if (vif->sme_state != SME_DISCONNECTED)
                return -EBUSY;
 
+       /* The FW currently can't support multi-vif WoW properly. */
+       if (ar->num_vif > 1)
+               return -EIO;
+
        ath6kl_cfg80211_scan_complete_event(vif, true);
 
-       for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) {
-               ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
-                                         i, DISABLE_SSID_FLAG,
-                                         0, NULL);
+       ret = ath6kl_set_probed_ssids(ar, vif, request->ssids,
+                                     request->n_ssids,
+                                     request->match_sets,
+                                     request->n_match_sets);
+       if (ret < 0)
+               return ret;
+
+       if (!request->n_match_sets) {
+               ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
+                                              ALL_BSS_FILTER, 0);
+               if (ret < 0)
+                       return ret;
+       } else {
+                ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
+                                               MATCHED_SSID_FILTER, 0);
+               if (ret < 0)
+                       return ret;
        }
 
        /* fw uses seconds, also make sure that it's >0 */
@@ -3102,16 +3249,7 @@ static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
 
        ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
                                  interval, interval,
-                                 10, 0, 0, 0, 3, 0, 0, 0);
-
-       if (request->n_ssids && request->ssids[0].ssid_len) {
-               for (i = 0; i < request->n_ssids; i++) {
-                       ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
-                                                 i, SPECIFIC_SSID_FLAG,
-                                                 request->ssids[i].ssid_len,
-                                                 request->ssids[i].ssid);
-               }
-       }
+                                 vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0);
 
        ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
                                          ATH6KL_WOW_MODE_ENABLE,
@@ -3127,7 +3265,7 @@ static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
                                       WMI_FRAME_PROBE_REQ,
                                       request->ie, request->ie_len);
        if (ret) {
-               ath6kl_warn("Failed to set probe request IE for scheduled scan: %d",
+               ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n",
                            ret);
                return ret;
        }
@@ -3159,6 +3297,18 @@ static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy,
        return 0;
 }
 
+static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy,
+                                      struct net_device *dev,
+                                      const u8 *addr,
+                                      const struct cfg80211_bitrate_mask *mask)
+{
+       struct ath6kl *ar = ath6kl_priv(dev);
+       struct ath6kl_vif *vif = netdev_priv(dev);
+
+       return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx,
+                                          mask);
+}
+
 static const struct ieee80211_txrx_stypes
 ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = {
        [NL80211_IFTYPE_STATION] = {
@@ -3213,7 +3363,6 @@ static struct cfg80211_ops ath6kl_cfg80211_ops = {
        .suspend = __ath6kl_cfg80211_suspend,
        .resume = __ath6kl_cfg80211_resume,
 #endif
-       .set_channel = ath6kl_set_channel,
        .start_ap = ath6kl_start_ap,
        .change_beacon = ath6kl_change_beacon,
        .stop_ap = ath6kl_stop_ap,
@@ -3225,6 +3374,7 @@ static struct cfg80211_ops ath6kl_cfg80211_ops = {
        .mgmt_frame_register = ath6kl_mgmt_frame_register,
        .sched_scan_start = ath6kl_cfg80211_sscan_start,
        .sched_scan_stop = ath6kl_cfg80211_sscan_stop,
+       .set_bitrate_mask = ath6kl_cfg80211_set_bitrate,
 };
 
 void ath6kl_cfg80211_stop(struct ath6kl_vif *vif)
@@ -3271,8 +3421,7 @@ void ath6kl_cfg80211_stop_all(struct ath6kl *ar)
                ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
 
                if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0)
-                       ath6kl_warn("ath6kl_deep_sleep_enable: "
-                                   "wmi_powermode_cmd failed\n");
+                       ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n");
                return;
        }
 
@@ -3352,7 +3501,9 @@ struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name,
        vif->next_mode = nw_type;
        vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL;
        vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME;
-       vif->htcap.ht_enable = true;
+       vif->bg_scan_period = 0;
+       vif->htcap[IEEE80211_BAND_2GHZ].ht_enable = true;
+       vif->htcap[IEEE80211_BAND_5GHZ].ht_enable = true;
 
        memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN);
        if (fw_vif_idx != 0)
@@ -3393,6 +3544,7 @@ err:
 int ath6kl_cfg80211_init(struct ath6kl *ar)
 {
        struct wiphy *wiphy = ar->wiphy;
+       bool band_2gig = false, band_5gig = false, ht = false;
        int ret;
 
        wiphy->mgmt_stypes = ath6kl_mgmt_stypes;
@@ -3411,15 +3563,71 @@ int ath6kl_cfg80211_init(struct ath6kl *ar)
        }
 
        /* max num of ssids that can be probed during scanning */
-       wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX;
+       wiphy->max_scan_ssids = MAX_PROBED_SSIDS;
+
+       /* max num of ssids that can be matched after scan */
+       if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST,
+                    ar->fw_capabilities))
+               wiphy->max_match_sets = MAX_PROBED_SSIDS;
+
        wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */
-       wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz;
-       wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz;
+       switch (ar->hw.cap) {
+       case WMI_11AN_CAP:
+               ht = true;
+       case WMI_11A_CAP:
+               band_5gig = true;
+               break;
+       case WMI_11GN_CAP:
+               ht = true;
+       case WMI_11G_CAP:
+               band_2gig = true;
+               break;
+       case WMI_11AGN_CAP:
+               ht = true;
+       case WMI_11AG_CAP:
+               band_2gig = true;
+               band_5gig = true;
+               break;
+       default:
+               ath6kl_err("invalid phy capability!\n");
+               return -EINVAL;
+       }
+
+       /*
+        * Even if the fw has HT support, advertise HT cap only when
+        * the firmware has support to override RSN capability, otherwise
+        * 4-way handshake would fail.
+        */
+       if (!(ht &&
+             test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE,
+                      ar->fw_capabilities))) {
+               ath6kl_band_2ghz.ht_cap.cap = 0;
+               ath6kl_band_2ghz.ht_cap.ht_supported = false;
+               ath6kl_band_5ghz.ht_cap.cap = 0;
+               ath6kl_band_5ghz.ht_cap.ht_supported = false;
+       }
+
+       if (ar->hw.flags & ATH6KL_HW_FLAG_64BIT_RATES) {
+               ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff;
+               ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff;
+               ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff;
+               ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff;
+       } else {
+               ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff;
+               ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff;
+       }
+
+       if (band_2gig)
+               wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz;
+       if (band_5gig)
+               wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz;
+
        wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
 
        wiphy->cipher_suites = cipher_suites;
        wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
 
+#ifdef CONFIG_PM
        wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT |
                              WIPHY_WOWLAN_DISCONNECT |
                              WIPHY_WOWLAN_GTK_REKEY_FAILURE  |
@@ -3429,8 +3637,9 @@ int ath6kl_cfg80211_init(struct ath6kl *ar)
        wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST;
        wiphy->wowlan.pattern_min_len = 1;
        wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE;
+#endif
 
-       wiphy->max_sched_scan_ssids = 10;
+       wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS;
 
        ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM |
                            WIPHY_FLAG_HAVE_AP_SME |
@@ -3447,8 +3656,7 @@ int ath6kl_cfg80211_init(struct ath6kl *ar)
        ar->wiphy->probe_resp_offload =
                NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS |
                NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 |
-               NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P |
-               NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U;
+               NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P;
 
        ret = wiphy_register(wiphy);
        if (ret < 0) {