void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) { int i; ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); if (!ar->scan_req) return; if ((status == -ECANCELED) || (status == -EBUSY)) { cfg80211_scan_done(ar->scan_req, true); goto out; } cfg80211_scan_done(ar->scan_req, false); if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { for (i = 0; i < ar->scan_req->n_ssids; i++) { ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, DISABLE_SSID_FLAG, 0, NULL); } } out: ar->scan_req = NULL; }
static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, struct cfg80211_scan_request *request) { struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); s8 n_channels = 0; u16 *channels = NULL; int ret = 0; if (!ath6kl_cfg80211_ready(ar)) return -EIO; if (!ar->usr_bss_filter) { clear_bit(CLEAR_BSSFILTER_ON_BEACON, &ar->flag); ret = ath6kl_wmi_bssfilter_cmd( ar->wmi, (test_bit(CONNECTED, &ar->flag) ? ALL_BUT_BSS_FILTER : 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, i + 1, SPECIFIC_SSID_FLAG, request->ssids[i].ssid_len, request->ssids[i].ssid); } if (request->ie) { ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_REQ, request->ie, request->ie_len); if (ret) { ath6kl_err("failed to set Probe Request appie for " "scan"); return ret; } } /* * Scan only the requested channels if the request specifies a set of * channels. If the list is longer than the target supports, do not * configure the list and instead, scan all available channels. */ if (request->n_channels > 0 && request->n_channels <= WMI_MAX_CHANNELS) { u8 i; n_channels = request->n_channels; channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); if (channels == NULL) { ath6kl_warn("failed to set scan channels, " "scan all channels"); n_channels = 0; } for (i = 0; i < n_channels; i++) channels[i] = request->channels[i]->center_freq; } ret = ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, 0, false, 0, 0, n_channels, channels); if (ret) ath6kl_err("wmi_startscan_cmd failed\n"); else ar->scan_req = request; kfree(channels); return ret; }
int ath6kl_tm_cmd(struct wiphy *wiphy, void *data, int len) { struct ath6kl *ar = wiphy_priv(wiphy); struct nlattr *tb[ATH6KL_TM_ATTR_MAX + 1]; int err, buf_len; void *buf; err = nla_parse(tb, ATH6KL_TM_ATTR_MAX, data, len, ath6kl_tm_policy); if (err) return err; if (!tb[ATH6KL_TM_ATTR_CMD]) return -EINVAL; switch (nla_get_u32(tb[ATH6KL_TM_ATTR_CMD])) { case ATH6KL_TM_CMD_TCMD: if (!tb[ATH6KL_TM_ATTR_DATA]) return -EINVAL; buf = nla_data(tb[ATH6KL_TM_ATTR_DATA]); buf_len = nla_len(tb[ATH6KL_TM_ATTR_DATA]); ath6kl_wmi_test_cmd(ar->wmi, buf, buf_len); return 0; break; #ifdef ATH6KL_SUPPORT_WLAN_HB case ATH6KL_TM_CMD_WLAN_HB: { struct wlan_hb_params *hb_params; struct ath6kl_vif *vif; vif = ath6kl_vif_first(ar); if (!vif) return -EINVAL; if (!tb[ATH6KL_TM_ATTR_DATA]) { printk(KERN_ERR "%s: NO DATA\n", __func__); return -EINVAL; } buf = nla_data(tb[ATH6KL_TM_ATTR_DATA]); buf_len = nla_len(tb[ATH6KL_TM_ATTR_DATA]); hb_params = (struct wlan_hb_params *)buf; if (hb_params->cmd == NL80211_WLAN_HB_ENABLE) { if (hb_params->enable != 0) { if (ath6kl_enable_wow_hb(ar)) { printk(KERN_ERR "%s: enable hb wow fail\n", __func__); return -EINVAL; } if (hb_params->enable & WLAN_HB_TCP_ENABLE) { ar->wlan_hb_enable |= WLAN_HB_TCP_ENABLE; if (ath6kl_wmi_set_heart_beat_params( ar->wmi, vif->fw_vif_idx, WLAN_HB_TCP_ENABLE)) { printk(KERN_ERR "%s: set heart beat enable fail\n", __func__); return -EINVAL; } } else if (hb_params->enable & WLAN_HB_UDP_ENABLE) { ar->wlan_hb_enable |= WLAN_HB_UDP_ENABLE; } } else { ar->wlan_hb_enable = 0; #ifdef CONFIG_ANDROID if (ath6kl_android_enable_wow_default(ar)) { printk(KERN_ERR "%s: enable android defualt wow fail\n", __func__); } #endif if (ath6kl_wmi_set_heart_beat_params(ar->wmi, vif->fw_vif_idx, 0)) { printk(KERN_ERR "%s: set heart beat enable fail\n", __func__); return -EINVAL; } } } else if (hb_params->cmd == NL80211_WLAN_TCP_PARAMS) { if (ath6kl_wmi_heart_beat_set_tcp_params(ar->wmi, vif->fw_vif_idx, hb_params->params.tcp_params.src_port, hb_params->params.tcp_params.dst_port, hb_params->params.tcp_params.timeout)) { printk(KERN_ERR "%s: set heart beat tcp params fail\n", __func__); return -EINVAL; } } else if (hb_params->cmd == NL80211_WLAN_TCP_FILTER) { if (hb_params->params.tcp_filter.length > WMI_MAX_TCP_FILTER_SIZE) { printk(KERN_ERR "%s: size of tcp filter is too large: %d\n", __func__, hb_params->params.tcp_filter.length); return -E2BIG; } if (ath6kl_wmi_heart_beat_set_tcp_filter(ar->wmi, vif->fw_vif_idx, hb_params->params.tcp_filter.filter, hb_params->params.tcp_filter.length)) { printk(KERN_ERR "%s: set heart beat tcp filter fail\n", __func__); return -EINVAL; } } else if (hb_params->cmd == NL80211_WLAN_UDP_PARAMS) { if (ath6kl_wmi_heart_beat_set_udp_params(ar->wmi, vif->fw_vif_idx, hb_params->params.udp_params.src_port, hb_params->params.udp_params.dst_port, hb_params->params.udp_params.interval, hb_params->params.udp_params.timeout)) { printk(KERN_ERR "%s: set heart beat udp params fail\n", __func__); return -EINVAL; } } else if (hb_params->cmd == NL80211_WLAN_UDP_FILTER) { if (hb_params->params.udp_filter.length > WMI_MAX_UDP_FILTER_SIZE) { printk(KERN_ERR "%s: size of udp filter is too large: %d\n", __func__, hb_params->params.udp_filter.length); return -E2BIG; } if (ath6kl_wmi_heart_beat_set_udp_filter(ar->wmi, vif->fw_vif_idx, hb_params->params.udp_filter.filter, hb_params->params.udp_filter.length)) { printk(KERN_ERR "%s: set heart beat udp filter fail\n", __func__); return -EINVAL; } } else if (hb_params->cmd == NL80211_WLAN_NET_INFO) { if (ath6kl_wmi_heart_beat_set_network_info(ar->wmi, vif->fw_vif_idx, hb_params->params.net_info.device_ip, hb_params->params.net_info.server_ip, hb_params->params.net_info.gateway_ip, hb_params->params.net_info.gateway_mac)) { printk(KERN_ERR "%s: set heart beat network information fail\n", __func__); return -EINVAL; } } } return 0; break; #endif #ifdef ATH6KL_SUPPORT_WIFI_DISC case ATH6KL_TM_CMD_WIFI_DISC: { struct wifi_disc_params *disc_params; struct ath6kl_vif *vif; vif = ath6kl_vif_first(ar); if (!vif) return -EINVAL; if (!tb[ATH6KL_TM_ATTR_DATA]) { printk(KERN_ERR "%s: NO DATA\n", __func__); return -EINVAL; } buf = nla_data(tb[ATH6KL_TM_ATTR_DATA]); buf_len = nla_len(tb[ATH6KL_TM_ATTR_DATA]); disc_params = (struct wifi_disc_params *)buf; if (disc_params->cmd == NL80211_WIFI_DISC_IE) { u8 ie_hdr[6] = {0xDD, 0x00, 0x00, 0x03, 0x7f, 0x00}; u8 *ie = NULL; u16 ie_length = disc_params->params.ie_params.length; ie = kmalloc(ie_length+6, GFP_KERNEL); if (ie == NULL) return -ENOMEM; memcpy(ie, ie_hdr, 6); ie[1] = ie_length+4; memcpy(ie+6, disc_params->params.ie_params.ie, ie_length); if (ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, WMI_FRAME_PROBE_REQ, ie, ie_length+6)) { kfree(ie); printk(KERN_ERR "%s: wifi discovery set probe request ie fail\n", __func__); return -EINVAL; } if (ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, WMI_FRAME_PROBE_RESP, ie, ie_length+6)) { kfree(ie); printk(KERN_ERR "%s: wifi discovery set probe response ie fail\n", __func__); return -EINVAL; } kfree(ie); } else if (disc_params->cmd == NL80211_WIFI_DISC_IE_FILTER) { if (ath6kl_wmi_disc_ie_cmd(ar->wmi, vif->fw_vif_idx, disc_params->params.ie_filter_params.enable, disc_params->params.ie_filter_params.startPos, disc_params->params.ie_filter_params.filter, disc_params->params.ie_filter_params.length)) { printk(KERN_ERR "%s: wifi discovery set ie filter fail\n", __func__); return -EINVAL; } } else if (disc_params->cmd == NL80211_WIFI_DISC_START) { int band, freq, numPeers, random; if (disc_params->params.start_params.channel <= 14) band = IEEE80211_BAND_2GHZ; else band = IEEE80211_BAND_5GHZ; freq = ieee80211_channel_to_frequency( disc_params->params.start_params.channel, band); if (!freq) { printk(KERN_ERR "%s: wifi discovery start channel %d error\n", __func__, disc_params->params.start_params.channel); return -EINVAL; } if (disc_params->params.start_params.numPeers == 0) numPeers = 1; else if (disc_params->params.start_params.numPeers > 4) numPeers = 4; else numPeers = disc_params->params.start_params.numPeers; random = (disc_params->params.start_params.random == 0) ? 100 : disc_params->params.start_params.random; if (disc_params->params.start_params.txPower) ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, disc_params->params.start_params.txPower); /* disable scanning */ ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0xFFFF, 0, 0, 0, 0, 0, 0, 0, 0, 0); if (ath6kl_wmi_disc_mode_cmd(ar->wmi, vif->fw_vif_idx, 1, freq, disc_params->params.start_params.dwellTime, disc_params->params.start_params.sleepTime, random, numPeers, disc_params->params.start_params.peerTimeout )) { printk(KERN_ERR "%s: wifi discovery start fail\n", __func__); return -EINVAL; } /* change disc state to active */ ar->disc_active = true; } else if (disc_params->cmd == NL80211_WIFI_DISC_STOP) { /* change disc state to inactive */ ar->disc_active = false; if (ath6kl_wmi_disc_mode_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 0, 0, 0, 0, 0)) { printk(KERN_ERR "%s: wifi discovery stop fail\n", __func__); return -EINVAL; } } } return 0; break; #endif #ifdef ATH6KL_SUPPORT_WIFI_KTK case ATH6KL_TM_CMD_WIFI_KTK: { struct wifi_ktk_params *ktk_params; struct ath6kl_vif *vif; vif = ath6kl_vif_first(ar); if (!vif) return -EINVAL; if (!tb[ATH6KL_TM_ATTR_DATA]) { printk(KERN_ERR "%s: NO DATA\n", __func__); return -EINVAL; } buf = nla_data(tb[ATH6KL_TM_ATTR_DATA]); buf_len = nla_len(tb[ATH6KL_TM_ATTR_DATA]); ktk_params = (struct wifi_ktk_params *)buf; if (ktk_params->cmd == NL80211_WIFI_KTK_IE) { u8 ie_hdr[6] = {0xDD, 0x00, 0x00, 0x03, 0x7f, 0x00}; u8 *ie = NULL; u16 ie_length = ktk_params->params.ie_params.length; ie = kmalloc(ie_length+6, GFP_KERNEL); if (ie == NULL) return -ENOMEM; memcpy(ie, ie_hdr, 6); ie[1] = ie_length+4; memcpy(ie+6, ktk_params->params.ie_params.ie, ie_length); if (ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, WMI_FRAME_PROBE_RESP, ie, ie_length+6)) { kfree(ie); printk(KERN_ERR "%s: wifi ktk set probe response ie fail\n", __func__); return -EINVAL; } if (ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, WMI_FRAME_BEACON, ie, ie_length+6)) { kfree(ie); printk(KERN_ERR "%s: wifi ktk set beacon ie fail\n", __func__); return -EINVAL; } kfree(ie); } else if (ktk_params->cmd == NL80211_WIFI_KTK_IE_FILTER) { if (ath6kl_wmi_disc_ie_cmd(ar->wmi, vif->fw_vif_idx, ktk_params->params.ie_filter_params.enable, ktk_params->params.ie_filter_params.startPos, ktk_params->params.ie_filter_params.filter, ktk_params->params.ie_filter_params.length)) { printk(KERN_ERR "%s: wifi ktk set ie filter fail\n", __func__); return -EINVAL; } } else if (ktk_params->cmd == NL80211_WIFI_KTK_START) { ar->ktk_active = true; /* Clear the legacy ie pattern and filter */ if (ath6kl_wmi_disc_ie_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, NULL, 0)) { printk(KERN_ERR "%s: wifi ktk clear ie filter fail\n", __func__); return -EINVAL; } memcpy(ar->ktk_passphrase, ktk_params->params.start_params.passphrase, 16); if (ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1, SPECIFIC_SSID_FLAG, ktk_params->params.start_params.ssid_len, ktk_params->params.start_params.ssid)) { printk(KERN_ERR "%s: wifi ktk set probedssid fail\n", __func__); return -EINVAL; } if (ath6kl_wmi_ibss_pm_caps_cmd(ar->wmi, vif->fw_vif_idx, ADHOC_PS_KTK, 5, 10, 10)) { printk(KERN_ERR "%s: wifi ktk set power save mode on fail\n", __func__); return -EINVAL; } } else if (ktk_params->cmd == NL80211_WIFI_KTK_STOP) { ar->ktk_active = false; if (ath6kl_wmi_ibss_pm_caps_cmd(ar->wmi, vif->fw_vif_idx, ADHOC_PS_DISABLE, 0, 0, 0)) { printk(KERN_ERR "%s: wifi ktk set power save mode off fail\n", __func__); return -EINVAL; } } } return 0; break; #endif default: return -EOPNOTSUPP; } }