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;
default:
return -EOPNOTSUPP;
}
}
static int ath6kl_tm_rx_report(struct ath6kl *ar, void *buf, size_t buf_len,
struct sk_buff *skb)
{
int ret = 0;
long left;
if (!test_bit(WMI_READY, &ar->flag)) {
ret = -EIO;
goto out;
}
if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
ret = -EBUSY;
goto out;
}
if (down_interruptible(&ar->sem))
return -EIO;
if (ath6kl_wmi_test_cmd(ar->wmi, buf, buf_len) < 0) {
up(&ar->sem);
return -EIO;
}
left = wait_event_interruptible_timeout(ar->event_wq,
ar->tm.rx_report != NULL,
WMI_TIMEOUT);
if (left == 0) {
ret = -ETIMEDOUT;
goto out;
} else if (left < 0) {
ret = left;
goto out;
}
if (ar->tm.rx_report == NULL || ar->tm.rx_report_len == 0) {
ret = -EINVAL;
goto out;
}
NLA_PUT(skb, ATH6KL_TM_ATTR_DATA, ar->tm.rx_report_len,
ar->tm.rx_report);
kfree(ar->tm.rx_report);
ar->tm.rx_report = NULL;
out:
up(&ar->sem);
return ret;
#ifdef _NLA_PUT_ERR_RTN
nla_put_failure:
ret = -ENOBUFS;
goto out;
#endif
}
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, reply_len;
struct sk_buff *skb;
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;
case ATH6KL_TM_CMD_RX_REPORT:
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]);
reply_len = nla_total_size(ATH6KL_TM_DATA_MAX_LEN);
skb = cfg80211_testmode_alloc_reply_skb(wiphy, reply_len);
if (!skb)
return -ENOMEM;
err = ath6kl_tm_rx_report(ar, buf, buf_len, skb);
if (err < 0) {
kfree_skb(skb);
return err;
}
return cfg80211_testmode_reply(skb);
default:
return -EOPNOTSUPP;
}
}
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;
}
}