/****************************************************************************** * * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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. * *****************************************************************************/ #include #include #ifdef CONFIG_RTW_80211R #ifndef RTW_FT_DBG #define RTW_FT_DBG 0 #endif #if RTW_FT_DBG #define RTW_FT_INFO(fmt, arg...) \ RTW_INFO(fmt, arg) #define RTW_FT_DUMP(str, data, len) \ RTW_INFO_DUMP(str, data, len) #else #define RTW_FT_INFO(fmt, arg...) do {} while (0) #define RTW_FT_DUMP(str, data, len) do {} while (0) #endif void rtw_ft_info_init(struct ft_roam_info *pft) { _rtw_memset(pft, 0, sizeof(struct ft_roam_info)); pft->ft_flags = 0 | RTW_FT_EN /* | RTW_FT_OTD_EN */ #ifdef CONFIG_RTW_BTM_ROAM | RTW_FT_BTM_ROAM #endif ; pft->ft_updated_bcn = _FALSE; RTW_FT_INFO("%s : ft_flags=0x%02x\n", __func__, pft->ft_flags); } ssize_t rtw_ft_proc_flags_set(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; u8 flags; if (count < 1) return -EFAULT; if (count > sizeof(tmp)) { rtw_warn_on(1); return -EFAULT; } if (buffer && !copy_from_user(tmp, buffer, count)) { int num = sscanf(tmp, "%hhx", &flags); if (num == 1) adapter->mlmepriv.ft_roam.ft_flags = flags; } return count; } int rtw_ft_proc_flags_get(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); RTW_PRINT_SEL(m, "0x%02x\n", adapter->mlmepriv.ft_roam.ft_flags); return 0; } u8 rtw_ft_chk_roaming_candidate( _adapter *padapter, struct wlan_network *competitor) { u8 *pmdie; u32 mdie_len = 0; struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); if (!(pmdie = rtw_get_ie(&competitor->network.IEs[12], _MDIE_, &mdie_len, competitor->network.IELength-12))) { RTW_INFO("FT : MDIE not foud in competitor!\n"); return _FALSE; } if (!_rtw_memcmp(&pft_roam->mdid, (pmdie+2), 2)) { RTW_INFO("FT : unmatched MDIE!\n"); return _FALSE; } /*The candidate don't support over-the-DS*/ if (rtw_ft_valid_otd_candidate(padapter, pmdie)) { RTW_INFO("FT: ignore the candidate(" MAC_FMT ") for over-the-DS\n", MAC_ARG(competitor->network.MacAddress)); /* rtw_ft_clr_flags(padapter, RTW_FT_PEER_OTD_EN); */ return _FALSE; } if (rtw_ft_chk_flags(padapter, RTW_FT_TEST_RSSI_ROAM)) { if (!_rtw_memcmp(padapter->mlmepriv.cur_network.network.MacAddress, competitor->network.MacAddress, ETH_ALEN) ) { competitor->network.Rssi +=20; RTW_FT_INFO("%s : update "MAC_FMT" RSSI to %d for RTW_FT_TEST_RSSI_ROAM\n", __func__, MAC_ARG(competitor->network.MacAddress), (int)competitor->network.Rssi); rtw_ft_clr_flags(padapter, RTW_FT_TEST_RSSI_ROAM); } } return _TRUE; } void rtw_ft_update_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork) { struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta = NULL; psta = rtw_get_stainfo(pstapriv, pnetwork->MacAddress); if (psta == NULL) psta = rtw_alloc_stainfo(pstapriv, pnetwork->MacAddress); if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { padapter->securitypriv.binstallGrpkey = _FALSE; padapter->securitypriv.busetkipkey = _FALSE; padapter->securitypriv.bgrpkey_handshake = _FALSE; psta->ieee8021x_blocked = _TRUE; psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); } } void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&(pmlmeinfo->network); struct cfg80211_ft_event_params ft_evt_parms; _irqL irqL; _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); rtw_ft_update_stainfo(padapter, pnetwork); ft_evt_parms.ies_len = pft_roam->ft_event.ies_len; ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); if (ft_evt_parms.ies) _rtw_memcpy((void *)ft_evt_parms.ies, pft_roam->ft_event.ies, ft_evt_parms.ies_len); else goto err_2; ft_evt_parms.target_ap = rtw_zmalloc(ETH_ALEN); if (ft_evt_parms.target_ap) _rtw_memcpy((void *)ft_evt_parms.target_ap, pstassoc->macaddr, ETH_ALEN); else goto err_1; ft_evt_parms.ric_ies = pft_roam->ft_event.ric_ies; ft_evt_parms.ric_ies_len = pft_roam->ft_event.ric_ies_len; /* It's a KERNEL issue between v4.11 ~ v4.16, * <= v4.10, NLMSG_DEFAULT_SIZE is used for nlmsg_new(). * v4.11 ~ v4.16, only used "100 + >ric_ies_len" for nlmsg_new() * even then DRIVER don't support RIC. * >= v4.17, issue should correct as "100 + ies_len + ric_ies_len". */ #if ((LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) && \ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 17, 0))) if (!ft_evt_parms.ric_ies_len) ft_evt_parms.ric_ies_len = ft_evt_parms.ies_len; else ft_evt_parms.ric_ies_len += ft_evt_parms.ies_len; #endif rtw_ft_lock_set_status(padapter, RTW_FT_AUTHENTICATED_STA, &irqL); rtw_cfg80211_ft_event(padapter, &ft_evt_parms); RTW_INFO("%s: to "MAC_FMT"\n", __func__, MAC_ARG(ft_evt_parms.target_ap)); rtw_mfree((u8 *)pft_roam->ft_event.target_ap, ETH_ALEN); err_1: rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); err_2: return; } void rtw_ft_validate_akm_type(_adapter *padapter, struct wlan_network *pnetwork) { struct security_priv *psecuritypriv = &(padapter->securitypriv); struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); u32 tmp_len; u8 *ptmp; /*IEEE802.11-2012 Std. Table 8-101-AKM suite selectors*/ if (rtw_ft_valid_akm(padapter, psecuritypriv->rsn_akm_suite_type)) { ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _MDIE_, &tmp_len, (pnetwork->network.IELength-12)); if (ptmp) { pft_roam->mdid = *(u16 *)(ptmp+2); pft_roam->ft_cap = *(ptmp+4); RTW_INFO("FT: target " MAC_FMT " mdid=(0x%2x), capacity=(0x%2x)\n", MAC_ARG(pnetwork->network.MacAddress), pft_roam->mdid, pft_roam->ft_cap); rtw_ft_set_flags(padapter, RTW_FT_PEER_EN); RTW_FT_INFO("%s : peer support FTOTA(0x%02x)\n", __func__, pft_roam->ft_flags); if (rtw_ft_otd_roam_en(padapter)) { rtw_ft_set_flags(padapter, RTW_FT_PEER_OTD_EN); RTW_FT_INFO("%s : peer support FTOTD(0x%02x)\n", __func__, pft_roam->ft_flags); } } else { /* Don't use FT roaming if target AP cannot support FT */ rtw_ft_clr_flags(padapter, (RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN)); rtw_ft_reset_status(padapter); } } else { /* It could be a non-FT connection */ rtw_ft_clr_flags(padapter, (RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN)); rtw_ft_reset_status(padapter); } RTW_FT_INFO("%s : ft_flags=0x%02x\n", __func__, pft_roam->ft_flags); } void rtw_ft_update_bcn(_adapter *padapter, union recv_frame *precv_frame) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; u8 *pframe = precv_frame->u.hdr.rx_data; uint len = precv_frame->u.hdr.len; WLAN_BSSID_EX *pbss; if (rtw_ft_chk_status(padapter,RTW_FT_ASSOCIATED_STA) && (pmlmepriv->ft_roam.ft_updated_bcn == _FALSE)) { pbss = (WLAN_BSSID_EX*)rtw_malloc(sizeof(WLAN_BSSID_EX)); if (pbss) { if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { struct beacon_keys recv_beacon; update_network(&(pmlmepriv->cur_network.network), pbss, padapter, _TRUE); /* Move into rtw_get_bcn_keys */ /* rtw_get_bcn_info(&(pmlmepriv->cur_network)); */ /* update bcn keys */ if (rtw_get_bcn_keys(padapter, pframe, len, &recv_beacon) == _TRUE) { RTW_FT_INFO("%s: beacon keys ready\n", __func__); _rtw_memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); if (is_hidden_ssid(recv_beacon.ssid, recv_beacon.ssid_len)) { _rtw_memcpy(pmlmepriv->cur_beacon_keys.ssid, pmlmeinfo->network.Ssid.Ssid, IW_ESSID_MAX_SIZE); pmlmepriv->cur_beacon_keys.ssid_len = pmlmeinfo->network.Ssid.SsidLength; } } else { RTW_ERR("%s: get beacon keys failed\n", __func__); _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); } #ifdef CONFIG_BCN_CNT_CONFIRM_HDL pmlmepriv->new_beacon_cnts = 0; #endif } rtw_mfree((u8*)pbss, sizeof(WLAN_BSSID_EX)); } /* check the vendor of the assoc AP */ pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pframe+sizeof(struct rtw_ieee80211_hdr_3addr), (len - sizeof(struct rtw_ieee80211_hdr_3addr))); /* update TSF Value */ update_TSF(pmlmeext, pframe, len); pmlmeext->bcn_cnt = 0; pmlmeext->last_bcn_cnt = 0; pmlmepriv->ft_roam.ft_updated_bcn = _TRUE; } } void rtw_ft_start_clnt_join(_adapter *padapter) { struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); if (rtw_ft_otd_roam(padapter)) { pmlmeinfo->state = WIFI_FW_AUTH_SUCCESS | WIFI_FW_STATION_STATE; pft_roam->ft_event.ies = (pft_roam->ft_action + sizeof(struct rtw_ieee80211_hdr_3addr) + 16); pft_roam->ft_event.ies_len = (pft_roam->ft_action_len - sizeof(struct rtw_ieee80211_hdr_3addr)); /*Not support RIC*/ pft_roam->ft_event.ric_ies = NULL; pft_roam->ft_event.ric_ies_len = 0; rtw_ft_report_evt(padapter); return; } pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; start_clnt_auth(padapter); } u8 rtw_ft_update_rsnie( _adapter *padapter, u8 bwrite, struct pkt_attrib *pattrib, u8 **pframe) { struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); u8 *pie; u32 len; pie = rtw_get_ie(pft_roam->updated_ft_ies, EID_WPA2, &len, pft_roam->updated_ft_ies_len); if (!bwrite) return (pie)?_SUCCESS:_FAIL; if (pie) { *pframe = rtw_set_ie(((u8 *)*pframe), EID_WPA2, len, pie+2, &(pattrib->pktlen)); } else return _FAIL; return _SUCCESS; } static u8 rtw_ft_update_mdie( _adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) { struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); u8 *pie, mdie[3]; u32 len = 3; if (rtw_ft_roam(padapter)) { if ((pie = rtw_get_ie(pft_roam->updated_ft_ies, _MDIE_, &len, pft_roam->updated_ft_ies_len))) { pie = (pie + 2); /* ignore md-id & length */ } else return _FAIL; } else { *((u16 *)&mdie[0]) = pft_roam->mdid; mdie[2] = pft_roam->ft_cap; pie = &mdie[0]; } *pframe = rtw_set_ie(((u8 *)*pframe), _MDIE_, len , pie, &(pattrib->pktlen)); return _SUCCESS; } static u8 rtw_ft_update_ftie( _adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) { struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); u8 *pie; u32 len; if ((pie = rtw_get_ie(pft_roam->updated_ft_ies, _FTIE_, &len, pft_roam->updated_ft_ies_len)) != NULL) { *pframe = rtw_set_ie(*pframe, _FTIE_, len , (pie+2), &(pattrib->pktlen)); } else return _FAIL; return _SUCCESS; } void rtw_ft_build_auth_req_ies(_adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) { u8 ftie_append = _TRUE; if (!pattrib || !(*pframe)) return; if (!rtw_ft_roam(padapter)) return; ftie_append = rtw_ft_update_rsnie(padapter, _TRUE, pattrib, pframe); rtw_ft_update_mdie(padapter, pattrib, pframe); if (ftie_append) rtw_ft_update_ftie(padapter, pattrib, pframe); } void rtw_ft_build_assoc_req_ies(_adapter *padapter, u8 is_reassoc, struct pkt_attrib *pattrib, u8 **pframe) { if (!pattrib || !(*pframe)) return; if (rtw_ft_chk_flags(padapter, RTW_FT_PEER_EN)) rtw_ft_update_mdie(padapter, pattrib, pframe); if ((!is_reassoc) || (!rtw_ft_roam(padapter))) return; if (rtw_ft_update_rsnie(padapter, _FALSE, pattrib, pframe)) rtw_ft_update_ftie(padapter, pattrib, pframe); } u8 rtw_ft_update_auth_rsp_ies(_adapter *padapter, u8 *pframe, u32 len) { u8 ret = _SUCCESS; u8 target_ap_addr[ETH_ALEN] = {0}; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); if (!rtw_ft_roam(padapter)) return _FAIL; /*rtw_ft_report_reassoc_evt already, * and waiting for cfg80211_rtw_update_ft_ies */ if (rtw_ft_authed_sta(padapter)) return ret; if (!pframe || !len) return _FAIL; rtw_buf_update(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len, pframe, len); pft_roam->ft_event.ies = (pmlmepriv->auth_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6); pft_roam->ft_event.ies_len = (pmlmepriv->auth_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6); /*Not support RIC*/ pft_roam->ft_event.ric_ies = NULL; pft_roam->ft_event.ric_ies_len = 0; _rtw_memcpy(target_ap_addr, pmlmepriv->assoc_bssid, ETH_ALEN); rtw_ft_report_reassoc_evt(padapter, target_ap_addr); return ret; } static void rtw_ft_start_clnt_action(_adapter *padapter, u8 *pTargetAddr) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; rtw_ft_set_status(padapter, RTW_FT_REQUESTING_STA); rtw_ft_issue_action_req(padapter, pTargetAddr); _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); } void rtw_ft_start_roam(_adapter *padapter, u8 *pTargetAddr) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; if (rtw_ft_otd_roam(padapter)) { RTW_FT_INFO("%s : try OTD roaming\n", __func__); rtw_ft_start_clnt_action(padapter, pTargetAddr); } else { /*wait a little time to retrieve packets buffered in the current ap while scan*/ RTW_FT_INFO("%s : start roaming timer\n", __func__); _set_timer(&pmlmeext->ft_roam_timer, 30); } } void rtw_ft_issue_action_req(_adapter *padapter, u8 *pTargetAddr) { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct xmit_frame *pmgntframe; struct rtw_ieee80211_hdr *pwlanhdr; struct pkt_attrib *pattrib; u8 *pframe; u8 category = RTW_WLAN_CATEGORY_FT; u8 action = RTW_WLAN_ACTION_FT_REQ; pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) return; 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; pwlanhdr->frame_ctl = 0; _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), 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++; set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); _rtw_memcpy(pframe, adapter_mac_addr(padapter), ETH_ALEN); pframe += ETH_ALEN; pattrib->pktlen += ETH_ALEN; _rtw_memcpy(pframe, pTargetAddr, ETH_ALEN); pframe += ETH_ALEN; pattrib->pktlen += ETH_ALEN; rtw_ft_update_mdie(padapter, pattrib, &pframe); if (rtw_ft_update_rsnie(padapter, _TRUE, pattrib, &pframe)) rtw_ft_update_ftie(padapter, pattrib, &pframe); RTW_INFO("FT : issue RTW_WLAN_ACTION_FT_REQ\n"); pattrib->last_txcmdsz = pattrib->pktlen; dump_mgntframe(padapter, pmgntframe); } void rtw_ft_report_evt(_adapter *padapter) { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&(pmlmeinfo->network); struct cfg80211_ft_event_params ft_evt_parms; _irqL irqL; _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); rtw_ft_update_stainfo(padapter, pnetwork); if (!pnetwork) goto err_2; ft_evt_parms.ies_len = pft_roam->ft_event.ies_len; ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); if (ft_evt_parms.ies) _rtw_memcpy((void *)ft_evt_parms.ies, pft_roam->ft_event.ies, ft_evt_parms.ies_len); else goto err_2; ft_evt_parms.target_ap = rtw_zmalloc(ETH_ALEN); if (ft_evt_parms.target_ap) _rtw_memcpy((void *)ft_evt_parms.target_ap, pnetwork->MacAddress, ETH_ALEN); else goto err_1; ft_evt_parms.ric_ies = pft_roam->ft_event.ric_ies; ft_evt_parms.ric_ies_len = pft_roam->ft_event.ric_ies_len; /* It's a KERNEL issue between v4.11 ~ v4.16, * <= v4.10, NLMSG_DEFAULT_SIZE is used for nlmsg_new(). * v4.11 ~ v4.16, only used "100 + >ric_ies_len" for nlmsg_new() * even then DRIVER don't support RIC. * >= v4.17, issue should correct as "100 + ies_len + ric_ies_len". */ #if ((LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) && \ (LINUX_VERSION_CODE < KERNEL_VERSION(4, 17, 0))) ft_evt_parms.ric_ies_len = (ft_evt_parms.ies_len <= 100 )? (0):(ft_evt_parms.ies_len - 100); #endif rtw_ft_lock_set_status(padapter, RTW_FT_AUTHENTICATED_STA, &irqL); rtw_cfg80211_ft_event(padapter, &ft_evt_parms); RTW_INFO("FT: rtw_ft_report_evt\n"); rtw_mfree((u8 *)pft_roam->ft_event.target_ap, ETH_ALEN); err_1: rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); err_2: return; } void rtw_ft_report_reassoc_evt(_adapter *padapter, u8 *pMacAddr) { struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); struct cmd_obj *pcmd_obj = NULL; struct stassoc_event *passoc_sta_evt = NULL; struct rtw_evt_header *evt_hdr = NULL; u8 *pevtcmd = NULL; u32 cmdsz = 0; pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); if (pcmd_obj == NULL) return; cmdsz = (sizeof(struct stassoc_event) + sizeof(struct rtw_evt_header)); pevtcmd = (u8 *)rtw_zmalloc(cmdsz); if (pevtcmd == NULL) { rtw_mfree((u8 *)pcmd_obj, sizeof(struct cmd_obj)); return; } _rtw_init_listhead(&pcmd_obj->list); pcmd_obj->cmdcode = CMD_SET_MLME_EVT; pcmd_obj->cmdsz = cmdsz; pcmd_obj->parmbuf = pevtcmd; pcmd_obj->rsp = NULL; pcmd_obj->rspsz = 0; evt_hdr = (struct rtw_evt_header *)(pevtcmd); evt_hdr->len = sizeof(struct stassoc_event); evt_hdr->id = EVT_FT_REASSOC; evt_hdr->seq = ATOMIC_INC_RETURN(&pmlmeext->event_seq); passoc_sta_evt = (struct stassoc_event *)(pevtcmd + sizeof(struct rtw_evt_header)); _rtw_memcpy((unsigned char *)(&(passoc_sta_evt->macaddr)), pMacAddr, ETH_ALEN); rtw_enqueue_cmd(pcmdpriv, pcmd_obj); } void rtw_ft_link_timer_hdl(void *ctx) { _adapter *padapter = (_adapter *)ctx; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); if (rtw_ft_chk_status(padapter, RTW_FT_REQUESTING_STA)) { if (pft_roam->ft_req_retry_cnt < RTW_FT_ACTION_REQ_LMT) { pft_roam->ft_req_retry_cnt++; rtw_ft_issue_action_req(padapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); } else { pft_roam->ft_req_retry_cnt = 0; if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) rtw_ft_set_status(padapter, RTW_FT_ASSOCIATED_STA); else rtw_ft_reset_status(padapter); } } } void rtw_ft_roam_timer_hdl(void *ctx) { _adapter *padapter = (_adapter *)ctx; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); RTW_FT_INFO("%s : try roaming\n", __func__); receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress , WLAN_REASON_ACTIVE_ROAM, _FALSE); } void rtw_ft_roam_status_reset(_adapter *padapter) { struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); if ((rtw_to_roam(padapter) > 0) && (!rtw_ft_chk_status(padapter, RTW_FT_REQUESTED_STA))) { rtw_ft_reset_status(padapter); } padapter->mlmepriv.ft_roam.ft_updated_bcn = _FALSE; } #endif /* CONFIG_RTW_80211R */