rtl8723cs/core/rtw_tdls.c

3163 lines
96 KiB
C
Raw Normal View History

2017-01-30 21:28:09 +01:00
/******************************************************************************
*
* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of version 2 of the GNU General Public License as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
* more details.
*
* You should have received a copy of the GNU General Public License along with
* this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
*
*
******************************************************************************/
#define _RTW_TDLS_C_
#include <drv_types.h>
#ifdef CONFIG_TDLS
#define ONE_SEC 1000 /* 1000 ms */
extern unsigned char MCS_rate_2R[16];
extern unsigned char MCS_rate_1R[16];
extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame);
void rtw_reset_tdls_info(_adapter* padapter)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
ptdlsinfo->ap_prohibited = _FALSE;
/* For TDLS channel switch, currently we only allow it to work in wifi logo test mode */
if (padapter->registrypriv.wifi_spec == 1)
{
ptdlsinfo->ch_switch_prohibited = _FALSE;
}
else
{
ptdlsinfo->ch_switch_prohibited = _TRUE;
}
ptdlsinfo->link_established = _FALSE;
ptdlsinfo->sta_cnt = 0;
ptdlsinfo->sta_maximum = _FALSE;
#ifdef CONFIG_TDLS_CH_SW
ptdlsinfo->chsw_info.ch_sw_state = TDLS_STATE_NONE;
ATOMIC_SET(&ptdlsinfo->chsw_info.chsw_on, _FALSE);
ptdlsinfo->chsw_info.off_ch_num = 0;
ptdlsinfo->chsw_info.ch_offset = 0;
ptdlsinfo->chsw_info.cur_time = 0;
ptdlsinfo->chsw_info.delay_switch_back = _FALSE;
ptdlsinfo->chsw_info.dump_stack = _FALSE;
#endif
ptdlsinfo->ch_sensing = 0;
ptdlsinfo->watchdog_count = 0;
ptdlsinfo->dev_discovered = _FALSE;
#ifdef CONFIG_WFD
ptdlsinfo->wfd_info = &padapter->wfd_info;
#endif
}
int rtw_init_tdls_info(_adapter* padapter)
{
int res = _SUCCESS;
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
rtw_reset_tdls_info(padapter);
ptdlsinfo->tdls_enable = _TRUE;
#ifdef CONFIG_TDLS_DRIVER_SETUP
ptdlsinfo->driver_setup = _TRUE;
#else
ptdlsinfo->driver_setup = _FALSE;
#endif /* CONFIG_TDLS_DRIVER_SETUP */
_rtw_spinlock_init(&ptdlsinfo->cmd_lock);
_rtw_spinlock_init(&ptdlsinfo->hdl_lock);
return res;
}
void rtw_free_tdls_info(struct tdls_info *ptdlsinfo)
{
_rtw_spinlock_free(&ptdlsinfo->cmd_lock);
_rtw_spinlock_free(&ptdlsinfo->hdl_lock);
_rtw_memset(ptdlsinfo, 0, sizeof(struct tdls_info) );
}
int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len)
{
u8 tdls_prohibited_bit = 0x40; /* bit(38); TDLS_prohibited */
if (pkt_len < 5) {
return _FALSE;
}
pframe += 4;
if ((*pframe) & tdls_prohibited_bit)
return _TRUE;
return _FALSE;
}
int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len)
{
u8 tdls_ch_swithcing_prohibited_bit = 0x80; /* bit(39); TDLS_channel_switching prohibited */
if (pkt_len < 5) {
return _FALSE;
}
pframe += 4;
if ((*pframe) & tdls_ch_swithcing_prohibited_bit)
return _TRUE;
return _FALSE;
}
int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack)
{
int ret = _FAIL;
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
unsigned char *pframe;
struct rtw_ieee80211_hdr *pwlanhdr;
unsigned short *fctrl, *qc;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
update_mgntframe_attrib(padapter, pattrib);
pattrib->hdrlen +=2;
pattrib->qos_en = _TRUE;
pattrib->eosp = 1;
pattrib->ack_policy = 0;
pattrib->mdata = 0;
pattrib->retry_ctrl = _FALSE;
_rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET);
pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
fctrl = &(pwlanhdr->frame_ctl);
*(fctrl) = 0;
if (power_mode)
SetPwrMgt(fctrl);
qc = (unsigned short *)(pframe + pattrib->hdrlen - 2);
SetPriority(qc, 7); /* Set priority to VO */
SetEOSP(qc, pattrib->eosp);
SetAckpolicy(qc, pattrib->ack_policy);
_rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN);
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq);
pmlmeext->mgnt_seq++;
SetFrameSubType(pframe, WIFI_QOS_DATA_NULL);
pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos);
pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos);
pattrib->last_txcmdsz = pattrib->pktlen;
if (wait_ack)
ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe);
else {
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
}
exit:
return ret;
}
/*
*wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT
*wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX
*try_cnt means the maximal TX count to try
*/
int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms)
{
int ret;
int i = 0;
u32 start = rtw_get_current_time();
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
#if 0
psta = rtw_get_stainfo(&padapter->stapriv, da);
if (psta) {
if (power_mode)
rtw_hal_macid_sleep(padapter, psta->mac_id);
else
rtw_hal_macid_wakeup(padapter, psta->mac_id);
} else {
DBG_871X(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n",
FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode?"sleep":"wakeup");
rtw_warn_on(1);
}
#endif
do {
ret = _issue_nulldata_to_TDLS_peer_STA(padapter, da, power_mode, wait_ms>0 ? _TRUE : _FALSE);
i++;
if (RTW_CANNOT_RUN(padapter))
break;
if (i < try_cnt && wait_ms > 0 && ret == _FAIL)
rtw_msleep_os(wait_ms);
} while ((i < try_cnt) && (ret==_FAIL || wait_ms==0));
if (ret != _FAIL) {
ret = _SUCCESS;
#ifndef DBG_XMIT_ACK
goto exit;
#endif
}
if (try_cnt && wait_ms) {
if (da)
DBG_871X(FUNC_ADPT_FMT" to "MAC_FMT", ch:%u%s, %d/%d in %u ms\n",
FUNC_ADPT_ARG(padapter), MAC_ARG(da), rtw_get_oper_ch(padapter),
ret==_SUCCESS?", acked":"", i, try_cnt, rtw_get_passing_time_ms(start));
else
DBG_871X(FUNC_ADPT_FMT", ch:%u%s, %d/%d in %u ms\n",
FUNC_ADPT_ARG(padapter), rtw_get_oper_ch(padapter),
ret==_SUCCESS?", acked":"", i, try_cnt, rtw_get_passing_time_ms(start));
}
exit:
return ret;
}
void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct sta_priv *pstapriv = &padapter->stapriv;
_irqL irqL;
/* free peer sta_info */
_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
if (ptdlsinfo->sta_cnt != 0)
ptdlsinfo->sta_cnt--;
_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
/* -2: AP + BC/MC sta, -4: default key */
if (ptdlsinfo->sta_cnt < MAX_ALLOWED_TDLS_STA_NUM) {
ptdlsinfo->sta_maximum = _FALSE;
_rtw_memset( &ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record) );
}
/* clear cam */
rtw_clearstakey_cmd(padapter, ptdls_sta, _TRUE);
if (ptdlsinfo->sta_cnt == 0) {
rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR);
ptdlsinfo->link_established = _FALSE;
}
else
DBG_871X("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt);
rtw_free_stainfo(padapter, ptdls_sta);
}
/* TDLS encryption(if needed) will always be CCMP */
void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta)
{
ptdls_sta->dot118021XPrivacy=_AES_;
rtw_setstakey_cmd(padapter, ptdls_sta, TDLS_KEY, _TRUE);
}
#ifdef CONFIG_80211N_HT
void rtw_tdls_process_ht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length)
{
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct ht_priv *phtpriv = &pmlmepriv->htpriv;
u8 max_AMPDU_len, min_MPDU_spacing;
u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0;
/* Save HT capabilities in the sta object */
_rtw_memset(&ptdls_sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap));
if (data && Length >= sizeof(struct rtw_ieee80211_ht_cap)) {
ptdls_sta->flags |= WLAN_STA_HT;
ptdls_sta->flags |= WLAN_STA_WME;
_rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap));
} else
ptdls_sta->flags &= ~WLAN_STA_HT;
if (ptdls_sta->flags & WLAN_STA_HT) {
if (padapter->registrypriv.ht_enable == _TRUE) {
ptdls_sta->htpriv.ht_option = _TRUE;
ptdls_sta->qos_option = _TRUE;
} else {
ptdls_sta->htpriv.ht_option = _FALSE;
ptdls_sta->qos_option = _FALSE;
}
}
/* HT related cap */
if (ptdls_sta->htpriv.ht_option) {
/* Check if sta supports rx ampdu */
if (padapter->registrypriv.ampdu_enable == 1)
ptdls_sta->htpriv.ampdu_enable = _TRUE;
/* AMPDU Parameters field */
/* Get MIN of MAX AMPDU Length Exp */
if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (data[2] & 0x3))
max_AMPDU_len = (data[2] & 0x3);
else
max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3);
/* Get MAX of MIN MPDU Start Spacing */
if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (data[2] & 0x1c))
min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c);
else
min_MPDU_spacing = (data[2] & 0x1c);
ptdls_sta->htpriv.rx_ampdu_min_spacing = max_AMPDU_len | min_MPDU_spacing;
/* Check if sta support s Short GI 20M */
if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20))
ptdls_sta->htpriv.sgi_20m = _TRUE;
/* Check if sta support s Short GI 40M */
if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_40))
ptdls_sta->htpriv.sgi_40m = _TRUE;
/* Bwmode would still followed AP's setting */
if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) {
if (padapter->mlmeextpriv.cur_bwmode >= CHANNEL_WIDTH_40)
ptdls_sta->bw_mode = CHANNEL_WIDTH_40;
ptdls_sta->htpriv.ch_offset = padapter->mlmeextpriv.cur_ch_offset;
}
/* Config LDPC Coding Capability */
if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP(data)) {
SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX));
DBG_871X("Enable HT Tx LDPC!\n");
}
ptdls_sta->htpriv.ldpc_cap = cur_ldpc_cap;
/* Config STBC setting */
if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(data)) {
SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX));
DBG_871X("Enable HT Tx STBC!\n");
}
ptdls_sta->htpriv.stbc_cap = cur_stbc_cap;
#ifdef CONFIG_BEAMFORMING
/* Config Tx beamforming setting */
if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) &&
GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(data)) {
SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE);
}
if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) &&
GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(data)) {
SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE);
}
ptdls_sta->htpriv.beamform_cap = cur_beamform_cap;
if (cur_beamform_cap)
DBG_871X("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap);
#endif /* CONFIG_BEAMFORMING */
}
}
u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
rtw_ht_use_default_setting(padapter);
rtw_restructure_ht_ie(padapter, NULL, pframe, 0, &(pattrib->pktlen), padapter->mlmeextpriv.cur_channel);
return pframe + pattrib->pktlen;
}
#endif
#ifdef CONFIG_80211AC_VHT
void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length)
{
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv;
u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rf_type = RF_1T1R;
u8 *pcap_mcs;
u8 vht_mcs[2];
_rtw_memset(&ptdls_sta->vhtpriv, 0, sizeof(struct vht_priv));
if (data && Length == 12) {
ptdls_sta->flags |= WLAN_STA_VHT;
_rtw_memcpy(ptdls_sta->vhtpriv.vht_cap, data, 12);
#if 0
if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) {
_rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1);
} else /* for Frame without Operating Mode notify ie; default: 80M */ {
pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80;
}
#else
ptdls_sta->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80;
#endif
} else
ptdls_sta->flags &= ~WLAN_STA_VHT;
if (ptdls_sta->flags & WLAN_STA_VHT) {
if (REGSTY_IS_11AC_ENABLE(&padapter->registrypriv)
&& hal_chk_proto_cap(padapter, PROTO_CAP_11AC)
&& (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)))
ptdls_sta->vhtpriv.vht_option = _TRUE;
else
ptdls_sta->vhtpriv.vht_option = _FALSE;
}
/* B4 Rx LDPC */
if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX) &&
GET_VHT_CAPABILITY_ELE_RX_LDPC(data)) {
SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX));
DBG_871X("Current VHT LDPC Setting = %02X\n", cur_ldpc_cap);
}
ptdls_sta->vhtpriv.ldpc_cap = cur_ldpc_cap;
/* B5 Short GI for 80 MHz */
ptdls_sta->vhtpriv.sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(data) & pvhtpriv->sgi_80m) ? _TRUE : _FALSE;
/* B8 B9 B10 Rx STBC */
if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX) &&
GET_VHT_CAPABILITY_ELE_RX_STBC(data)) {
SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX));
DBG_871X("Current VHT STBC Setting = %02X\n", cur_stbc_cap);
}
ptdls_sta->vhtpriv.stbc_cap = cur_stbc_cap;
/* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */
if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) &&
GET_VHT_CAPABILITY_ELE_SU_BFEE(data)) {
SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE);
}
/* B12 SU Beamformee Capable, the target supports Beamformee and we are Beamformer */
if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) &&
GET_VHT_CAPABILITY_ELE_SU_BFER(data)) {
SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE);
}
ptdls_sta->vhtpriv.beamform_cap = cur_beamform_cap;
if (cur_beamform_cap)
DBG_871X("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap);
/* B23 B24 B25 Maximum A-MPDU Length Exponent */
ptdls_sta->vhtpriv.ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(data);
pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(data);
_rtw_memcpy(vht_mcs, pcap_mcs, 2);
rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R))
vht_mcs[0] |= 0xfc;
else if (rf_type == RF_2T2R)
vht_mcs[0] |= 0xf0;
else if (rf_type == RF_3T3R)
vht_mcs[0] |= 0xc0;
_rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs, 2);
ptdls_sta->vhtpriv.vht_highest_rate = rtw_get_vht_highest_rate(ptdls_sta->vhtpriv.vht_mcs_map);
}
u8 *rtw_tdls_set_aid(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
return rtw_set_ie(pframe, EID_AID, 2, (u8 *)&(padapter->mlmepriv.cur_network.aid), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_vht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
u32 ie_len = 0;
rtw_vht_use_default_setting(padapter);
ie_len = rtw_build_vht_cap_ie(padapter, pframe);
pattrib->pktlen += ie_len;
return pframe + ie_len;
}
u8 *rtw_tdls_set_vht_operation(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 channel)
{
u32 ie_len = 0;
ie_len = rtw_build_vht_operation_ie(padapter, pframe, channel);
pattrib->pktlen += ie_len;
return pframe + ie_len;
}
u8 *rtw_tdls_set_vht_op_mode_notify(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 bw)
{
u32 ie_len = 0;
ie_len = rtw_build_vht_op_mode_notify_ie(padapter, pframe, bw);
pattrib->pktlen += ie_len;
return pframe + ie_len;
}
#endif
u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib)
{
u8 sup_ch[30 * 2] = {0x00}, ch_set_idx = 0, sup_ch_idx = 2;
do {
if (pmlmeext->channel_set[ch_set_idx].ChannelNum <= 14) {
sup_ch[0] = 1; /* First channel number */
sup_ch[1] = pmlmeext->channel_set[ch_set_idx].ChannelNum; /* Number of channel */
} else {
sup_ch[sup_ch_idx++] = pmlmeext->channel_set[ch_set_idx].ChannelNum;
sup_ch[sup_ch_idx++] = 1;
}
ch_set_idx++;
} while (pmlmeext->channel_set[ch_set_idx].ChannelNum != 0 && ch_set_idx < MAX_CHANNEL_NUM);
return rtw_set_ie(pframe, _SUPPORTED_CH_IE_, sup_ch_idx, sup_ch, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_rsnie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta)
{
u8 *p = NULL;
int len = 0;
if (ptxmgmt->len > 0)
p = rtw_get_ie(ptxmgmt->buf, _RSN_IE_2_, &len, ptxmgmt->len);
if (p != NULL)
return rtw_set_ie(pframe, _RSN_IE_2_, len, p+2, &(pattrib->pktlen));
else
if (init == _TRUE)
return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(TDLS_RSNIE), TDLS_RSNIE, &(pattrib->pktlen));
else
return rtw_set_ie(pframe, _RSN_IE_2_, sizeof(ptdls_sta->TDLS_RSNIE), ptdls_sta->TDLS_RSNIE, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_ext_cap(u8 *pframe, struct pkt_attrib *pattrib)
{
return rtw_set_ie(pframe, _EXT_CAP_IE_ , sizeof(TDLS_EXT_CAPIE), TDLS_EXT_CAPIE, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_qos_cap(u8 *pframe, struct pkt_attrib *pattrib)
{
return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, sizeof(TDLS_WMMIE), TDLS_WMMIE, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_ftie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, u8 *ANonce, u8 *SNonce)
{
struct wpa_tdls_ftie FTIE = {0};
u8 *p = NULL;
int len = 0;
if (ptxmgmt->len > 0)
p = rtw_get_ie(ptxmgmt->buf, _FTIE_, &len, ptxmgmt->len);
if (p != NULL)
return rtw_set_ie(pframe, _FTIE_, len, p+2, &(pattrib->pktlen));
else {
if (ANonce != NULL)
_rtw_memcpy(FTIE.Anonce, ANonce, WPA_NONCE_LEN);
if (SNonce != NULL)
_rtw_memcpy(FTIE.Snonce, SNonce, WPA_NONCE_LEN);
return rtw_set_ie(pframe, _FTIE_ , 82, (u8 *)FTIE.mic_ctrl, &(pattrib->pktlen));
}
}
u8 *rtw_tdls_set_timeout_interval(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib *pattrib, int init, struct sta_info *ptdls_sta)
{
u8 timeout_itvl[5]; /* set timeout interval to maximum value */
u32 timeout_interval= TPK_RESEND_COUNT;
u8 *p = NULL;
int len = 0;
if (ptxmgmt->len > 0)
p = rtw_get_ie(ptxmgmt->buf, _TIMEOUT_ITVL_IE_, &len, ptxmgmt->len);
if (p != NULL)
return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, len, p+2, &(pattrib->pktlen));
else {
/* Timeout interval */
timeout_itvl[0]=0x02;
if (init == _TRUE)
_rtw_memcpy(timeout_itvl+1, &timeout_interval, 4);
else
_rtw_memcpy(timeout_itvl+1, (u8 *)(&ptdls_sta->TDLS_PeerKey_Lifetime), 4);
return rtw_set_ie(pframe, _TIMEOUT_ITVL_IE_, 5, timeout_itvl, &(pattrib->pktlen));
}
}
u8 *rtw_tdls_set_bss_coexist(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
u8 iedata=0;
if (padapter->mlmepriv.num_FortyMHzIntolerant > 0)
iedata |= BIT(2); /* 20 MHz BSS Width Request */
/* Information Bit should be set by TDLS test plan 5.9 */
iedata |= BIT(0);
return rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_payload_type(u8 *pframe, struct pkt_attrib *pattrib)
{
u8 payload_type = 0x02;
return rtw_set_fixed_ie(pframe, 1, &(payload_type), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_category(u8 *pframe, struct pkt_attrib *pattrib, u8 category)
{
return rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_action(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt)
{
return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->action_code), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_status_code(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt)
{
return rtw_set_fixed_ie(pframe, 2, (u8 *)&(ptxmgmt->status_code), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_dialog(u8 *pframe, struct pkt_attrib *pattrib, struct tdls_txmgmt *ptxmgmt)
{
u8 dialogtoken = 1;
if (ptxmgmt->dialog_token)
return rtw_set_fixed_ie(pframe, 1, &(ptxmgmt->dialog_token), &(pattrib->pktlen));
else
return rtw_set_fixed_ie(pframe, 1, &(dialogtoken), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_reg_class(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta)
{
u8 reg_class = 1;
return rtw_set_fixed_ie(pframe, 1, &(reg_class), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_capability(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
u8 cap_from_ie[2] = {0};
_rtw_memcpy(cap_from_ie, rtw_get_capability_from_ie(pmlmeinfo->network.IEs), 2);
return rtw_set_fixed_ie(pframe, 2, cap_from_ie, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_supported_rate(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
u8 bssrate[NDIS_802_11_LENGTH_RATES_EX];
int bssrate_len = 0;
u8 more_supportedrates = 0;
rtw_set_supported_rate(bssrate, (padapter->registrypriv.wireless_mode == WIRELESS_MODE_MAX) ? padapter->mlmeextpriv.cur_wireless_mode : padapter->registrypriv.wireless_mode);
bssrate_len = rtw_get_rateset_len(bssrate);
if (bssrate_len > 8) {
pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , 8, bssrate, &(pattrib->pktlen));
more_supportedrates = 1;
} else {
pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_ , bssrate_len , bssrate, &(pattrib->pktlen));
}
/* extended supported rates */
if (more_supportedrates == 1) {
pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_ , (bssrate_len - 8), (bssrate + 8), &(pattrib->pktlen));
}
return pframe;
}
u8 *rtw_tdls_set_sup_reg_class(u8 *pframe, struct pkt_attrib *pattrib)
{
return rtw_set_ie(pframe, _SRC_IE_ , sizeof(TDLS_SRC), TDLS_SRC, &(pattrib->pktlen));
}
u8 *rtw_tdls_set_linkid(u8 *pframe, struct pkt_attrib *pattrib, u8 init)
{
u8 link_id_addr[18] = {0};
if (init == _TRUE) {
_rtw_memcpy(link_id_addr, pattrib->ra, 6);
_rtw_memcpy((link_id_addr+6), pattrib->src, 6);
_rtw_memcpy((link_id_addr+12), pattrib->dst, 6);
} else {
_rtw_memcpy(link_id_addr, pattrib->ra, 6);
_rtw_memcpy((link_id_addr+6), pattrib->dst, 6);
_rtw_memcpy((link_id_addr+12), pattrib->src, 6);
}
return rtw_set_ie(pframe, _LINK_ID_IE_, 18, link_id_addr, &(pattrib->pktlen));
}
#ifdef CONFIG_TDLS_CH_SW
u8 *rtw_tdls_set_target_ch(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
u8 target_ch = 1;
if (padapter->tdlsinfo.chsw_info.off_ch_num)
return rtw_set_fixed_ie(pframe, 1, &(padapter->tdlsinfo.chsw_info.off_ch_num), &(pattrib->pktlen));
else
return rtw_set_fixed_ie(pframe, 1, &(target_ch), &(pattrib->pktlen));
}
u8 *rtw_tdls_set_ch_sw(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info *ptdls_sta)
{
u8 ch_switch_timing[4] = {0};
u16 switch_time = (ptdls_sta->ch_switch_time >= CH_SWITCH_TIME * 1000) ?
ptdls_sta->ch_switch_time : CH_SWITCH_TIME;
u16 switch_timeout = (ptdls_sta->ch_switch_timeout >= CH_SWITCH_TIMEOUT * 1000) ?
ptdls_sta->ch_switch_timeout : CH_SWITCH_TIMEOUT;
_rtw_memcpy(ch_switch_timing, &switch_time, 2);
_rtw_memcpy(ch_switch_timing + 2, &switch_timeout, 2);
return rtw_set_ie(pframe, _CH_SWITCH_TIMING_, 4, ch_switch_timing, &(pattrib->pktlen));
}
#endif
u8 *rtw_tdls_set_wmm_params(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib)
{
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
u8 wmm_param_ele[24] = {0};
if (&pmlmeinfo->WMM_param) {
_rtw_memcpy(wmm_param_ele, WMM_PARA_OUI, 6);
if (_rtw_memcmp(&pmlmeinfo->WMM_param, &wmm_param_ele[6], 18) == _TRUE)
/* Use default WMM Param */
_rtw_memcpy(wmm_param_ele + 6, (u8 *)&TDLS_WMM_PARAM_IE, sizeof(TDLS_WMM_PARAM_IE));
else
_rtw_memcpy(wmm_param_ele + 6, (u8 *)&pmlmeinfo->WMM_param, sizeof(pmlmeinfo->WMM_param));
return rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, 24, wmm_param_ele, &(pattrib->pktlen));
}
else
return pframe;
}
#ifdef CONFIG_WFD
void rtw_tdls_process_wfd_ie(struct tdls_info *ptdlsinfo, u8 *ptr, u8 length)
{
u8 *wfd_ie;
u32 wfd_ielen = 0;
if (!hal_chk_wl_func(tdls_info_to_adapter(ptdlsinfo), WL_FUNC_MIRACAST))
return;
/* Try to get the TCP port information when receiving the negotiation response. */
wfd_ie = rtw_get_wfd_ie(ptr, length, NULL, &wfd_ielen);
while (wfd_ie) {
u8 *attr_content;
u32 attr_contentlen = 0;
int i;
DBG_871X( "[%s] WFD IE Found!!\n", __FUNCTION__ );
attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &attr_contentlen);
if (attr_content && attr_contentlen) {
ptdlsinfo->wfd_info->peer_rtsp_ctrlport = RTW_GET_BE16( attr_content + 2 );
DBG_871X( "[%s] Peer PORT NUM = %d\n", __FUNCTION__, ptdlsinfo->wfd_info->peer_rtsp_ctrlport );
}
attr_content = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_LOCAL_IP_ADDR, NULL, &attr_contentlen);
if (attr_content && attr_contentlen) {
_rtw_memcpy(ptdlsinfo->wfd_info->peer_ip_address, ( attr_content + 1 ), 4);
DBG_871X("[%s] Peer IP = %02u.%02u.%02u.%02u\n", __FUNCTION__,
ptdlsinfo->wfd_info->peer_ip_address[0], ptdlsinfo->wfd_info->peer_ip_address[1],
ptdlsinfo->wfd_info->peer_ip_address[2], ptdlsinfo->wfd_info->peer_ip_address[3]);
}
wfd_ie = rtw_get_wfd_ie(wfd_ie + wfd_ielen, (ptr + length) - (wfd_ie + wfd_ielen), NULL, &wfd_ielen);
}
}
int issue_tunneled_probe_req(_adapter *padapter)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
u8 baddr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
struct tdls_txmgmt txmgmt;
int ret = _FAIL;
DBG_871X("[%s]\n", __FUNCTION__);
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
txmgmt.action_code = TUNNELED_PROBE_REQ;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, baddr, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
int issue_tunneled_probe_rsp(_adapter *padapter, union recv_frame *precv_frame)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct tdls_txmgmt txmgmt;
int ret = _FAIL;
DBG_871X("[%s]\n", __FUNCTION__);
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
txmgmt.action_code = TUNNELED_PROBE_RSP;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, precv_frame->u.hdr.attrib.src, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
#endif /* CONFIG_WFD */
int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *ptdls_sta= NULL;
_irqL irqL;
int ret = _FAIL;
/* Retry timer should be set at least 301 sec, using TPK_count counting 301 times. */
u32 timeout_interval= TPK_RESEND_COUNT;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
ptxmgmt->action_code = TDLS_SETUP_REQUEST;
if (ptdlsinfo->ap_prohibited == _TRUE)
goto exit;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
/* init peer sta_info */
ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer);
if (ptdls_sta == NULL) {
ptdls_sta = rtw_alloc_stainfo(pstapriv, ptxmgmt->peer);
if (ptdls_sta == NULL) {
DBG_871X("[%s] rtw_alloc_stainfo fail\n", __FUNCTION__);
rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
}
if(!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE))
ptdlsinfo->sta_cnt++;
if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM)
ptdlsinfo->sta_maximum = _TRUE;
ptdls_sta->tdls_sta_state |= TDLS_RESPONDER_STATE;
if (rtw_tdls_is_driver_setup(padapter) == _TRUE) {
ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval;
_set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME);
}
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) !=_SUCCESS) {
rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
if (wait_ack) {
ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe);
} else {
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
}
exit:
return ret;
}
int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *ptdls_sta=NULL;
_irqL irqL;
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
ptxmgmt->action_code = TDLS_TEARDOWN;
ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer);
if (ptdls_sta == NULL) {
DBG_871X("Np tdls_sta for tearing down\n");
goto exit;
}
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
rtw_set_scan_deny(padapter, 550);
rtw_scan_abort(padapter);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_buddy_adapter_up(padapter))
rtw_scan_abort(padapter->pbuddy_adapter);
#endif /* CONFIG_CONCURRENT_MODE */
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
if (rtw_tdls_is_driver_setup(padapter) == _TRUE)
if(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)
if (pattrib->encrypt)
_cancel_timer_ex(&ptdls_sta->TPK_timer);
if (wait_ack) {
ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe);
} else {
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
}
if (ret == _SUCCESS && rtw_tdls_is_driver_setup(padapter))
rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEAR_STA);
exit:
return ret;
}
int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack)
{
int ret = _FAIL;
ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack);
if ((ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) && (ret == _FAIL)) {
/* Change status code and send teardown again via AP */
ptxmgmt->status_code = _RSON_TDLS_TEAR_TOOFAR_;
ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack);
}
return ret;
}
int issue_tdls_dis_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
ptxmgmt->action_code = TDLS_DISCOVERY_REQUEST;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
DBG_871X("issue tdls dis req\n");
ret = _SUCCESS;
exit:
return ret;
}
int issue_tdls_setup_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
ptxmgmt->action_code = TDLS_SETUP_RESPONSE;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(&(padapter->mlmepriv)), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
int issue_tdls_setup_cfm(_adapter *padapter, struct tdls_txmgmt *ptxmgmt)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
ptxmgmt->action_code = TDLS_SETUP_CONFIRM;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(&padapter->mlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
/* TDLS Discovery Response frame is a management action frame */
int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 privacy)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
unsigned char *pframe;
struct rtw_ieee80211_hdr *pwlanhdr;
unsigned short *fctrl;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
update_mgntframe_attrib(padapter, pattrib);
_rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET);
pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
fctrl = &(pwlanhdr->frame_ctl);
*(fctrl) = 0;
/* unicast probe request frame */
_rtw_memcpy(pwlanhdr->addr1, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->dst, pwlanhdr->addr1, ETH_ALEN);
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->src, pwlanhdr->addr2, ETH_ALEN);
_rtw_memcpy(pwlanhdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ra, pwlanhdr->addr3, ETH_ALEN);
SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq);
pmlmeext->mgnt_seq++;
SetFrameSubType(pframe, WIFI_ACTION);
pframe += sizeof (struct rtw_ieee80211_hdr_3addr);
pattrib->pktlen = sizeof (struct rtw_ieee80211_hdr_3addr);
rtw_build_tdls_dis_rsp_ies(padapter, pmgntframe, pframe, ptxmgmt, privacy);
pattrib->nr_frags = 1;
pattrib->last_txcmdsz = pattrib->pktlen;
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *ptdls_sta, struct tdls_txmgmt *ptxmgmt)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
ptxmgmt->action_code = TDLS_PEER_TRAFFIC_RESPONSE;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) !=_SUCCESS) {
rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdls_sta)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct tdls_txmgmt txmgmt;
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
txmgmt.action_code = TDLS_PEER_TRAFFIC_INDICATION;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
/* PTI frame's priority should be AC_VO */
pattrib->priority = 7;
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) != _SUCCESS) {
rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
struct tdls_txmgmt txmgmt;
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE)
{ DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__);
goto exit;
}
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
txmgmt.action_code = TDLS_CHANNEL_SWITCH_REQUEST;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, &txmgmt) !=_SUCCESS) {
rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
exit:
return ret;
}
int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack)
{
struct xmit_frame *pmgntframe;
struct pkt_attrib *pattrib;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
int ret = _FAIL;
DBG_871X("[TDLS] %s\n", __FUNCTION__);
if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE)
{ DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__);
goto exit;
}
ptxmgmt->action_code = TDLS_CHANNEL_SWITCH_RESPONSE;
if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL)
goto exit;
pattrib = &pmgntframe->attrib;
pmgntframe->frame_tag = DATA_FRAMETAG;
pattrib->ether_type = 0x890d;
_rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN);
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
update_tdls_attrib(padapter, pattrib);
pattrib->qsel = pattrib->priority;
/*
_enter_critical_bh(&pxmitpriv->lock, &irqL);
if(xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pmgntframe)==_TRUE){
_exit_critical_bh(&pxmitpriv->lock, &irqL);
return _FALSE;
}
*/
if (rtw_xmit_tdls_coalesce(padapter, pmgntframe, ptxmgmt) !=_SUCCESS) {
rtw_free_xmitbuf(pxmitpriv,pmgntframe->pxmitbuf);
rtw_free_xmitframe(pxmitpriv, pmgntframe);
goto exit;
}
if (wait_ack) {
ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe);
} else {
dump_mgntframe(padapter, pmgntframe);
ret = _SUCCESS;
}
ret = _SUCCESS;
exit:
return ret;
}
int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame)
{
struct sta_info *ptdls_sta = NULL, *psta = rtw_get_stainfo(&(padapter->stapriv), get_bssid(&(padapter->mlmepriv)));
struct recv_priv *precvpriv = &(padapter->recvpriv);
u8 *ptr = precv_frame->u.hdr.rx_data, *psa;
struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib);
struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo);
u8 empty_addr[ETH_ALEN] = { 0x00 };
int UndecoratedSmoothedPWDB;
struct tdls_txmgmt txmgmt;
int ret = _SUCCESS;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
/* WFDTDLS: for sigma test, not to setup direct link automatically */
ptdlsinfo->dev_discovered = _TRUE;
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), psa);
if (ptdls_sta != NULL)
ptdls_sta->sta_stats.rx_tdls_disc_rsp_pkts++;
#ifdef CONFIG_TDLS_AUTOSETUP
if (ptdls_sta != NULL) {
/* Record the tdls sta with lowest signal strength */
if (ptdlsinfo->sta_maximum == _TRUE && ptdls_sta->alive_count >= 1 ) {
if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) {
_rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN);
ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll;
} else {
if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.RxPWDBAll) {
_rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN);
ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll;
}
}
}
} else {
if (ptdlsinfo->sta_maximum == _TRUE) {
if (_rtw_memcmp( ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) {
/* All traffics are busy, do not set up another direct link. */
ret = _FAIL;
goto exit;
} else {
if (pattrib->phy_info.RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll) {
_rtw_memcpy(txmgmt.peer, ptdlsinfo->ss_record.macaddr, ETH_ALEN);
/* issue_tdls_teardown(padapter, ptdlsinfo->ss_record.macaddr, _FALSE); */
} else {
ret = _FAIL;
goto exit;
}
}
}
rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB);
if (pattrib->phy_info.RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB) {
DBG_871X("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->phy_info.RxPWDBAll, UndecoratedSmoothedPWDB);
_rtw_memcpy(txmgmt.peer, psa, ETH_ALEN);
issue_tdls_setup_req(padapter, &txmgmt, _FALSE);
}
}
#endif /* CONFIG_TDLS_AUTOSETUP */
exit:
return ret;
}
sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
u8 *psa, *pmyid;
struct sta_info *ptdls_sta= NULL;
struct sta_priv *pstapriv = &padapter->stapriv;
u8 *ptr = precv_frame->u.hdr.rx_data;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct security_priv *psecuritypriv = &padapter->securitypriv;
_irqL irqL;
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
u8 *prsnie, *ppairwise_cipher;
u8 i, k;
u8 ccmp_included=0, rsnie_included=0;
u16 j, pairwise_count;
u8 SNonce[32];
u32 timeout_interval = TPK_RESEND_COUNT;
sint parsing_length; /* Frame body length, without icv_len */
PNDIS_802_11_VARIABLE_IEs pIE;
u8 FIXED_IE = 5;
unsigned char supportRate[16];
int supportRateNum = 0;
struct tdls_txmgmt txmgmt;
if (ptdlsinfo->ap_prohibited == _TRUE)
goto exit;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(pstapriv, psa);
pmyid = adapter_mac_addr(padapter);
ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len
-prx_pkt_attrib->hdrlen
-prx_pkt_attrib->iv_len
-prx_pkt_attrib->icv_len
-LLC_HEADER_SIZE
-ETH_TYPE_LEN
-PAYLOAD_TYPE_LEN
-FIXED_IE;
if (ptdls_sta == NULL) {
ptdls_sta = rtw_alloc_stainfo(pstapriv, psa);
} else {
if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) {
/* If the direct link is already set up */
/* Process as re-setup after tear down */
DBG_871X("re-setup a direct link\n");
}
/* Already receiving TDLS setup request */
else if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) {
DBG_871X("receive duplicated TDLS setup request frame in handshaking\n");
goto exit;
}
/* When receiving and sending setup_req to the same link at the same time */
/* STA with higher MAC_addr would be initiator */
else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) {
DBG_871X("receive setup_req after sending setup_req\n");
for (i=0;i<6;i++){
if(*(pmyid+i)==*(psa+i)){
}
else if(*(pmyid+i)>*(psa+i)){
ptdls_sta->tdls_sta_state = TDLS_INITIATOR_STATE;
break;
}else if(*(pmyid+i)<*(psa+i)){
goto exit;
}
}
}
}
if (ptdls_sta) {
txmgmt.dialog_token = *(ptr+2); /* Copy dialog token */
txmgmt.status_code = _STATS_SUCCESSFUL_;
/* Parsing information element */
for (j=FIXED_IE; j<parsing_length;) {
pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr+ j);
switch (pIE->ElementID) {
case _SUPPORTEDRATES_IE_:
_rtw_memcpy(supportRate, pIE->data, pIE->Length);
supportRateNum = pIE->Length;
break;
case _COUNTRY_IE_:
break;
case _EXT_SUPPORTEDRATES_IE_:
if (supportRateNum<=sizeof(supportRate)) {
_rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length);
supportRateNum += pIE->Length;
}
break;
case _SUPPORTED_CH_IE_:
break;
case _RSN_IE_2_:
rsnie_included=1;
if (prx_pkt_attrib->encrypt) {
prsnie=(u8*)pIE;
/* Check CCMP pairwise_cipher presence. */
ppairwise_cipher=prsnie+10;
_rtw_memcpy(ptdls_sta->TDLS_RSNIE, pIE->data, pIE->Length);
pairwise_count = *(u16*)(ppairwise_cipher-2);
for (k=0; k<pairwise_count; k++) {
if (_rtw_memcmp( ppairwise_cipher+4*k, RSN_CIPHER_SUITE_CCMP, 4)==_TRUE)
ccmp_included=1;
}
if (ccmp_included == 0)
txmgmt.status_code=_STATS_INVALID_RSNIE_;
}
break;
case _EXT_CAP_IE_:
break;
case _VENDOR_SPECIFIC_IE_:
break;
case _FTIE_:
if (prx_pkt_attrib->encrypt)
_rtw_memcpy(SNonce, (ptr+j+52), 32);
break;
case _TIMEOUT_ITVL_IE_:
if (prx_pkt_attrib->encrypt)
timeout_interval = cpu_to_le32(*(u32*)(ptr+j+3));
break;
case _RIC_Descriptor_IE_:
break;
#ifdef CONFIG_80211N_HT
case _HT_CAPABILITY_IE_:
rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length);
break;
#endif
#ifdef CONFIG_80211AC_VHT
case EID_AID:
break;
case EID_VHTCapability:
rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length);
break;
#endif
case EID_BSSCoexistence:
break;
case _LINK_ID_IE_:
if (_rtw_memcmp(get_bssid(pmlmepriv), pIE->data, 6) == _FALSE)
txmgmt.status_code=_STATS_NOT_IN_SAME_BSS_;
break;
default:
break;
}
j += (pIE->Length + 2);
}
/* Check status code */
/* If responder STA has/hasn't security on AP, but request hasn't/has RSNIE, it should reject */
if (txmgmt.status_code == _STATS_SUCCESSFUL_) {
if (rsnie_included && prx_pkt_attrib->encrypt == 0)
txmgmt.status_code = _STATS_SEC_DISABLED_;
else if (rsnie_included==0 && prx_pkt_attrib->encrypt)
txmgmt.status_code = _STATS_INVALID_PARAMETERS_;
#ifdef CONFIG_WFD
/* WFD test plan version 0.18.2 test item 5.1.5 */
/* SoUT does not use TDLS if AP uses weak security */
if (padapter->wdinfo.wfd_tdls_enable && (rsnie_included && prx_pkt_attrib->encrypt != _AES_))
txmgmt.status_code = _STATS_SEC_DISABLED_;
#endif /* CONFIG_WFD */
}
ptdls_sta->tdls_sta_state|= TDLS_INITIATOR_STATE;
if (prx_pkt_attrib->encrypt) {
_rtw_memcpy(ptdls_sta->SNonce, SNonce, 32);
if (timeout_interval <= 300)
ptdls_sta->TDLS_PeerKey_Lifetime = TPK_RESEND_COUNT;
else
ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval;
}
/* Update station supportRate */
ptdls_sta->bssratelen = supportRateNum;
_rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum);
if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE))
ptdlsinfo->sta_cnt++;
/* -2: AP + BC/MC sta, -4: default key */
if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM)
ptdlsinfo->sta_maximum = _TRUE;
#ifdef CONFIG_WFD
rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length);
#endif
}else {
goto exit;
}
_rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN);
if (rtw_tdls_is_driver_setup(padapter)) {
issue_tdls_setup_rsp(padapter, &txmgmt);
if (txmgmt.status_code==_STATS_SUCCESSFUL_) {
_set_timer( &ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME);
}else {
free_tdls_sta(padapter, ptdls_sta);
}
}
exit:
return _SUCCESS;
}
int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame)
{
struct registry_priv *pregistrypriv = &padapter->registrypriv;
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct sta_info *ptdls_sta= NULL;
struct sta_priv *pstapriv = &padapter->stapriv;
u8 *ptr = precv_frame->u.hdr.rx_data;
_irqL irqL;
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
u8 *psa;
u16 status_code=0;
sint parsing_length; /* Frame body length, without icv_len */
PNDIS_802_11_VARIABLE_IEs pIE;
u8 FIXED_IE =7;
u8 ANonce[32];
u8 *pftie=NULL, *ptimeout_ie=NULL, *plinkid_ie=NULL, *prsnie=NULL, *pftie_mic=NULL, *ppairwise_cipher=NULL;
u16 pairwise_count, j, k;
u8 verify_ccmp=0;
unsigned char supportRate[16];
int supportRateNum = 0;
struct tdls_txmgmt txmgmt;
int ret = _SUCCESS;
u32 timeout_interval = TPK_RESEND_COUNT;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(pstapriv, psa);
if (NULL == ptdls_sta) {
ret = _FAIL;
goto exit;
}
ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len
-prx_pkt_attrib->hdrlen
-prx_pkt_attrib->iv_len
-prx_pkt_attrib->icv_len
-LLC_HEADER_SIZE
-ETH_TYPE_LEN
-PAYLOAD_TYPE_LEN
-FIXED_IE;
_rtw_memcpy(&status_code, ptr+2, 2);
if (status_code != 0) {
DBG_871X( "[TDLS] %s status_code = %d, free_tdls_sta\n", __FUNCTION__, status_code );
free_tdls_sta(padapter, ptdls_sta);
ret = _FAIL;
goto exit;
}
status_code = 0;
/* parsing information element */
for (j = FIXED_IE; j<parsing_length;) {
pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr+ j);
switch (pIE->ElementID) {
case _SUPPORTEDRATES_IE_:
_rtw_memcpy(supportRate, pIE->data, pIE->Length);
supportRateNum = pIE->Length;
break;
case _COUNTRY_IE_:
break;
case _EXT_SUPPORTEDRATES_IE_:
if (supportRateNum<=sizeof(supportRate)) {
_rtw_memcpy(supportRate+supportRateNum, pIE->data, pIE->Length);
supportRateNum += pIE->Length;
}
break;
case _SUPPORTED_CH_IE_:
break;
case _RSN_IE_2_:
prsnie=(u8*)pIE;
/* Check CCMP pairwise_cipher presence. */
ppairwise_cipher=prsnie+10;
_rtw_memcpy(&pairwise_count, (u16*)(ppairwise_cipher-2), 2);
for (k=0;k<pairwise_count;k++) {
if (_rtw_memcmp( ppairwise_cipher+4*k, RSN_CIPHER_SUITE_CCMP, 4) == _TRUE)
verify_ccmp=1;
}
case _EXT_CAP_IE_:
break;
case _VENDOR_SPECIFIC_IE_:
if (_rtw_memcmp((u8 *)pIE + 2, WMM_INFO_OUI, 6) == _TRUE) {
/* WMM Info ID and OUI */
if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE))
ptdls_sta->qos_option = _TRUE;
}
break;
case _FTIE_:
pftie=(u8*)pIE;
_rtw_memcpy(ANonce, (ptr+j+20), 32);
break;
case _TIMEOUT_ITVL_IE_:
ptimeout_ie=(u8*)pIE;
timeout_interval = cpu_to_le32(*(u32*)(ptimeout_ie+3));
break;
case _RIC_Descriptor_IE_:
break;
#ifdef CONFIG_80211N_HT
case _HT_CAPABILITY_IE_:
rtw_tdls_process_ht_cap(padapter, ptdls_sta, pIE->data, pIE->Length);
break;
#endif
#ifdef CONFIG_80211AC_VHT
case EID_AID:
/* todo in the future if necessary */
break;
case EID_VHTCapability:
rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length);
break;
case EID_OpModeNotification:
rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta);
break;
#endif
case EID_BSSCoexistence:
break;
case _LINK_ID_IE_:
plinkid_ie=(u8*)pIE;
break;
default:
break;
}
j += (pIE->Length + 2);
}
ptdls_sta->bssratelen = supportRateNum;
_rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum);
_rtw_memcpy(ptdls_sta->ANonce, ANonce, 32);
#ifdef CONFIG_WFD
rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length);
#endif
if (status_code != _STATS_SUCCESSFUL_) {
txmgmt.status_code = status_code;
} else {
if (prx_pkt_attrib->encrypt) {
if (verify_ccmp == 1) {
txmgmt.status_code = _STATS_SUCCESSFUL_;
if (rtw_tdls_is_driver_setup(padapter) == _TRUE) {
wpa_tdls_generate_tpk(padapter, ptdls_sta);
if (tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL) {
DBG_871X( "[TDLS] %s tdls_verify_mic fail, free_tdls_sta\n", __FUNCTION__);
free_tdls_sta(padapter, ptdls_sta);
ret = _FAIL;
goto exit;
}
ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval;
}
}
else
{
txmgmt.status_code = _STATS_INVALID_RSNIE_;
}
}else{
txmgmt.status_code = _STATS_SUCCESSFUL_;
}
}
if (rtw_tdls_is_driver_setup(padapter) == _TRUE) {
_rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN);
issue_tdls_setup_cfm(padapter, &txmgmt);
if (txmgmt.status_code == _STATS_SUCCESSFUL_) {
ptdlsinfo->link_established = _TRUE;
if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) {
ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE;
ptdls_sta->state |= _FW_LINKED;
_cancel_timer_ex( &ptdls_sta->handshake_timer);
}
if (prx_pkt_attrib->encrypt)
rtw_tdls_set_key(padapter, ptdls_sta);
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED);
}
}
exit:
if (rtw_tdls_is_driver_setup(padapter) == _TRUE)
return ret;
else
return _SUCCESS;
}
int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct sta_info *ptdls_sta= NULL;
struct sta_priv *pstapriv = &padapter->stapriv;
u8 *ptr = precv_frame->u.hdr.rx_data;
_irqL irqL;
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
u8 *psa;
u16 status_code=0;
sint parsing_length;
PNDIS_802_11_VARIABLE_IEs pIE;
u8 FIXED_IE =5;
u8 *pftie=NULL, *ptimeout_ie=NULL, *plinkid_ie=NULL, *prsnie=NULL, *pftie_mic=NULL, *ppairwise_cipher=NULL;
u16 j, pairwise_count;
int ret = _SUCCESS;
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(pstapriv, psa);
if (ptdls_sta == NULL) {
DBG_871X("[%s] Direct Link Peer = "MAC_FMT" not found\n", __FUNCTION__, MAC_ARG(psa));
ret = _FAIL;
goto exit;
}
ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len
-prx_pkt_attrib->hdrlen
-prx_pkt_attrib->iv_len
-prx_pkt_attrib->icv_len
-LLC_HEADER_SIZE
-ETH_TYPE_LEN
-PAYLOAD_TYPE_LEN
-FIXED_IE;
_rtw_memcpy(&status_code, ptr+2, 2);
if (status_code!= 0) {
DBG_871X("[%s] status_code = %d\n, free_tdls_sta", __FUNCTION__, status_code);
free_tdls_sta(padapter, ptdls_sta);
ret = _FAIL;
goto exit;
}
/* Parsing information element */
for (j = FIXED_IE; j < parsing_length;) {
pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr + j);
switch (pIE->ElementID) {
case _RSN_IE_2_:
prsnie = (u8 *)pIE;
break;
case _VENDOR_SPECIFIC_IE_:
if (_rtw_memcmp((u8 *)pIE + 2, WMM_PARA_OUI, 6) == _TRUE) {
/* WMM Parameter ID and OUI */
ptdls_sta->qos_option = _TRUE;
}
break;
case _FTIE_:
pftie = (u8 *)pIE;
break;
case _TIMEOUT_ITVL_IE_:
ptimeout_ie = (u8 *)pIE;
break;
#ifdef CONFIG_80211N_HT
case _HT_EXTRA_INFO_IE_:
break;
#endif
#ifdef CONFIG_80211AC_VHT
case EID_VHTOperation:
break;
case EID_OpModeNotification:
rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta);
break;
#endif
case _LINK_ID_IE_:
plinkid_ie = (u8 *)pIE;
break;
default:
break;
}
j += (pIE->Length + 2);
}
if (prx_pkt_attrib->encrypt) {
/* Verify mic in FTIE MIC field */
if (rtw_tdls_is_driver_setup(padapter) &&
(tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL)) {
free_tdls_sta(padapter, ptdls_sta);
ret = _FAIL;
goto exit;
}
}
if (rtw_tdls_is_driver_setup(padapter)) {
ptdlsinfo->link_established = _TRUE;
if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) {
ptdls_sta->tdls_sta_state|=TDLS_LINKED_STATE;
ptdls_sta->state |= _FW_LINKED;
_cancel_timer_ex(&ptdls_sta->handshake_timer);
}
if (prx_pkt_attrib->encrypt) {
rtw_tdls_set_key(padapter, ptdls_sta);
/* Start TPK timer */
ptdls_sta->TPK_count = 0;
_set_timer(&ptdls_sta->TPK_timer, ONE_SEC);
}
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED);
}
exit:
return ret;
}
int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame)
{
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *psta_ap;
u8 *ptr = precv_frame->u.hdr.rx_data;
sint parsing_length; /* Frame body length, without icv_len */
PNDIS_802_11_VARIABLE_IEs pIE;
u8 FIXED_IE = 3, *dst;
u16 j;
struct tdls_txmgmt txmgmt;
int ret = _SUCCESS;
if (rtw_tdls_is_driver_setup(padapter) == _FALSE)
goto exit;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
txmgmt.dialog_token = *(ptr+2);
_rtw_memcpy(&txmgmt.peer, precv_frame->u.hdr.attrib.src, ETH_ALEN);
txmgmt.action_code = TDLS_DISCOVERY_RESPONSE;
parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len
-prx_pkt_attrib->hdrlen
-prx_pkt_attrib->iv_len
-prx_pkt_attrib->icv_len
-LLC_HEADER_SIZE
-ETH_TYPE_LEN
-PAYLOAD_TYPE_LEN
-FIXED_IE;
/* Parsing information element */
for (j=FIXED_IE; j<parsing_length;) {
pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr+ j);
switch (pIE->ElementID) {
case _LINK_ID_IE_:
psta_ap = rtw_get_stainfo(pstapriv, pIE->data);
if (psta_ap == NULL)
goto exit;
dst = pIE->data + 12;
if (MacAddr_isBcst(dst) == _FALSE && (_rtw_memcmp(adapter_mac_addr(padapter), dst, 6) == _FALSE))
goto exit;
break;
default:
break;
}
j += (pIE->Length + 2);
}
issue_tdls_dis_rsp(padapter, &txmgmt, prx_pkt_attrib->privacy);
exit:
return ret;
}
int On_TDLS_Teardown(_adapter *padapter, union recv_frame *precv_frame)
{
u8 *psa;
u8 *ptr = precv_frame->u.hdr.rx_data;
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *ptdls_sta= NULL;
_irqL irqL;
u8 reason;
reason = *(ptr + prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN + 2);
DBG_871X("[TDLS] %s Reason code(%d)\n", __FUNCTION__,reason);
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(pstapriv, psa);
if (ptdls_sta != NULL) {
if (rtw_tdls_is_driver_setup(padapter))
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEAR_STA);
}
return _SUCCESS;
}
#if 0
u8 TDLS_check_ch_state(uint state){
if (state & TDLS_CH_SWITCH_ON_STATE &&
state & TDLS_PEER_AT_OFF_STATE) {
if (state & TDLS_PEER_SLEEP_STATE)
return 2; /* U-APSD + ch. switch */
else
return 1; /* ch. switch */
}else
return 0;
}
#endif
int On_TDLS_Peer_Traffic_Indication(_adapter *padapter, union recv_frame *precv_frame)
{
struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib;
struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src);
u8 *ptr = precv_frame->u.hdr.rx_data;
struct tdls_txmgmt txmgmt;
ptr +=pattrib->hdrlen + pattrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
if (ptdls_sta != NULL) {
txmgmt.dialog_token = *(ptr+2);
issue_tdls_peer_traffic_rsp(padapter, ptdls_sta, &txmgmt);
//issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0);
} else {
DBG_871X("from unknown sta:"MAC_FMT"\n", MAC_ARG(pattrib->src));
return _FAIL;
}
return _SUCCESS;
}
/* We process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here */
int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame)
{
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct rx_pkt_attrib *pattrib = & precv_frame->u.hdr.attrib;
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src);
u8 wmmps_ac=0;
/* u8 state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); */
int i;
ptdls_sta->sta_stats.rx_data_pkts++;
ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE);
/* Check 4-AC queue bit */
if (ptdls_sta->uapsd_vo || ptdls_sta->uapsd_vi || ptdls_sta->uapsd_be || ptdls_sta->uapsd_bk)
wmmps_ac=1;
/* If it's a direct link and have buffered frame */
if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) {
if (wmmps_ac) {
_irqL irqL;
_list *xmitframe_plist, *xmitframe_phead;
struct xmit_frame *pxmitframe=NULL;
_enter_critical_bh(&ptdls_sta->sleep_q.lock, &irqL);
xmitframe_phead = get_list_head(&ptdls_sta->sleep_q);
xmitframe_plist = get_next(xmitframe_phead);
/* transmit buffered frames */
while (rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist) == _FALSE) {
pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list);
xmitframe_plist = get_next(xmitframe_plist);
rtw_list_delete(&pxmitframe->list);
ptdls_sta->sleepq_len--;
ptdls_sta->sleepq_ac_len--;
if (ptdls_sta->sleepq_len>0) {
pxmitframe->attrib.mdata = 1;
pxmitframe->attrib.eosp = 0;
} else {
pxmitframe->attrib.mdata = 0;
pxmitframe->attrib.eosp = 1;
}
pxmitframe->attrib.triggered = 1;
rtw_hal_xmitframe_enqueue(padapter, pxmitframe);
}
if (ptdls_sta->sleepq_len==0)
DBG_871X("no buffered packets for tdls to xmit\n");
else {
DBG_871X("error!psta->sleepq_len=%d\n", ptdls_sta->sleepq_len);
ptdls_sta->sleepq_len=0;
}
_exit_critical_bh(&ptdls_sta->sleep_q.lock, &irqL);
}
}
return _SUCCESS;
}
#ifdef CONFIG_TDLS_CH_SW
sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame)
{
struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info;
struct sta_info *ptdls_sta= NULL;
struct sta_priv *pstapriv = &padapter->stapriv;
u8 *ptr = precv_frame->u.hdr.rx_data;
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
u8 *psa;
sint parsing_length;
PNDIS_802_11_VARIABLE_IEs pIE;
u8 FIXED_IE = 4;
u16 j;
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct tdls_txmgmt txmgmt;
u16 switch_time= CH_SWITCH_TIME * 1000, switch_timeout=CH_SWITCH_TIMEOUT * 1000;
if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE)
{ DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__);
return _SUCCESS;
}
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(pstapriv, psa);
ptdls_sta->ch_switch_time=switch_time;
ptdls_sta->ch_switch_timeout=switch_timeout;
ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len+LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
parsing_length= ((union recv_frame *)precv_frame)->u.hdr.len
-prx_pkt_attrib->hdrlen
-prx_pkt_attrib->iv_len
-prx_pkt_attrib->icv_len
-LLC_HEADER_SIZE
-ETH_TYPE_LEN
-PAYLOAD_TYPE_LEN
-FIXED_IE;
pchsw_info->off_ch_num = *(ptr + 2);
if (*(ptr + 2) == 2) {
pchsw_info->off_ch_num = 11;
}
if (pchsw_info->off_ch_num != pmlmeext->cur_channel) {
pchsw_info->delay_switch_back = _FALSE;
}
/* Parsing information element */
for (j=FIXED_IE; j<parsing_length;) {
pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr+ j);
switch (pIE->ElementID) {
case EID_SecondaryChnlOffset:
padapter->tdlsinfo.chsw_info.ch_offset = *(pIE->data);
break;
case _LINK_ID_IE_:
break;
case _CH_SWITCH_TIMING_:
ptdls_sta->ch_switch_time = (RTW_GET_LE16(pIE->data) >= CH_SWITCH_TIME * 1000) ?
RTW_GET_LE16(pIE->data) : CH_SWITCH_TIME * 1000;
ptdls_sta->ch_switch_timeout = (RTW_GET_LE16(pIE->data + 2) >= CH_SWITCH_TIMEOUT * 1000) ?
RTW_GET_LE16(pIE->data + 2) : CH_SWITCH_TIMEOUT * 1000;
DBG_871X("%s ch_switch_time:%d, ch_switch_timeout:%d\n"
, __FUNCTION__, RTW_GET_LE16(pIE->data), RTW_GET_LE16(pIE->data + 2));
default:
break;
}
j += (pIE->Length + 2);
}
/* Todo: check status */
txmgmt.status_code = 0;
_rtw_memcpy(txmgmt.peer, psa, ETH_ALEN);
ATOMIC_SET(&pchsw_info->chsw_on, _TRUE);
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_RESP);
return _SUCCESS;
}
sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame)
{
struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info;
struct sta_info *ptdls_sta= NULL;
struct sta_priv *pstapriv = &padapter->stapriv;
u8 *ptr = precv_frame->u.hdr.rx_data;
struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib;
u8 *psa;
sint parsing_length;
PNDIS_802_11_VARIABLE_IEs pIE;
u8 FIXED_IE = 4;
u16 status_code, j, switch_time, switch_timeout;
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
int ret = _SUCCESS;
if (padapter->tdlsinfo.ch_switch_prohibited == _TRUE)
{ DBG_871X("[TDLS] Ignore %s since ch_switch_prohibited = _TRUE\n", __FUNCTION__);
return _SUCCESS;
}
psa = get_sa(ptr);
ptdls_sta = rtw_get_stainfo(pstapriv, psa);
/* If we receive Unsolicited TDLS Channel Switch Response when channel switch is running, */
/* we will go back to base channel and terminate this channel switch procedure */
if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) {
if (pmlmeext->cur_channel != rtw_get_oper_ch(padapter)) {
DBG_871X("receive unsolicited channel switch response \n");
rtw_tdls_cmd(padapter, NULL, TDLS_CH_SW_BACK);
goto exit;
}
}
ptr +=prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE+ETH_TYPE_LEN+PAYLOAD_TYPE_LEN;
parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len
-prx_pkt_attrib->hdrlen
-prx_pkt_attrib->iv_len
-prx_pkt_attrib->icv_len
-LLC_HEADER_SIZE
-ETH_TYPE_LEN
-PAYLOAD_TYPE_LEN
-FIXED_IE;
_rtw_memcpy(&status_code, ptr+2, 2);
if (status_code != 0) {
DBG_871X("[%s] status_code:%d\n", __FUNCTION__, status_code);
pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE);
ATOMIC_SET(&pchsw_info->chsw_on, _FALSE);
ret = _FAIL;
goto exit;
}
/* Parsing information element */
for (j = FIXED_IE; j < parsing_length;) {
pIE = (PNDIS_802_11_VARIABLE_IEs)(ptr+ j);
switch (pIE->ElementID) {
case _LINK_ID_IE_:
break;
case _CH_SWITCH_TIMING_:
_rtw_memcpy(&switch_time, pIE->data, 2);
if (switch_time > ptdls_sta->ch_switch_time)
_rtw_memcpy(&ptdls_sta->ch_switch_time, &switch_time, 2);
_rtw_memcpy(&switch_timeout, pIE->data + 2, 2);
if (switch_timeout > ptdls_sta->ch_switch_timeout)
_rtw_memcpy(&ptdls_sta->ch_switch_timeout, &switch_timeout, 2);
break;
default:
break;
}
j += (pIE->Length + 2);
}
if ((pmlmeext->cur_channel == rtw_get_oper_ch(padapter)) &&
(pchsw_info->ch_sw_state & TDLS_WAIT_CH_RSP_STATE)) {
ATOMIC_SET(&pchsw_info->chsw_on, _TRUE);
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW);
}
exit:
return ret;
}
#endif /* CONFIG_TDLS_CH_SW */
#ifdef CONFIG_WFD
void wfd_ie_tdls(_adapter * padapter, u8 *pframe, u32 *pktlen )
{
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info;
u8 wfdie[ MAX_WFD_IE_LEN] = { 0x00 };
u32 wfdielen = 0;
if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST))
return;
/* WFD OUI */
wfdielen = 0;
wfdie[ wfdielen++ ] = 0x50;
wfdie[ wfdielen++ ] = 0x6F;
wfdie[ wfdielen++ ] = 0x9A;
wfdie[ wfdielen++ ] = 0x0A; /* WFA WFD v1.0 */
/*
* Commented by Albert 20110825
* According to the WFD Specification, the negotiation request frame should contain 3 WFD attributes
* 1. WFD Device Information
* 2. Associated BSSID ( Optional )
* 3. Local IP Adress ( Optional )
*/
/* WFD Device Information ATTR */
/* Type: */
wfdie[ wfdielen++ ] = WFD_ATTR_DEVICE_INFO;
/* Length: */
/* Note: In the WFD specification, the size of length field is 2. */
RTW_PUT_BE16(wfdie + wfdielen, 0x0006);
wfdielen += 2;
/* Value1: */
/* WFD device information */
/* available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) */
RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL
| WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD);
wfdielen += 2;
/* Value2: */
/* Session Management Control Port */
/* Default TCP port for RTSP messages is 554 */
RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->tdls_rtsp_ctrlport);
wfdielen += 2;
/* Value3: */
/* WFD Device Maximum Throughput */
/* 300Mbps is the maximum throughput */
RTW_PUT_BE16(wfdie + wfdielen, 300);
wfdielen += 2;
/* Associated BSSID ATTR */
/* Type: */
wfdie[ wfdielen++ ] = WFD_ATTR_ASSOC_BSSID;
/* Length: */
/* Note: In the WFD specification, the size of length field is 2. */
RTW_PUT_BE16(wfdie + wfdielen, 0x0006);
wfdielen += 2;
/* Value: */
/* Associated BSSID */
if (check_fwstate( pmlmepriv, _FW_LINKED) == _TRUE)
_rtw_memcpy(wfdie + wfdielen, &pmlmepriv->assoc_bssid[ 0 ], ETH_ALEN);
else
_rtw_memset(wfdie + wfdielen, 0x00, ETH_ALEN);
/* Local IP Address ATTR */
wfdie[ wfdielen++ ] = WFD_ATTR_LOCAL_IP_ADDR;
/* Length: */
/* Note: In the WFD specification, the size of length field is 2. */
RTW_PUT_BE16(wfdie + wfdielen, 0x0005);
wfdielen += 2;
/* Version: */
/* 0x01: Version1;IPv4 */
wfdie[ wfdielen++ ] = 0x01;
/* IPv4 Address */
_rtw_memcpy( wfdie + wfdielen, pwfd_info->ip_address, 4 );
wfdielen += 4;
pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, wfdielen, (unsigned char *) wfdie, pktlen);
}
#endif /* CONFIG_WFD */
void rtw_build_tdls_setup_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct registry_priv *pregistrypriv = &padapter->registrypriv;
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst);
int i = 0 ;
u32 time;
u8 *pframe_head;
/* SNonce */
if (pattrib->encrypt) {
for (i=0;i<8;i++) {
time=rtw_get_current_time();
_rtw_memcpy(&ptdls_sta->SNonce[4*i], (u8 *)&time, 4);
}
}
pframe_head = pframe; /* For rtw_tdls_set_ht_cap() */
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_capability(padapter, pframe, pattrib);
pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib);
pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib);
pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib);
if (pattrib->encrypt)
pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta);
pframe = rtw_tdls_set_ext_cap(pframe, pattrib);
if (pattrib->encrypt) {
pframe = rtw_tdls_set_ftie(ptxmgmt
, pframe
, pattrib
, NULL
, ptdls_sta->SNonce);
pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta);
}
#ifdef CONFIG_80211N_HT
/* Sup_reg_classes(optional) */
if (pregistrypriv->ht_enable == _TRUE)
pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib);
#endif
pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib);
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE))
pframe = rtw_tdls_set_qos_cap(pframe, pattrib);
#ifdef CONFIG_80211AC_VHT
if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14)
&& REGSTY_IS_11AC_ENABLE(pregistrypriv)
&& hal_chk_proto_cap(padapter, PROTO_CAP_11AC)
&& (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent))
) {
pframe = rtw_tdls_set_aid(padapter, pframe, pattrib);
pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib);
}
#endif
#ifdef CONFIG_WFD
if (padapter->wdinfo.wfd_tdls_enable == 1)
wfd_ie_tdls(padapter, pframe, &(pattrib->pktlen));
#endif
}
void rtw_build_tdls_setup_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct registry_priv *pregistrypriv = &padapter->registrypriv;
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_info *ptdls_sta;
u8 k; /* for random ANonce */
u8 *pftie=NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL;
u32 time;
u8 *pframe_head;
ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst);
if (ptdls_sta == NULL)
DBG_871X("[%s] %d ptdls_sta is NULL\n", __FUNCTION__, __LINE__);
if (pattrib->encrypt && ptdls_sta != NULL) {
for (k=0;k<8;k++) {
time = rtw_get_current_time();
_rtw_memcpy(&ptdls_sta->ANonce[4*k], (u8*)&time, 4);
}
}
pframe_head = pframe;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt);
if (ptxmgmt->status_code != 0) {
DBG_871X("[%s] status_code:%04x \n", __FUNCTION__, ptxmgmt->status_code);
return;
}
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_capability(padapter, pframe, pattrib);
pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib);
pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib);
pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib);
if (pattrib->encrypt) {
prsnie = pframe;
pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta);
}
pframe = rtw_tdls_set_ext_cap(pframe, pattrib);
if (pattrib->encrypt) {
if (rtw_tdls_is_driver_setup(padapter) == _TRUE)
wpa_tdls_generate_tpk(padapter, ptdls_sta);
pftie = pframe;
pftie_mic = pframe+4;
pframe = rtw_tdls_set_ftie(ptxmgmt
, pframe
, pattrib
, ptdls_sta->ANonce
, ptdls_sta->SNonce);
ptimeout_ie = pframe;
pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _FALSE, ptdls_sta);
}
#ifdef CONFIG_80211N_HT
/* Sup_reg_classes(optional) */
if (pregistrypriv->ht_enable == _TRUE)
pframe = rtw_tdls_set_ht_cap(padapter, pframe_head, pattrib);
#endif
pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib);
plinkid_ie = pframe;
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
/* Fill FTIE mic */
if (pattrib->encrypt && rtw_tdls_is_driver_setup(padapter) == _TRUE)
wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic);
if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE))
pframe = rtw_tdls_set_qos_cap(pframe, pattrib);
#ifdef CONFIG_80211AC_VHT
if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14)
&& REGSTY_IS_11AC_ENABLE(pregistrypriv)
&& hal_chk_proto_cap(padapter, PROTO_CAP_11AC)
&& (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent))
) {
pframe = rtw_tdls_set_aid(padapter, pframe, pattrib);
pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib);
pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode);
}
#endif
#ifdef CONFIG_WFD
if (padapter->wdinfo.wfd_tdls_enable)
wfd_ie_tdls(padapter, pframe, &(pattrib->pktlen));
#endif
}
void rtw_build_tdls_setup_cfm_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct registry_priv *pregistrypriv = &padapter->registrypriv;
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_info *ptdls_sta=rtw_get_stainfo( (&padapter->stapriv) , pattrib->dst);
unsigned int ie_len;
unsigned char *p;
u8 wmm_param_ele[24] = {0};
u8 *pftie=NULL, *ptimeout_ie=NULL, *plinkid_ie=NULL, *prsnie=NULL, *pftie_mic=NULL;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
if (ptxmgmt->status_code!=0)
return;
if (pattrib->encrypt) {
prsnie = pframe;
pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta);
}
if (pattrib->encrypt) {
pftie = pframe;
pftie_mic = pframe+4;
pframe = rtw_tdls_set_ftie(ptxmgmt
, pframe
, pattrib
, ptdls_sta->ANonce
, ptdls_sta->SNonce);
ptimeout_ie = pframe;
pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, ptdls_sta);
if (rtw_tdls_is_driver_setup(padapter) == _TRUE) {
/* Start TPK timer */
ptdls_sta->TPK_count=0;
_set_timer(&ptdls_sta->TPK_timer, ONE_SEC);
}
}
/* HT operation; todo */
plinkid_ie = pframe;
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE))
wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic);
if (ptdls_sta->qos_option == _TRUE)
pframe = rtw_tdls_set_wmm_params(padapter, pframe, pattrib);
#ifdef CONFIG_80211AC_VHT
if ((padapter->mlmepriv.htpriv.ht_option == _TRUE)
&& (ptdls_sta->vhtpriv.vht_option == _TRUE) && (pmlmeext->cur_channel > 14)
&& REGSTY_IS_11AC_ENABLE(pregistrypriv)
&& hal_chk_proto_cap(padapter, PROTO_CAP_11AC)
&& (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent))
) {
pframe = rtw_tdls_set_vht_operation(padapter, pframe, pattrib, pmlmeext->cur_channel);
pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode);
}
#endif
}
void rtw_build_tdls_teardown_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_info *ptdls_sta = rtw_get_stainfo( &(padapter->stapriv) , pattrib->dst);
u8 *pftie = NULL, *pftie_mic = NULL, *plinkid_ie = NULL;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt);
if (pattrib->encrypt) {
pftie = pframe;
pftie_mic = pframe + 4;
pframe = rtw_tdls_set_ftie(ptxmgmt
, pframe
, pattrib
, ptdls_sta->ANonce
, ptdls_sta->SNonce);
}
plinkid_ie = pframe;
if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE))
wpa_tdls_teardown_ftie_mic(ptdls_sta->tpk.kck, plinkid_ie, ptxmgmt->status_code, 1, 4, pftie, pftie_mic);
}
void rtw_build_tdls_dis_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
}
void rtw_build_tdls_dis_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy)
{
struct registry_priv *pregistrypriv = &padapter->registrypriv;
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct pkt_attrib *pattrib = &pxmitframe->attrib;
u8 *pframe_head, pktlen_index;
pktlen_index = pattrib->pktlen;
pframe_head = pframe;
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_PUBLIC);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_capability(padapter, pframe, pattrib);
pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib);
pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib);
if (privacy)
pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, NULL);
pframe = rtw_tdls_set_ext_cap(pframe, pattrib);
if (privacy) {
pframe = rtw_tdls_set_ftie(ptxmgmt, pframe, pattrib, NULL, NULL);
pframe = rtw_tdls_set_timeout_interval(ptxmgmt, pframe, pattrib, _TRUE, NULL);
}
#ifdef CONFIG_80211N_HT
if (pregistrypriv->ht_enable == _TRUE)
pframe = rtw_tdls_set_ht_cap(padapter, pframe_head - pktlen_index, pattrib);
#endif
pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib);
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
}
void rtw_build_tdls_peer_traffic_indication_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
u8 AC_queue=0;
struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst);
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
/* PTI control */
/* PU buffer status */
if (ptdls_sta->uapsd_bk & BIT(1))
AC_queue=BIT(0);
if (ptdls_sta->uapsd_be & BIT(1))
AC_queue=BIT(1);
if (ptdls_sta->uapsd_vi & BIT(1))
AC_queue=BIT(2);
if (ptdls_sta->uapsd_vo & BIT(1))
AC_queue=BIT(3);
pframe = rtw_set_ie(pframe, _PTI_BUFFER_STATUS_, 1, &AC_queue, &(pattrib->pktlen));
}
void rtw_build_tdls_peer_traffic_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst);
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt);
if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
}
#ifdef CONFIG_TDLS_CH_SW
void rtw_build_tdls_ch_switch_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst);
u16 switch_time= CH_SWITCH_TIME * 1000, switch_timeout=CH_SWITCH_TIMEOUT * 1000;
ptdls_sta->ch_switch_time=switch_time;
ptdls_sta->ch_switch_timeout=switch_timeout;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_target_ch(padapter, pframe, pattrib);
pframe = rtw_tdls_set_reg_class(pframe, pattrib, ptdls_sta);
if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta);
}
void rtw_build_tdls_ch_switch_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct sta_priv *pstapriv = &padapter->stapriv;
struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst);
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS);
pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt);
pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt);
if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE);
else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE)
pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE);
pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta);
}
#endif
#ifdef CONFIG_WFD
void rtw_build_tunneled_probe_req_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct wifidirect_info *pwdinfo = &padapter->wdinfo;
struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo;
u8 category = RTW_WLAN_CATEGORY_P2P;
u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a};
u8 probe_req = 4;
u8 wfdielen = 0;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen));
pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen));
pframe = rtw_set_fixed_ie(pframe, 1, &(probe_req), &(pattrib->pktlen));
if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
wfdielen = build_probe_req_wfd_ie(pwdinfo, pframe);
pframe += wfdielen;
pattrib->pktlen += wfdielen;
} else if (!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) {
wfdielen = build_probe_req_wfd_ie(pbuddy_wdinfo, pframe);
pframe += wfdielen;
pattrib->pktlen += wfdielen;
}
}
void rtw_build_tunneled_probe_rsp_ies(_adapter * padapter, struct xmit_frame * pxmitframe, u8 *pframe)
{
struct pkt_attrib *pattrib = &pxmitframe->attrib;
struct wifidirect_info *pwdinfo = &padapter->wdinfo;
struct wifidirect_info *pbuddy_wdinfo = &padapter->pbuddy_adapter->wdinfo;
u8 category = RTW_WLAN_CATEGORY_P2P;
u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a};
u8 probe_rsp = 5;
u8 wfdielen = 0;
pframe = rtw_tdls_set_payload_type(pframe, pattrib);
pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen));
pframe = rtw_set_fixed_ie(pframe, 3, WFA_OUI, &(pattrib->pktlen));
pframe = rtw_set_fixed_ie(pframe, 1, &(probe_rsp), &(pattrib->pktlen));
if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
wfdielen = build_probe_resp_wfd_ie(pwdinfo, pframe, 1);
pframe += wfdielen;
pattrib->pktlen += wfdielen;
} else if (!rtw_p2p_chk_state(pbuddy_wdinfo, P2P_STATE_NONE)) {
wfdielen = build_probe_resp_wfd_ie(pbuddy_wdinfo, pframe, 1);
pframe += wfdielen;
pattrib->pktlen += wfdielen;
}
}
#endif /* CONFIG_WFD */
void _tdls_tpk_timer_hdl(void *FunctionContext)
{
struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext;
struct tdls_txmgmt txmgmt;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
ptdls_sta->TPK_count++;
/* TPK_timer expired in a second */
/* Retry timer should set at least 301 sec. */
if (ptdls_sta->TPK_count >= ptdls_sta->TDLS_PeerKey_Lifetime) {
DBG_871X("[TDLS] %s, Re-Setup TDLS link with "MAC_FMT" since TPK lifetime expires!\n", __FUNCTION__, MAC_ARG(ptdls_sta->hwaddr));
ptdls_sta->TPK_count=0;
_rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN);
issue_tdls_setup_req(ptdls_sta->padapter, &txmgmt, _FALSE);
}
_set_timer(&ptdls_sta->TPK_timer, ONE_SEC);
}
#ifdef CONFIG_TDLS_CH_SW
void _tdls_ch_switch_timer_hdl(void *FunctionContext)
{
struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext;
_adapter *padapter = ptdls_sta->padapter;
struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info;
//DBG_871X("%s %d, tdls_sta_state:0x%08x\n", __FUNCTION__, __LINE__, ptdls_sta->tdls_sta_state);
if (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter)) {
if (!(pchsw_info->ch_sw_state & TDLS_PEER_AT_OFF_STATE)) {
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_BACK);
ATOMIC_SET(&pchsw_info->chsw_on, _FALSE);
DBG_871X("[TDLS] %s, can't get traffic from op_ch:%d\n", __FUNCTION__, rtw_get_oper_ch(padapter));
} else {
//DBG_871X("%s %d\n", __FUNCTION__, __LINE__);
//_set_timer(&ptdls_sta->delay_timer, padapter->mlmeextpriv.mlmext_info.bcn_interval - 5 - ptdls_sta->ch_switch_timeout/1000);
}
} else {
//DBG_871X("%s %d, op_ch:%d, tdls_state:0x%08x\n", __FUNCTION__, __LINE__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state);
}
#if 0
if (!(pchsw_info->ch_sw_state & TDLS_PEER_AT_OFF_STATE)) {
//SelectChannel(padapter, padapter->mlmeextpriv.cur_channel);
ATOMIC_SET(&pchsw_info->chsw_on, _FALSE);
DBG_871X("%s %d, op_ch:%d, tdls_state:0x%08x\n", __FUNCTION__, __LINE__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state);
}
if (pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) {
if (padapter->mlmeextpriv.cur_channel != rtw_get_oper_ch(padapter)) {
DBG_871X("%s %d\n", __FUNCTION__, __LINE__);
_set_timer(&ptdls_sta->delay_timer, padapter->mlmeextpriv.mlmext_info.bcn_interval - 5 - ptdls_sta->ch_switch_timeout/1000);
//_set_timer(&ptdls_sta->delay_timer, 1000);
} else {
DBG_871X("%s %d\n", __FUNCTION__, __LINE__);
issue_tdls_ch_switch_req(padapter, ptdls_sta);
//_set_timer(&ptdls_sta->delay_timer, 500);
}
}
#endif
}
void _tdls_delay_timer_hdl(void *FunctionContext)
{
struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext;
_adapter *padapter = ptdls_sta->padapter;
struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info;
DBG_871X("[TDLS] %s, op_ch:%d, tdls_state:0x%08x\n", __FUNCTION__, rtw_get_oper_ch(padapter), ptdls_sta->tdls_sta_state);
pchsw_info->delay_switch_back = _TRUE;
}
#endif
void _tdls_handshake_timer_hdl(void *FunctionContext)
{
struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext;
_adapter *padapter = ptdls_sta->padapter;
struct tdls_txmgmt txmgmt;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
_rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN);
txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_;
if (ptdls_sta != NULL) {
DBG_871X("[TDLS] Handshake time out\n");
if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)
{
issue_tdls_teardown(padapter, &txmgmt, _TRUE);
}
else
{
rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEAR_STA);
}
}
}
void _tdls_pti_timer_hdl(void *FunctionContext)
{
struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext;
_adapter *padapter = ptdls_sta->padapter;
struct tdls_txmgmt txmgmt;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
_rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN);
txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_;
if (ptdls_sta != NULL) {
if (ptdls_sta->tdls_sta_state & TDLS_WAIT_PTR_STATE) {
DBG_871X("[TDLS] Doesn't receive PTR from peer dev:"MAC_FMT"; "
"Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->hwaddr));
issue_tdls_teardown(padapter, &txmgmt, _FALSE);
}
}
}
void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta)
{
psta->padapter=padapter;
_init_timer(&psta->TPK_timer, padapter->pnetdev, _tdls_tpk_timer_hdl, psta);
#ifdef CONFIG_TDLS_CH_SW
_init_timer(&psta->ch_sw_timer, padapter->pnetdev, _tdls_ch_switch_timer_hdl, psta);
_init_timer(&psta->delay_timer, padapter->pnetdev, _tdls_delay_timer_hdl, psta);
#endif
_init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta);
_init_timer(&psta->pti_timer, padapter->pnetdev, _tdls_pti_timer_hdl, psta);
}
void rtw_free_tdls_timer(struct sta_info *psta)
{
_cancel_timer_ex(&psta->TPK_timer);
#ifdef CONFIG_TDLS_CH_SW
_cancel_timer_ex(&psta->ch_sw_timer);
_cancel_timer_ex(&psta->delay_timer);
#endif
_cancel_timer_ex(&psta->handshake_timer);
_cancel_timer_ex(&psta->pti_timer);
}
u8 update_sgi_tdls(_adapter *padapter, struct sta_info *psta)
{
return query_ra_short_GI(psta);
}
u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta)
{
unsigned char sta_band = 0;
unsigned int tx_ra_bitmap=0;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
rtw_hal_update_sta_rate_mask(padapter, psta);
tx_ra_bitmap = psta->ra_mask;
if (pcur_network->Configuration.DSConfig > 14) {
if (tx_ra_bitmap & 0xffff000)
sta_band |= WIRELESS_11_5N | WIRELESS_11A;
else
sta_band |= WIRELESS_11A;
} else {
if (tx_ra_bitmap & 0xffff000)
sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B;
else if (tx_ra_bitmap & 0xff0)
sta_band |= WIRELESS_11G |WIRELESS_11B;
else
sta_band |= WIRELESS_11B;
}
psta->wireless_mode = sta_band;
psta->raid = rtw_hal_networktype_to_raid(padapter,psta);
tx_ra_bitmap |= ((psta->raid<<28)&0xf0000000);
return tx_ra_bitmap;
}
int rtw_tdls_is_driver_setup(_adapter *padapter)
{
return padapter->tdlsinfo.driver_setup;
}
const char * rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action)
{
switch (action) {
case TDLS_SETUP_REQUEST:
return "TDLS_SETUP_REQUEST";
case TDLS_SETUP_RESPONSE:
return "TDLS_SETUP_RESPONSE";
case TDLS_SETUP_CONFIRM:
return "TDLS_SETUP_CONFIRM";
case TDLS_TEARDOWN:
return "TDLS_TEARDOWN";
case TDLS_PEER_TRAFFIC_INDICATION:
return "TDLS_PEER_TRAFFIC_INDICATION";
case TDLS_CHANNEL_SWITCH_REQUEST:
return "TDLS_CHANNEL_SWITCH_REQUEST";
case TDLS_CHANNEL_SWITCH_RESPONSE:
return "TDLS_CHANNEL_SWITCH_RESPONSE";
case TDLS_PEER_PSM_REQUEST:
return "TDLS_PEER_PSM_REQUEST";
case TDLS_PEER_PSM_RESPONSE:
return "TDLS_PEER_PSM_RESPONSE";
case TDLS_PEER_TRAFFIC_RESPONSE:
return "TDLS_PEER_TRAFFIC_RESPONSE";
case TDLS_DISCOVERY_REQUEST:
return "TDLS_DISCOVERY_REQUEST";
case TDLS_DISCOVERY_RESPONSE:
return "TDLS_DISCOVERY_RESPONSE";
default:
return "UNKNOWN";
}
}
#endif /* CONFIG_TDLS */