--- /dev/null
+/******************************************************************************
+ *
+ * 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 <drv_types.h>
+#include <hal_data.h>
+#include "rtw_rm_fsm.h"
+
+#define pstr(s) s+strlen(s)
+
+u8 rm_post_event_hdl(_adapter *padapter, u8 *pbuf)
+{
+#ifdef CONFIG_RTW_80211K
+ struct rm_event *pev = (struct rm_event *)pbuf;
+
+ _rm_post_event(padapter, pev->rmid, pev->evid);
+ rm_handler(padapter, pev);
+#endif
+ return H2C_SUCCESS;
+}
+
+#ifdef CONFIG_RTW_80211K
+
+/* 802.11-2012 Table E-1 Operationg classes in United States */
+static RT_OPERATING_CLASS RTW_OP_CLASS_US[] = {
+ /* 0, OP_CLASS_NULL */ { 0, 0, {}},
+ /* 1, OP_CLASS_1 */ {115, 4, {36, 40, 44, 48}},
+ /* 2, OP_CLASS_2 */ {118, 4, {52, 56, 60, 64}},
+ /* 3, OP_CLASS_3 */ {124, 4, {149, 153, 157, 161}},
+ /* 4, OP_CLASS_4 */ {121, 11, {100, 104, 108, 112, 116, 120, 124,
+ 128, 132, 136, 140}},
+ /* 5, OP_CLASS_5 */ {125, 5, {149, 153, 157, 161, 165}},
+ /* 6, OP_CLASS_12 */ { 81, 11, {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}}
+};
+
+struct cmd_meas_type_ {
+ u8 id;
+ char *name;
+};
+
+char *rm_type_req_name(u8 meas_type) {
+
+ switch (meas_type) {
+ case basic_req:
+ return "basic_req";
+ case cca_req:
+ return "cca_req";
+ case rpi_histo_req:
+ return "rpi_histo_req";
+ case ch_load_req:
+ return "ch_load_req";
+ case noise_histo_req:
+ return "noise_histo_req";
+ case bcn_req:
+ return "bcn_req";
+ case frame_req:
+ return "frame_req";
+ case sta_statis_req:
+ return "sta_statis_req";
+ }
+ return "unknown_req";
+};
+
+char *rm_type_rep_name(u8 meas_type) {
+
+ switch (meas_type) {
+ case basic_rep:
+ return "basic_rep";
+ case cca_rep:
+ return "cca_rep";
+ case rpi_histo_rep:
+ return "rpi_histo_rep";
+ case ch_load_rep:
+ return "ch_load_rep";
+ case noise_histo_rep:
+ return "noise_histo_rep";
+ case bcn_rep:
+ return "bcn_rep";
+ case frame_rep:
+ return "frame_rep";
+ case sta_statis_rep:
+ return "sta_statis_rep";
+ }
+ return "unknown_rep";
+};
+
+char *rm_en_cap_name(enum rm_cap_en en)
+{
+ switch (en) {
+ case RM_LINK_MEAS_CAP_EN:
+ return "RM_LINK_MEAS_CAP_EN";
+ case RM_NB_REP_CAP_EN:
+ return "RM_NB_REP_CAP_EN";
+ case RM_PARAL_MEAS_CAP_EN:
+ return "RM_PARAL_MEAS_CAP_EN";
+ case RM_REPEAT_MEAS_CAP_EN:
+ return "RM_REPEAT_MEAS_CAP_EN";
+ case RM_BCN_PASSIVE_MEAS_CAP_EN:
+ return "RM_BCN_PASSIVE_MEAS_CAP_EN";
+ case RM_BCN_ACTIVE_MEAS_CAP_EN:
+ return "RM_BCN_ACTIVE_MEAS_CAP_EN";
+ case RM_BCN_TABLE_MEAS_CAP_EN:
+ return "RM_BCN_TABLE_MEAS_CAP_EN";
+ case RM_BCN_MEAS_REP_COND_CAP_EN:
+ return "RM_BCN_MEAS_REP_COND_CAP_EN";
+
+ case RM_FRAME_MEAS_CAP_EN:
+ return "RM_FRAME_MEAS_CAP_EN";
+ case RM_CH_LOAD_CAP_EN:
+ return "RM_CH_LOAD_CAP_EN";
+ case RM_NOISE_HISTO_CAP_EN:
+ return "RM_NOISE_HISTO_CAP_EN";
+ case RM_STATIS_MEAS_CAP_EN:
+ return "RM_STATIS_MEAS_CAP_EN";
+ case RM_LCI_MEAS_CAP_EN:
+ return "RM_LCI_MEAS_CAP_EN";
+ case RM_LCI_AMIMUTH_CAP_EN:
+ return "RM_LCI_AMIMUTH_CAP_EN";
+ case RM_TRANS_STREAM_CAT_MEAS_CAP_EN:
+ return "RM_TRANS_STREAM_CAT_MEAS_CAP_EN";
+ case RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN:
+ return "RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN";
+
+ case RM_AP_CH_REP_CAP_EN:
+ return "RM_AP_CH_REP_CAP_EN";
+ case RM_RM_MIB_CAP_EN:
+ return "RM_RM_MIB_CAP_EN";
+ case RM_OP_CH_MAX_MEAS_DUR0:
+ return "RM_OP_CH_MAX_MEAS_DUR0";
+ case RM_OP_CH_MAX_MEAS_DUR1:
+ return "RM_OP_CH_MAX_MEAS_DUR1";
+ case RM_OP_CH_MAX_MEAS_DUR2:
+ return "RM_OP_CH_MAX_MEAS_DUR2";
+ case RM_NONOP_CH_MAX_MEAS_DUR0:
+ return "RM_NONOP_CH_MAX_MEAS_DUR0";
+ case RM_NONOP_CH_MAX_MEAS_DUR1:
+ return "RM_NONOP_CH_MAX_MEAS_DUR1";
+ case RM_NONOP_CH_MAX_MEAS_DUR2:
+ return "RM_NONOP_CH_MAX_MEAS_DUR2";
+
+ case RM_MEAS_PILOT_CAP0:
+ return "RM_MEAS_PILOT_CAP0"; /* 24-26 */
+ case RM_MEAS_PILOT_CAP1:
+ return "RM_MEAS_PILOT_CAP1";
+ case RM_MEAS_PILOT_CAP2:
+ return "RM_MEAS_PILOT_CAP2";
+ case RM_MEAS_PILOT_TRANS_INFO_CAP_EN:
+ return "RM_MEAS_PILOT_TRANS_INFO_CAP_EN";
+ case RM_NB_REP_TSF_OFFSET_CAP_EN:
+ return "RM_NB_REP_TSF_OFFSET_CAP_EN";
+ case RM_RCPI_MEAS_CAP_EN:
+ return "RM_RCPI_MEAS_CAP_EN"; /* 29 */
+ case RM_RSNI_MEAS_CAP_EN:
+ return "RM_RSNI_MEAS_CAP_EN";
+ case RM_BSS_AVG_ACCESS_DELAY_CAP_EN:
+ return "RM_BSS_AVG_ACCESS_DELAY_CAP_EN";
+
+ case RM_AVALB_ADMIS_CAPACITY_CAP_EN:
+ return "RM_AVALB_ADMIS_CAPACITY_CAP_EN";
+ case RM_ANT_CAP_EN:
+ return "RM_ANT_CAP_EN";
+ case RM_RSVD:
+ case RM_MAX:
+ default:
+ break;
+ }
+ return "unknown";
+}
+
+int rm_en_cap_chk_and_set(struct rm_obj *prm, enum rm_cap_en en)
+{
+ int idx;
+ u8 cap;
+
+
+ if (en >= RM_MAX)
+ return _FALSE;
+
+ idx = en / 8;
+ cap = prm->psta->padapter->rmpriv.rm_en_cap_def[idx];
+
+ if (!(cap & BIT(en - (idx*8)))) {
+ RTW_INFO("RM: %s incapable\n",rm_en_cap_name(en));
+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP);
+ return _FALSE;
+ }
+ return _SUCCESS;
+}
+
+static u8 rm_get_oper_class_via_ch(u8 ch)
+{
+ int i,j,sz;
+
+
+ sz = sizeof(RTW_OP_CLASS_US)/sizeof(struct _RT_OPERATING_CLASS);
+
+ for (i = 0; i < sz; i++) {
+ for (j = 0; j < RTW_OP_CLASS_US[i].Len; j++) {
+ if ( ch == RTW_OP_CLASS_US[i].Channel[j]) {
+ RTW_INFO("RM: ch %u in oper_calss %u\n",
+ ch, RTW_OP_CLASS_US[i].global_op_class);
+ return RTW_OP_CLASS_US[i].global_op_class;
+ break;
+ }
+ }
+ }
+ return 0;
+}
+
+static u8 rm_get_ch_set(
+ struct rtw_ieee80211_channel *pch_set, u8 op_class, u8 ch_num)
+{
+ int i,j,sz;
+ u8 ch_amount = 0;
+
+
+ sz = sizeof(RTW_OP_CLASS_US)/sizeof(struct _RT_OPERATING_CLASS);
+
+ if (ch_num != 0) {
+ pch_set[0].hw_value = ch_num;
+ ch_amount = 1;
+ RTW_INFO("RM: meas_ch->hw_value = %u\n", pch_set->hw_value);
+ goto done;
+ }
+
+ for (i = 0; i < sz; i++) {
+
+ if (RTW_OP_CLASS_US[i].global_op_class == op_class) {
+
+ for (j = 0; j < RTW_OP_CLASS_US[i].Len; j++) {
+ pch_set[j].hw_value =
+ RTW_OP_CLASS_US[i].Channel[j];
+ RTW_INFO("RM: meas_ch[%d].hw_value = %u\n",
+ j, pch_set[j].hw_value);
+ }
+ ch_amount = RTW_OP_CLASS_US[i].Len;
+ break;
+ }
+ }
+done:
+ return ch_amount;
+}
+
+static int is_wildcard_bssid(u8 *bssid)
+{
+ int i;
+ u8 val8 = 0xff;
+
+
+ for (i=0;i<6;i++)
+ val8 &= bssid[i];
+
+ if (val8 == 0xff)
+ return _SUCCESS;
+ return _FALSE;
+}
+
+/* for caller outside rm */
+u8 rm_add_nb_req(_adapter *padapter, struct sta_info *psta)
+{
+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
+ struct rm_obj *prm;
+
+
+ prm = rm_alloc_rmobj(padapter);
+
+ if (prm == NULL) {
+ RTW_ERR("RM: unable to alloc rm obj for requeset\n");
+ return _FALSE;
+ }
+
+ prm->psta = psta;
+ prm->q.category = RTW_WLAN_CATEGORY_RADIO_MEAS;
+ prm->q.diag_token = pmlmeinfo->dialogToken++;
+ prm->q.m_token = 1;
+
+ prm->rmid = psta->cmn.aid << 16
+ | prm->q.diag_token << 8
+ | RM_MASTER;
+
+ prm->q.action_code = RM_ACT_NB_REP_REQ;
+
+ #if 0
+ if (pmac) { /* find sta_info according to bssid */
+ pmac += 4; /* skip mac= */
+ if (hwaddr_parse(pmac, bssid) == NULL) {
+ sprintf(pstr(s), "Err: \nincorrect mac format\n");
+ return _FAIL;
+ }
+ psta = rm_get_sta(padapter, 0xff, bssid);
+ }
+ #endif
+
+ /* enquee rmobj */
+ rm_enqueue_rmobj(padapter, prm, _FALSE);
+
+ RTW_INFO("RM: rmid=%x add req to " MAC_FMT "\n",
+ prm->rmid, MAC_ARG(psta->cmn.mac_addr));
+
+ return _SUCCESS;
+}
+
+
+static u8 *build_wlan_hdr(_adapter *padapter, struct xmit_frame *pmgntframe,
+ struct sta_info *psta, u16 frame_type)
+{
+ u8 *pframe;
+ u16 *fctrl;
+ struct pkt_attrib *pattr;
+ struct rtw_ieee80211_hdr *pwlanhdr;
+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
+ struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
+
+
+ /* update attribute */
+ pattr = &pmgntframe->attrib;
+ update_mgntframe_attrib(padapter, pattr);
+
+ _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;
+
+ _rtw_memcpy(pwlanhdr->addr1, psta->cmn.mac_addr, ETH_ALEN);
+ _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN);
+ _rtw_memcpy(pwlanhdr->addr3,
+ get_my_bssid(&(pmlmeinfo->network)),ETH_ALEN);
+
+ RTW_INFO("RM: dst = " MAC_FMT "\n", MAC_ARG(pwlanhdr->addr1));
+
+ SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq);
+ pmlmeext->mgnt_seq++;
+ SetFragNum(pframe, 0);
+
+ set_frame_sub_type(pframe, WIFI_ACTION);
+
+ pframe += sizeof(struct rtw_ieee80211_hdr_3addr);
+ pattr->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr);
+
+ return pframe;
+}
+
+void rm_set_rep_mode(struct rm_obj *prm, u8 mode)
+{
+
+ RTW_INFO("RM: rmid=%x set %s\n",
+ prm->rmid,
+ mode|MEAS_REP_MOD_INCAP?"INCAP":
+ mode|MEAS_REP_MOD_REFUSE?"REFUSE":
+ mode|MEAS_REP_MOD_LATE?"LATE":"");
+
+ prm->p.m_mode |= mode;
+}
+
+int issue_null_reply(struct rm_obj *prm)
+{
+ int len=0, my_len;
+ u8 *pframe, m_mode;
+ _adapter *padapter = prm->psta->padapter;
+ struct pkt_attrib *pattr;
+ struct xmit_frame *pmgntframe;
+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
+
+
+ m_mode = prm->p.m_mode;
+ if (m_mode || prm->p.rpt == 0) {
+ RTW_INFO("RM: rmid=%x reply (%s repeat=%d)\n",
+ prm->rmid,
+ m_mode&MEAS_REP_MOD_INCAP?"INCAP":
+ m_mode&MEAS_REP_MOD_REFUSE?"REFUSE":
+ m_mode&MEAS_REP_MOD_LATE?"LATE":"no content",
+ prm->p.rpt);
+ }
+
+ switch (prm->p.action_code) {
+ case RM_ACT_RADIO_MEAS_REQ:
+ len = 8;
+ break;
+ case RM_ACT_NB_REP_REQ:
+ len = 3;
+ break;
+ case RM_ACT_LINK_MEAS_REQ:
+ len = 3;
+ break;
+ default:
+ break;
+ }
+
+ if (len==0)
+ return _FALSE;
+
+ pmgntframe = alloc_mgtxmitframe(pxmitpriv);
+ if (pmgntframe == NULL) {
+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__);
+ return _FALSE;
+ }
+ pattr = &pmgntframe->attrib;
+ pframe = build_wlan_hdr(padapter, pmgntframe, prm->psta, WIFI_ACTION);
+ pframe = rtw_set_fixed_ie(pframe, 3, &prm->p.category, &pattr->pktlen);
+
+ my_len = 0;
+ if (len>5) {
+ prm->p.len = len - 3 - 2;
+ pframe = rtw_set_fixed_ie(pframe, len - 3,
+ &prm->p.e_id, &my_len);
+ }
+
+ pattr->pktlen += my_len;
+ pattr->last_txcmdsz = pattr->pktlen;
+ dump_mgntframe(padapter, pmgntframe);
+
+ return _SUCCESS;
+}
+
+int ready_for_scan(struct rm_obj *prm)
+{
+ _adapter *padapter = prm->psta->padapter;
+ u8 ssc_chk;
+
+ if (!rtw_is_adapter_up(padapter))
+ return _FALSE;
+
+ ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE);
+
+ if (ssc_chk == SS_ALLOW)
+ return _SUCCESS;
+
+ return _FALSE;
+}
+
+int rm_sitesurvey(struct rm_obj *prm)
+{
+ int meas_ch_num=0;
+ u8 ch_num=0, op_class=0, val8;
+ struct rtw_ieee80211_channel *pch_set;
+ struct sitesurvey_parm parm;
+
+
+ RTW_INFO("RM: rmid=%x %s\n",prm->rmid, __func__);
+
+ pch_set = &prm->q.ch_set[0];
+
+ _rtw_memset(pch_set, 0,
+ sizeof(struct rtw_ieee80211_channel) * MAX_OP_CHANNEL_SET_NUM);
+
+ if (prm->q.ch_num == 0) {
+ /* ch_num=0 : scan all ch in operating class */
+ op_class = prm->q.op_class;
+
+ } else if (prm->q.ch_num == 255) {
+ /* 802.11 p.499 */
+ /* ch_num=255 : scan all ch in current operating class */
+ op_class = rm_get_oper_class_via_ch(
+ (u8)prm->psta->padapter->mlmeextpriv.cur_channel);
+ } else
+ ch_num = prm->q.ch_num;
+
+ /* get means channel */
+ meas_ch_num = rm_get_ch_set(pch_set, op_class, ch_num);
+ prm->q.ch_set_ch_amount = meas_ch_num;
+
+ _rtw_memset(&parm, 0, sizeof(struct sitesurvey_parm));
+ _rtw_memcpy(parm.ch, pch_set,
+ sizeof(struct rtw_ieee80211_channel) * MAX_OP_CHANNEL_SET_NUM);
+
+ _rtw_memcpy(&parm.ssid[0], &prm->q.opt.bcn.ssid, IW_ESSID_MAX_SIZE);
+
+ parm.ssid_num = 1;
+ parm.scan_mode = prm->q.m_mode;
+ parm.ch_num = meas_ch_num;
+ parm.igi = 0;
+ parm.token = prm->rmid;
+ parm.duration = prm->q.meas_dur;
+ /* parm.bw = BW_20M; */
+
+ rtw_sitesurvey_cmd(prm->psta->padapter, &parm);
+
+ return _SUCCESS;
+}
+
+static u8 translate_percentage_to_rcpi(u32 SignalStrengthIndex)
+{
+ s32 SignalPower; /* in dBm. */
+ u8 rcpi;
+
+ /* Translate to dBm (x=y-100) */
+ SignalPower = SignalStrengthIndex - 100;
+
+ /* RCPI = Int{(Power in dBm + 110)*2} for 0dBm > Power > -110dBm
+ * 0 : power <= -110.0 dBm
+ * 1 : power = -109.5 dBm
+ * 2 : power = -109.0 dBm
+ */
+
+ rcpi = (SignalPower + 110)*2;
+ return rcpi;
+}
+
+static int rm_parse_ch_load_s_elem(struct rm_obj *prm, u8 *pbody, int req_len)
+{
+ u8 *popt_id;
+ int i, p=0; /* position */
+ int len = req_len;
+
+
+ prm->q.opt_s_elem_len = len;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: opt_s_elem_len=%d\n", len);
+#endif
+ while (len) {
+
+ switch (pbody[p]) {
+ case ch_load_rep_info:
+ /* check RM_EN */
+ rm_en_cap_chk_and_set(prm, RM_CH_LOAD_CAP_EN);
+
+ _rtw_memcpy(&(prm->q.opt.clm.rep_cond),
+ &pbody[p+2], sizeof(prm->q.opt.clm.rep_cond));
+
+ RTW_INFO("RM: ch_load_rep_info=%u:%u\n",
+ prm->q.opt.clm.rep_cond.cond,
+ prm->q.opt.clm.rep_cond.threshold);
+ break;
+ default:
+ break;
+
+ }
+ len = len - (int)pbody[p+1] - 2;
+ p = p + (int)pbody[p+1] + 2;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: opt_s_elem_len=%d\n",len);
+#endif
+ }
+ return _SUCCESS;
+}
+
+static int rm_parse_noise_histo_s_elem(struct rm_obj *prm,
+ u8 *pbody, int req_len)
+{
+ u8 *popt_id;
+ int i, p=0; /* position */
+ int len = req_len;
+
+
+ prm->q.opt_s_elem_len = len;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: opt_s_elem_len=%d\n", len);
+#endif
+
+ while (len) {
+
+ switch (pbody[p]) {
+ case noise_histo_rep_info:
+ /* check RM_EN */
+ rm_en_cap_chk_and_set(prm, RM_NOISE_HISTO_CAP_EN);
+
+ _rtw_memcpy(&(prm->q.opt.nhm.rep_cond),
+ &pbody[p+2], sizeof(prm->q.opt.nhm.rep_cond));
+
+ RTW_INFO("RM: noise_histo_rep_info=%u:%u\n",
+ prm->q.opt.nhm.rep_cond.cond,
+ prm->q.opt.nhm.rep_cond.threshold);
+ break;
+ default:
+ break;
+
+ }
+ len = len - (int)pbody[p+1] - 2;
+ p = p + (int)pbody[p+1] + 2;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: opt_s_elem_len=%d\n",len);
+#endif
+ }
+ return _SUCCESS;
+}
+
+static int rm_parse_bcn_req_s_elem(struct rm_obj *prm, u8 *pbody, int req_len)
+{
+ u8 *popt_id;
+ int i, p=0; /* position */
+ int len = req_len;
+
+
+ /* opt length,2:pbody[0]+ pbody[1] */
+ /* first opt id : pbody[18] */
+
+ prm->q.opt_s_elem_len = len;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: opt_s_elem_len=%d\n", len);
+#endif
+
+ popt_id = prm->q.opt.bcn.opt_id;
+ while (len && prm->q.opt.bcn.opt_id_num < BCN_REQ_OPT_MAX_NUM) {
+
+ switch (pbody[p]) {
+ case bcn_req_ssid:
+ RTW_INFO("bcn_req_ssid\n");
+
+#if (DBG_BCN_REQ_WILDCARD)
+ RTW_INFO("DBG set ssid to WILDCARD\n");
+#else
+#if (DBG_BCN_REQ_SSID)
+ RTW_INFO("DBG set ssid to %s\n",DBG_BCN_REQ_SSID_NAME);
+ i = strlen(DBG_BCN_REQ_SSID_NAME);
+ prm->q.opt.bcn.ssid.SsidLength = i;
+ _rtw_memcpy(&(prm->q.opt.bcn.ssid.Ssid),
+ DBG_BCN_REQ_SSID_NAME, i);
+
+#else /* original */
+ prm->q.opt.bcn.ssid.SsidLength = pbody[p+1];
+ _rtw_memcpy(&(prm->q.opt.bcn.ssid.Ssid),
+ &pbody[p+2], pbody[p+1]);
+#endif
+#endif
+
+ RTW_INFO("RM: bcn_req_ssid=%s\n",
+ prm->q.opt.bcn.ssid.Ssid);
+
+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];
+ break;
+
+ case bcn_req_rep_info:
+ /* check RM_EN */
+ rm_en_cap_chk_and_set(prm, RM_BCN_MEAS_REP_COND_CAP_EN);
+
+ _rtw_memcpy(&(prm->q.opt.bcn.rep_cond),
+ &pbody[p+2], sizeof(prm->q.opt.bcn.rep_cond));
+
+ RTW_INFO("bcn_req_rep_info=%u:%u\n",
+ prm->q.opt.bcn.rep_cond.cond,
+ prm->q.opt.bcn.rep_cond.threshold);
+
+ /*popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];*/
+ break;
+
+ case bcn_req_rep_detail:
+#if DBG_BCN_REQ_DETAIL
+ prm->q.opt.bcn.rep_detail = 2; /* all IE in beacon */
+#else
+ prm->q.opt.bcn.rep_detail = pbody[p+2];
+#endif
+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];
+
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: report_detail=%d\n",
+ prm->q.opt.bcn.rep_detail);
+#endif
+ break;
+
+ case bcn_req_req:
+ RTW_INFO("RM: bcn_req_req\n");
+
+ prm->q.opt.bcn.req_start = rtw_malloc(pbody[p+1]);
+
+ if (prm->q.opt.bcn.req_start == NULL) {
+ RTW_ERR("RM: req_start malloc fail!!\n");
+ break;
+ }
+
+ for (i = 0; i < pbody[p+1]; i++)
+ *((prm->q.opt.bcn.req_start)+i) =
+ pbody[p+2+i];
+
+ prm->q.opt.bcn.req_len = pbody[p+1];
+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];
+ break;
+
+ case bcn_req_ac_ch_rep:
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: bcn_req_ac_ch_rep\n");
+#endif
+ popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];
+ break;
+
+ default:
+ break;
+
+ }
+ len = len - (int)pbody[p+1] - 2;
+ p = p + (int)pbody[p+1] + 2;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: opt_s_elem_len=%d\n",len);
+#endif
+ }
+
+ return _SUCCESS;
+}
+
+static int rm_parse_meas_req(struct rm_obj *prm, u8 *pbody)
+{
+ int p; /* position */
+ int req_len;
+
+
+ req_len = (int)pbody[1];
+ p = 5;
+
+ prm->q.op_class = pbody[p++];
+ prm->q.ch_num = pbody[p++];
+ prm->q.rand_intvl = le16_to_cpu(*(u16*)(&pbody[p]));
+ p+=2;
+ prm->q.meas_dur = le16_to_cpu(*(u16*)(&pbody[p]));
+ p+=2;
+
+ if (prm->q.m_type == bcn_req) {
+ /*
+ * 0: passive
+ * 1: active
+ * 2: bcn_table
+ */
+ prm->q.m_mode = pbody[p++];
+
+ /* BSSID */
+ _rtw_memcpy(&(prm->q.bssid), &pbody[p], 6);
+ p+=6;
+
+ /*
+ * default, used when Reporting detail subelement
+ * is not included in Beacon Request
+ */
+ prm->q.opt.bcn.rep_detail = 2;
+ }
+
+ if (req_len-(p-2) <= 0) /* without sub-element */
+ return _SUCCESS;
+
+ switch (prm->q.m_type) {
+ case bcn_req:
+ rm_parse_bcn_req_s_elem(prm, &pbody[p], req_len-(p-2));
+ break;
+ case ch_load_req:
+ rm_parse_ch_load_s_elem(prm, &pbody[p], req_len-(p-2));
+ break;
+ case noise_histo_req:
+ rm_parse_noise_histo_s_elem(prm, &pbody[p], req_len-(p-2));
+ break;
+ default:
+ break;
+ }
+
+ return _SUCCESS;
+}
+
+/* receive measurement request */
+int rm_recv_radio_mens_req(_adapter *padapter,
+ union recv_frame *precv_frame, struct sta_info *psta)
+{
+ struct rm_obj *prm;
+ struct rm_priv *prmpriv = &padapter->rmpriv;
+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data +
+ sizeof(struct rtw_ieee80211_hdr_3addr));
+ u8 *pmeas_body = &pdiag_body[5];
+ u8 rmid, update = 0;
+
+
+#if 0
+ /* search existing rm_obj */
+ rmid = psta->cmn.aid << 16
+ | pdiag_body[2] << 8
+ | RM_SLAVE;
+
+ prm = rm_get_rmobj(padapter, rmid);
+ if (prm) {
+ RTW_INFO("RM: Found an exist meas rmid=%u\n", rmid);
+ update = 1;
+ } else
+#endif
+ prm = rm_alloc_rmobj(padapter);
+
+ if (prm == NULL) {
+ RTW_ERR("RM: unable to alloc rm obj for requeset\n");
+ return _FALSE;
+ }
+
+ prm->psta = psta;
+ prm->q.diag_token = pdiag_body[2];
+ prm->q.rpt = le16_to_cpu(*(u16*)(&pdiag_body[3]));
+
+ /* Figure 8-104 Measurement Requested format */
+ prm->q.e_id = pmeas_body[0];
+ prm->q.m_token = pmeas_body[2];
+ prm->q.m_mode = pmeas_body[3];
+ prm->q.m_type = pmeas_body[4];
+
+ prm->rmid = psta->cmn.aid << 16
+ | prm->q.diag_token << 8
+ | RM_SLAVE;
+
+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid,
+ MAC_ARG(prm->psta->cmn.mac_addr));
+
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: element_id = %d\n", prm->q.e_id);
+ RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]);
+ RTW_INFO("RM: meas_token = %d\n", prm->q.m_token);
+ RTW_INFO("RM: meas_mode = %d\n", prm->q.m_mode);
+ RTW_INFO("RM: meas_type = %d\n", prm->q.m_type);
+#endif
+
+ if (prm->q.e_id != _MEAS_REQ_IE_) /* 38 */
+ return _FALSE;
+
+ switch (prm->q.m_type) {
+ case bcn_req:
+ RTW_INFO("RM: recv beacon_request\n");
+ switch (prm->q.m_mode) {
+ case bcn_req_passive:
+ rm_en_cap_chk_and_set(prm, RM_BCN_PASSIVE_MEAS_CAP_EN);
+ break;
+ case bcn_req_active:
+ rm_en_cap_chk_and_set(prm, RM_BCN_ACTIVE_MEAS_CAP_EN);
+ break;
+ case bcn_req_bcn_table:
+ rm_en_cap_chk_and_set(prm, RM_BCN_TABLE_MEAS_CAP_EN);
+ break;
+ default:
+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP);
+ break;
+ }
+ break;
+ case ch_load_req:
+ RTW_INFO("RM: recv ch_load_request\n");
+ rm_en_cap_chk_and_set(prm, RM_CH_LOAD_CAP_EN);
+ break;
+ case noise_histo_req:
+ RTW_INFO("RM: recv noise_histogram_request\n");
+ rm_en_cap_chk_and_set(prm, RM_NOISE_HISTO_CAP_EN);
+ break;
+ default:
+ RTW_INFO("RM: recv unknown request type 0x%02x\n",
+ prm->q.m_type);
+ rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP);
+ goto done;
+ }
+ rm_parse_meas_req(prm, pmeas_body);
+done:
+ if (!update)
+ rm_enqueue_rmobj(padapter, prm, _FALSE);
+
+ return _SUCCESS;
+}
+
+/* receive measurement report */
+int rm_recv_radio_mens_rep(_adapter *padapter,
+ union recv_frame *precv_frame, struct sta_info *psta)
+{
+ int ret = _FALSE;
+ struct rm_obj *prm;
+ u32 rmid;
+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data +
+ sizeof(struct rtw_ieee80211_hdr_3addr));
+ u8 *pmeas_body = &pdiag_body[3];
+
+
+ rmid = psta->cmn.aid << 16
+ | pdiag_body[2] << 8
+ | RM_MASTER;
+
+ prm = rm_get_rmobj(padapter, rmid);
+ if (prm == NULL)
+ return _FALSE;
+
+ prm->p.action_code = pdiag_body[1];
+ prm->p.diag_token = pdiag_body[2];
+
+ /* Figure 8-140 Measuremnt Report format */
+ prm->p.e_id = pmeas_body[0];
+ prm->p.m_token = pmeas_body[2];
+ prm->p.m_mode = pmeas_body[3];
+ prm->p.m_type = pmeas_body[4];
+
+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid,
+ MAC_ARG(prm->psta->cmn.mac_addr));
+
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: element_id = %d\n", prm->p.e_id);
+ RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]);
+ RTW_INFO("RM: meas_token = %d\n", prm->p.m_token);
+ RTW_INFO("RM: meas_mode = %d\n", prm->p.m_mode);
+ RTW_INFO("RM: meas_type = %d\n", prm->p.m_type);
+#endif
+ if (prm->p.e_id != _MEAS_RSP_IE_) /* 39 */
+ return _FALSE;
+
+ RTW_INFO("RM: recv %s\n", rm_type_rep_name(prm->p.m_type));
+ rm_post_event(padapter, prm->rmid, RM_EV_recv_rep);
+
+ return ret;
+}
+
+int rm_radio_mens_nb_rep(_adapter *padapter,
+ union recv_frame *precv_frame, struct sta_info *psta)
+{
+ u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data +
+ sizeof(struct rtw_ieee80211_hdr_3addr));
+ u8 *pmeas_body = &pdiag_body[3];
+ u32 len = precv_frame->u.hdr.len;
+ u32 rmid;
+ struct rm_obj *prm;
+
+
+ rmid = psta->cmn.aid << 16
+ | pdiag_body[2] << 8
+ | RM_MASTER;
+
+ prm = rm_get_rmobj(padapter, rmid);
+ if (prm == NULL)
+ return _FALSE;
+
+ prm->p.action_code = pdiag_body[1];
+ prm->p.diag_token = pdiag_body[2];
+ prm->p.e_id = pmeas_body[0];
+
+ RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid,
+ MAC_ARG(prm->psta->cmn.mac_addr));
+
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: element_id = %d\n", prm->p.e_id);
+ RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]);
+#endif
+ rm_post_event(padapter, prm->rmid, RM_EV_recv_rep);
+
+#ifdef CONFIG_LAYER2_ROAMING
+ if (rtw_wnm_btm_candidates_survey(padapter
+ ,(pdiag_body + 3)
+ ,(len - sizeof(struct rtw_ieee80211_hdr_3addr))
+ ,_FALSE) == _FAIL)
+ return _FALSE;
+#endif
+ rtw_cfg80211_rx_rrm_action(padapter, precv_frame);
+
+ return _TRUE;
+}
+
+unsigned int rm_on_action(_adapter *padapter, union recv_frame *precv_frame)
+{
+ u32 ret = _FAIL;
+ u8 *pframe = NULL;
+ u8 *pframe_body = NULL;
+ u8 action_code = 0;
+ u8 diag_token = 0;
+ struct rtw_ieee80211_hdr_3addr *whdr;
+ struct sta_info *psta;
+
+
+ pframe = precv_frame->u.hdr.rx_data;
+
+ /* check RA matches or not */
+ if (!_rtw_memcmp(adapter_mac_addr(padapter),
+ GetAddr1Ptr(pframe), ETH_ALEN))
+ goto exit;
+
+ whdr = (struct rtw_ieee80211_hdr_3addr *)pframe;
+ RTW_INFO("RM: %s bssid = " MAC_FMT "\n",
+ __func__, MAC_ARG(whdr->addr2));
+
+ psta = rtw_get_stainfo(&padapter->stapriv, whdr->addr2);
+
+ if (!psta) {
+ RTW_ERR("RM: psta not found\n");
+ goto exit;
+ }
+
+ pframe_body = (unsigned char *)(pframe +
+ sizeof(struct rtw_ieee80211_hdr_3addr));
+
+ /* Figure 8-438 radio measurement request frame Action field format */
+ /* Category = pframe_body[0] = 5 (Radio Measurement) */
+ action_code = pframe_body[1];
+ diag_token = pframe_body[2];
+
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: %s radio_action=%x, diag_token=%x\n", __func__,
+ action_code, diag_token);
+#endif
+
+ switch (action_code) {
+
+ case RM_ACT_RADIO_MEAS_REQ:
+ RTW_INFO("RM: RM_ACT_RADIO_MEAS_REQ\n");
+ ret = rm_recv_radio_mens_req(padapter, precv_frame, psta);
+ break;
+
+ case RM_ACT_RADIO_MEAS_REP:
+ RTW_INFO("RM: RM_ACT_RADIO_MEAS_REP\n");
+ ret = rm_recv_radio_mens_rep(padapter, precv_frame, psta);
+ break;
+
+ case RM_ACT_LINK_MEAS_REQ:
+ RTW_INFO("RM: RM_ACT_LINK_MEAS_REQ\n");
+ break;
+
+ case RM_ACT_LINK_MEAS_REP:
+ RTW_INFO("RM: RM_ACT_LINK_MEAS_REP\n");
+ break;
+
+ case RM_ACT_NB_REP_REQ:
+ RTW_INFO("RM: RM_ACT_NB_REP_REQ\n");
+ break;
+
+ case RM_ACT_NB_REP_RESP:
+ RTW_INFO("RM: RM_ACT_NB_REP_RESP\n");
+ ret = rm_radio_mens_nb_rep(padapter, precv_frame, psta);
+ break;
+
+ default:
+ /* TODO reply incabable */
+ RTW_ERR("RM: unknown specturm management action %2x\n",
+ action_code);
+ break;
+ }
+exit:
+ return ret;
+}
+
+static u8 *rm_gen_bcn_detail_elem(_adapter *padapter, u8 *pframe,
+ struct rm_obj *prm, struct wlan_network *pnetwork,
+ unsigned int *fr_len)
+{
+ WLAN_BSSID_EX *pbss = &pnetwork->network;
+ unsigned int my_len;
+ int j, k, len;
+ u8 *plen;
+ u8 *ptr;
+ u8 val8, eid;
+
+
+ my_len = 0;
+ /* Reporting Detail values
+ * 0: No fixed length fields or elements
+ * 1: All fixed length fields and any requested elements
+ * in the Request info element if present
+ * 2: All fixed length fields and elements
+ * 3-255: Reserved
+ */
+
+ /* report_detail = 0 */
+ if (prm->q.opt.bcn.rep_detail == 0
+ || prm->q.opt.bcn.rep_detail > 2) {
+ return pframe;
+ }
+
+ /* ID */
+ val8 = 1; /* 1:reported frame body */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ plen = pframe;
+ val8 = 0;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* report_detail = 2 */
+ if (prm->q.opt.bcn.rep_detail == 2) {
+ pframe = rtw_set_fixed_ie(pframe, pbss->IELength - 4,
+ pbss->IEs, &my_len); /* -4 remove FCS */
+ goto done;
+ }
+
+ /* report_detail = 1 */
+ /* all fixed lenght fields */
+ pframe = rtw_set_fixed_ie(pframe,
+ _FIXED_IE_LENGTH_, pbss->IEs, &my_len);
+
+ for (j = 0; j < prm->q.opt.bcn.opt_id_num; j++) {
+ switch (prm->q.opt.bcn.opt_id[j]) {
+ case bcn_req_ssid:
+ /* SSID */
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: bcn_req_ssid\n");
+#endif
+ pframe = rtw_set_ie(pframe, _SSID_IE_,
+ pbss->Ssid.SsidLength,
+ pbss->Ssid.Ssid, &my_len);
+ break;
+ case bcn_req_req:
+ if (prm->q.opt.bcn.req_start == NULL)
+ break;
+#if (RM_MORE_DBG_MSG)
+ RTW_INFO("RM: bcn_req_req");
+#endif
+ for (k=0; k<prm->q.opt.bcn.req_len; k++) {
+ eid = prm->q.opt.bcn.req_start[k];
+
+ val8 = pbss->IELength - _FIXED_IE_LENGTH_;
+ ptr = rtw_get_ie(pbss->IEs + _FIXED_IE_LENGTH_,
+ eid, &len, val8);
+
+ if (!ptr)
+ continue;
+#if (RM_MORE_DBG_MSG)
+ switch (eid) {
+ case EID_QBSSLoad:
+ RTW_INFO("RM: EID_QBSSLoad\n");
+ break;
+ case EID_HTCapability:
+ RTW_INFO("RM: EID_HTCapability\n");
+ break;
+ case _MDIE_:
+ RTW_INFO("RM: EID_MobilityDomain\n");
+ break;
+ default:
+ RTW_INFO("RM: EID %d todo\n",eid);
+ break;
+ }
+#endif
+ pframe = rtw_set_ie(pframe, eid,
+ len,ptr+2, &my_len);
+ } /* for() */
+ break;
+ case bcn_req_ac_ch_rep:
+ default:
+ RTW_INFO("RM: OPT %d TODO\n",prm->q.opt.bcn.opt_id[j]);
+ break;
+ }
+ }
+done:
+ /*
+ * update my length
+ * content length does NOT include ID and LEN
+ */
+ val8 = my_len - 2;
+ rtw_set_fixed_ie(plen, 1, &val8, &j);
+
+ /* update length to caller */
+ *fr_len += my_len;
+
+ return pframe;
+}
+
+static u8 rm_get_rcpi(struct rm_obj *prm, struct wlan_network *pnetwork)
+{
+ return translate_percentage_to_rcpi(
+ pnetwork->network.PhyInfo.SignalStrength);
+}
+
+static u8 rm_get_rsni(struct rm_obj *prm, struct wlan_network *pnetwork)
+{
+ int i;
+ u8 val8, snr;
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(prm->psta->padapter);
+
+
+ if (pnetwork->network.PhyInfo.is_cck_rate) {
+ /* current HW doesn't have CCK RSNI */
+ /* 255 indicates RSNI is unavailable */
+ val8 = 255;
+ } else {
+ snr = 0;
+ for (i = 0; i < pHalData->NumTotalRFPath; i++) {
+ snr += pnetwork->network.PhyInfo.rx_snr[i];
+ }
+ snr = snr / pHalData->NumTotalRFPath;
+ val8 = (u8)(snr + 10)*2;
+ }
+ return val8;
+}
+
+u8 rm_bcn_req_cond_mach(struct rm_obj *prm, struct wlan_network *pnetwork)
+{
+ u8 val8;
+
+
+ switch(prm->q.opt.bcn.rep_cond.cond) {
+ case bcn_rep_cond_immediately:
+ return _SUCCESS;
+ case bcn_req_cond_rcpi_greater:
+ val8 = rm_get_rcpi(prm, pnetwork);
+ if (val8 > prm->q.opt.bcn.rep_cond.threshold)
+ return _SUCCESS;
+ break;
+ case bcn_req_cond_rcpi_less:
+ val8 = rm_get_rcpi(prm, pnetwork);
+ if (val8 < prm->q.opt.bcn.rep_cond.threshold)
+ return _SUCCESS;
+ break;
+ case bcn_req_cond_rsni_greater:
+ val8 = rm_get_rsni(prm, pnetwork);
+ if (val8 != 255 && val8 > prm->q.opt.bcn.rep_cond.threshold)
+ return _SUCCESS;
+ break;
+ case bcn_req_cond_rsni_less:
+ val8 = rm_get_rsni(prm, pnetwork);
+ if (val8 != 255 && val8 < prm->q.opt.bcn.rep_cond.threshold)
+ return _SUCCESS;
+ break;
+ default:
+ RTW_ERR("RM: bcn_req cond %u not support\n",
+ prm->q.opt.bcn.rep_cond.cond);
+ break;
+ }
+ return _FALSE;
+}
+
+static u8 *rm_bcn_rep_fill_scan_resule (struct rm_obj *prm,
+ u8 *pframe, struct wlan_network *pnetwork, unsigned int *fr_len)
+{
+ int snr, i;
+ u8 val8, *plen;
+ u16 val16;
+ u32 val32;
+ u64 val64;
+ PWLAN_BSSID_EX pbss;
+ unsigned int my_len;
+ _adapter *padapter = prm->psta->padapter;
+
+
+ my_len = 0;
+ /* meas ID */
+ val8 = EID_MeasureReport;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* remember position form elelment length */
+ plen = pframe;
+
+ /* meas_rpt_len */
+ /* default 3 = mode + token + type but no beacon content */
+ val8 = 3;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* meas_token */
+ val8 = prm->q.m_token;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* meas_rpt_mode F8-141 */
+ val8 = prm->p.m_mode;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* meas_type T8-81 */
+ val8 = bcn_rep;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ if (pnetwork == NULL)
+ goto done;
+
+ pframe = rtw_set_fixed_ie(pframe, 1, &prm->q.op_class, &my_len);
+
+ /* channel */
+ pbss = &pnetwork->network;
+ val8 = pbss->Configuration.DSConfig;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* Actual Measurement StartTime */
+ val64 = cpu_to_le64(prm->meas_start_time);
+ pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len);
+
+ /* Measurement Duration */
+ val16 = prm->meas_end_time - prm->meas_start_time;
+ val16 = cpu_to_le16(val16);
+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len);
+
+ /* TODO
+ * ReportedFrameInformation:
+ * 0 :beacon or probe rsp
+ * 1 :pilot frame
+ */
+ val8 = 0; /* report frame info */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* RCPI */
+ val8 = rm_get_rcpi(prm, pnetwork);
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* RSNI */
+ val8 = rm_get_rsni(prm, pnetwork);
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* BSSID */
+ pframe = rtw_set_fixed_ie(pframe, 6, (u8 *)&pbss->MacAddress, &my_len);
+
+ /*
+ * AntennaID
+ * 0: unknown
+ * 255: multiple antenna (Diversity)
+ */
+ val8 = 0;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* ParentTSF */
+ val32 = prm->meas_start_time + pnetwork->network.PhyInfo.free_cnt;
+ pframe = rtw_set_fixed_ie(pframe, 4, (u8 *)&val32, &my_len);
+
+ /*
+ * Generate Beacon detail
+ */
+ pframe = rm_gen_bcn_detail_elem(padapter, pframe,
+ prm, pnetwork, &my_len);
+done:
+ /*
+ * update my length
+ * content length does NOT include ID and LEN
+ */
+ val8 = my_len - 2;
+ rtw_set_fixed_ie(plen, 1, &val8, &i);
+
+ /* update length to caller */
+ *fr_len += my_len;
+
+ return pframe;
+}
+
+static u8 *rm_gen_bcn_rep_ie (struct rm_obj *prm,
+ u8 *pframe, struct wlan_network *pnetwork, unsigned int *fr_len)
+{
+ int snr, i;
+ u8 val8, *plen;
+ u16 val16;
+ u32 val32;
+ u64 val64;
+ unsigned int my_len;
+ _adapter *padapter = prm->psta->padapter;
+
+
+ my_len = 0;
+ plen = pframe + 1;
+ pframe = rtw_set_fixed_ie(pframe, 7, &prm->p.e_id, &my_len);
+
+ /* Actual Measurement StartTime */
+ val64 = cpu_to_le64(prm->meas_start_time);
+ pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len);
+
+ /* Measurement Duration */
+ val16 = prm->meas_end_time - prm->meas_start_time;
+ val16 = cpu_to_le16(val16);
+ pframe = rtw_set_fixed_ie(pframe, 2, (u8*)&val16, &my_len);
+
+ /* TODO
+ * ReportedFrameInformation:
+ * 0 :beacon or probe rsp
+ * 1 :pilot frame
+ */
+ val8 = 0; /* report frame info */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* RCPI */
+ val8 = rm_get_rcpi(prm, pnetwork);
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* RSNI */
+ val8 = rm_get_rsni(prm, pnetwork);
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* BSSID */
+ pframe = rtw_set_fixed_ie(pframe, 6,
+ (u8 *)&pnetwork->network.MacAddress, &my_len);
+
+ /*
+ * AntennaID
+ * 0: unknown
+ * 255: multiple antenna (Diversity)
+ */
+ val8 = 0;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* ParentTSF */
+ val32 = prm->meas_start_time + pnetwork->network.PhyInfo.free_cnt;
+ pframe = rtw_set_fixed_ie(pframe, 4, (u8 *)&val32, &my_len);
+
+ /* Generate Beacon detail */
+ pframe = rm_gen_bcn_detail_elem(padapter, pframe,
+ prm, pnetwork, &my_len);
+done:
+ /*
+ * update my length
+ * content length does NOT include ID and LEN
+ */
+ val8 = my_len - 2;
+ rtw_set_fixed_ie(plen, 1, &val8, &i);
+
+ /* update length to caller */
+ *fr_len += my_len;
+
+ return pframe;
+}
+
+static int retrieve_scan_result(struct rm_obj *prm)
+{
+ _irqL irqL;
+ _list *plist, *phead;
+ _queue *queue;
+ _adapter *padapter = prm->psta->padapter;
+ struct rtw_ieee80211_channel *pch_set;
+ struct wlan_network *pnetwork = NULL;
+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
+ int i, meas_ch_num=0;
+ PWLAN_BSSID_EX pbss;
+ unsigned int matched_network;
+ int len, my_len;
+ u8 buf_idx, *pbuf = NULL, *tmp_buf = NULL;
+
+
+ tmp_buf = rtw_malloc(MAX_XMIT_EXTBUF_SZ);
+ if (tmp_buf == NULL)
+ return 0;
+
+ my_len = 0;
+ buf_idx = 0;
+ matched_network = 0;
+ queue = &(pmlmepriv->scanned_queue);
+
+ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
+
+ phead = get_list_head(queue);
+ plist = get_next(phead);
+
+ /* get requested measurement channel set */
+ pch_set = prm->q.ch_set;
+ meas_ch_num = prm->q.ch_set_ch_amount;
+
+ /* search scan queue to find requested SSID */
+ while (1) {
+
+ if (rtw_end_of_queue_search(phead, plist) == _TRUE)
+ break;
+
+ pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
+ pbss = &pnetwork->network;
+
+ /*
+ * report network if requested channel set contains
+ * the channel matchs selected network
+ */
+ if (rtw_chset_search_ch(adapter_to_chset(padapter),
+ pbss->Configuration.DSConfig) == 0)
+ goto next;
+
+ if (rtw_mlme_band_check(padapter, pbss->Configuration.DSConfig)
+ == _FALSE)
+ goto next;
+
+ if (rtw_validate_ssid(&(pbss->Ssid)) == _FALSE)
+ goto next;
+
+ /* go through measurement requested channels */
+ for (i = 0; i < meas_ch_num; i++) {
+
+ /* match channel */
+ if (pch_set[i].hw_value != pbss->Configuration.DSConfig)
+ continue;
+
+ /* match bssid */
+ if (is_wildcard_bssid(prm->q.bssid) == FALSE)
+ if (_rtw_memcmp(prm->q.bssid,
+ pbss->MacAddress, 6) == _FALSE) {
+ continue;
+ }
+ /*
+ * default wildcard SSID. wildcard SSID:
+ * A SSID value (null) used to represent all SSIDs
+ */
+
+ /* match ssid */
+ if ((prm->q.opt.bcn.ssid.SsidLength > 0) &&
+ _rtw_memcmp(prm->q.opt.bcn.ssid.Ssid,
+ pbss->Ssid.Ssid,
+ prm->q.opt.bcn.ssid.SsidLength) == _FALSE)
+ continue;
+
+ /* match condition */
+ if (rm_bcn_req_cond_mach(prm, pnetwork) == _FALSE) {
+ RTW_INFO("RM: condition mismatch ch %u ssid %s bssid "MAC_FMT"\n",
+ pch_set[i].hw_value, pbss->Ssid.Ssid,
+ MAC_ARG(pbss->MacAddress));
+ RTW_INFO("RM: condition %u:%u\n",
+ prm->q.opt.bcn.rep_cond.cond,
+ prm->q.opt.bcn.rep_cond.threshold);
+ continue;
+ }
+
+ /* Found a matched SSID */
+ matched_network++;
+
+ RTW_INFO("RM: ch %u Found %s bssid "MAC_FMT"\n",
+ pch_set[i].hw_value, pbss->Ssid.Ssid,
+ MAC_ARG(pbss->MacAddress));
+
+ len = 0;
+ _rtw_memset(tmp_buf, 0, MAX_XMIT_EXTBUF_SZ);
+ rm_gen_bcn_rep_ie(prm, tmp_buf, pnetwork, &len);
+new_packet:
+ if (my_len == 0) {
+ pbuf = rtw_malloc(MAX_XMIT_EXTBUF_SZ);
+ if (pbuf == NULL)
+ goto fail;
+ prm->buf[buf_idx].pbuf = pbuf;
+ }
+
+ if ((MAX_XMIT_EXTBUF_SZ - (my_len+len+24+4)) > 0) {
+ pbuf = rtw_set_fixed_ie(pbuf,
+ len, tmp_buf, &my_len);
+ prm->buf[buf_idx].len = my_len;
+ } else {
+ if (my_len == 0) /* not enough space */
+ goto fail;
+
+ my_len = 0;
+ buf_idx++;
+ goto new_packet;
+ }
+ } /* for() */
+next:
+ plist = get_next(plist);
+ } /* while() */
+fail:
+ _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
+
+ if (tmp_buf)
+ rtw_mfree(tmp_buf, MAX_XMIT_EXTBUF_SZ);
+
+ RTW_INFO("RM: Found %d matched %s\n", matched_network,
+ prm->q.opt.bcn.ssid.Ssid);
+
+ if (prm->buf[buf_idx].pbuf)
+ return buf_idx+1;
+
+ return 0;
+}
+
+int issue_beacon_rep(struct rm_obj *prm)
+{
+ int i, my_len;
+ u8 *pframe;
+ _adapter *padapter = prm->psta->padapter;
+ struct pkt_attrib *pattr;
+ struct xmit_frame *pmgntframe;
+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
+ int pkt_num;
+
+
+ pkt_num = retrieve_scan_result(prm);
+
+ if (pkt_num == 0) {
+ issue_null_reply(prm);
+ return _SUCCESS;
+ }
+
+ for (i=0;i<pkt_num;i++) {
+
+ pmgntframe = alloc_mgtxmitframe(pxmitpriv);
+ if (pmgntframe == NULL) {
+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__);
+ goto fail;
+ }
+ pattr = &pmgntframe->attrib;
+ pframe = build_wlan_hdr(padapter,
+ pmgntframe, prm->psta, WIFI_ACTION);
+ pframe = rtw_set_fixed_ie(pframe,
+ 3, &prm->p.category, &pattr->pktlen);
+
+ my_len = 0;
+ pframe = rtw_set_fixed_ie(pframe,
+ prm->buf[i].len, prm->buf[i].pbuf, &my_len);
+
+ pattr->pktlen += my_len;
+ pattr->last_txcmdsz = pattr->pktlen;
+ dump_mgntframe(padapter, pmgntframe);
+ }
+fail:
+ for (i=0;i<pkt_num;i++) {
+ if (prm->buf[i].pbuf) {
+ rtw_mfree(prm->buf[i].pbuf, MAX_XMIT_EXTBUF_SZ);
+ prm->buf[i].pbuf = NULL;
+ prm->buf[i].len = 0;
+ }
+ }
+ return _SUCCESS;
+}
+
+/* neighbor request */
+int issue_nb_req(struct rm_obj *prm)
+{
+ _adapter *padapter = prm->psta->padapter;
+ struct sta_info *psta = prm->psta;
+ struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
+ struct xmit_frame *pmgntframe = NULL;
+ struct pkt_attrib *pattr = NULL;
+ u8 val8;
+ u8 *pframe = NULL;
+
+
+ RTW_INFO("RM: %s\n", __func__);
+
+ pmgntframe = alloc_mgtxmitframe(pxmitpriv);
+ if (pmgntframe == NULL) {
+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__);
+ return _FALSE;
+ }
+ pattr = &pmgntframe->attrib;
+ pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION);
+ pframe = rtw_set_fixed_ie(pframe,
+ 3, &prm->q.category, &pattr->pktlen);
+
+ if (prm->q.pssid) {
+
+ u8 sub_ie[64] = {0};
+ u8 *pie = &sub_ie[2];
+
+ RTW_INFO("RM: Send NB Req to "MAC_FMT" for(SSID) %s searching\n",
+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress),
+ pmlmepriv->cur_network.network.Ssid.Ssid);
+
+ val8 = strlen(prm->q.pssid);
+ sub_ie[0] = 0; /*SSID*/
+ sub_ie[1] = val8;
+
+ _rtw_memcpy(pie, prm->q.pssid, val8);
+
+ pframe = rtw_set_fixed_ie(pframe, val8 + 2,
+ sub_ie, &pattr->pktlen);
+ } else {
+
+ if (!pmlmepriv->cur_network.network.Ssid.SsidLength)
+ RTW_INFO("RM: Send NB Req to "MAC_FMT"\n",
+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress));
+ else {
+ u8 sub_ie[64] = {0};
+ u8 *pie = &sub_ie[2];
+
+ RTW_INFO("RM: Send NB Req to "MAC_FMT" for(SSID) %s searching\n",
+ MAC_ARG(pmlmepriv->cur_network.network.MacAddress),
+ pmlmepriv->cur_network.network.Ssid.Ssid);
+
+ sub_ie[0] = 0; /*SSID*/
+ sub_ie[1] = pmlmepriv->cur_network.network.Ssid.SsidLength;
+
+ _rtw_memcpy(pie, pmlmepriv->cur_network.network.Ssid.Ssid,
+ pmlmepriv->cur_network.network.Ssid.SsidLength);
+
+ pframe = rtw_set_fixed_ie(pframe,
+ pmlmepriv->cur_network.network.Ssid.SsidLength + 2,
+ sub_ie, &pattr->pktlen);
+ }
+ }
+
+ pattr->last_txcmdsz = pattr->pktlen;
+ dump_mgntframe(padapter, pmgntframe);
+
+ return _SUCCESS;
+}
+
+static u8 *rm_gen_bcn_req_s_elem(_adapter *padapter,
+ u8 *pframe, unsigned int *fr_len)
+{
+ u8 val8;
+ unsigned int my_len = 0;
+ u8 bssid[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
+
+
+ val8 = bcn_req_active; /* measurement mode T8-64 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ pframe = rtw_set_fixed_ie(pframe, 6, bssid, &my_len);
+
+ /* update length to caller */
+ *fr_len += my_len;
+
+ /* optional subelements */
+ return pframe;
+}
+
+static u8 *rm_gen_ch_load_req_s_elem(_adapter *padapter,
+ u8 *pframe, unsigned int *fr_len)
+{
+ u8 val8;
+ unsigned int my_len = 0;
+
+
+ val8 = 1; /* 1: channel load T8-60 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ val8 = 2; /* channel load length = 2 (extensible) */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ val8 = 0; /* channel load condition : 0 (issue when meas done) T8-61 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ val8 = 0; /* channel load reference value : 0 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* update length to caller */
+ *fr_len += my_len;
+
+ return pframe;
+}
+
+static u8 *rm_gen_noise_histo_req_s_elem(_adapter *padapter,
+ u8 *pframe, unsigned int *fr_len)
+{
+ u8 val8;
+ unsigned int my_len = 0;
+
+
+ val8 = 1; /* 1: noise histogram T8-62 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ val8 = 2; /* noise histogram length = 2 (extensible) */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ val8 = 0; /* noise histogram condition : 0 (issue when meas done) T8-63 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ val8 = 0; /* noise histogram reference value : 0 */
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+
+ /* update length to caller */
+ *fr_len += my_len;
+
+ return pframe;
+}
+
+int issue_radio_meas_req(struct rm_obj *prm)
+{
+ u8 val8;
+ u8 *pframe;
+ u8 *plen;
+ u16 val16;
+ int my_len, i;
+ struct xmit_frame *pmgntframe;
+ struct pkt_attrib *pattr;
+ _adapter *padapter = prm->psta->padapter;
+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
+
+
+ RTW_INFO("RM: %s - %s\n", __func__, rm_type_req_name(prm->q.m_type));
+
+ pmgntframe = alloc_mgtxmitframe(pxmitpriv);
+ if (pmgntframe == NULL) {
+ RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__);
+ return _FALSE;
+ }
+ pattr = &pmgntframe->attrib;
+ pframe = build_wlan_hdr(padapter, pmgntframe, prm->psta, WIFI_ACTION);
+ pframe = rtw_set_fixed_ie(pframe, 3, &prm->q.category, &pattr->pktlen);
+
+ /* repeat */
+ val16 = cpu_to_le16(prm->q.rpt);
+ pframe = rtw_set_fixed_ie(pframe, 2,
+ (unsigned char *)&(val16), &pattr->pktlen);
+
+ my_len = 0;
+ plen = pframe + 1;
+ pframe = rtw_set_fixed_ie(pframe, 7, &prm->q.e_id, &my_len);
+
+ /* random interval */
+ val16 = 100; /* 100 TU */
+ val16 = cpu_to_le16(val16);
+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len);
+
+ /* measurement duration */
+ val16 = 100;
+ val16 = cpu_to_le16(val16);
+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len);
+
+ /* optional subelement */
+ switch (prm->q.m_type) {
+ case bcn_req:
+ pframe = rm_gen_bcn_req_s_elem(padapter, pframe, &my_len);
+ break;
+ case ch_load_req:
+ pframe = rm_gen_ch_load_req_s_elem(padapter, pframe, &my_len);
+ break;
+ case noise_histo_req:
+ pframe = rm_gen_noise_histo_req_s_elem(padapter,
+ pframe, &my_len);
+ break;
+ case basic_req:
+ default:
+ break;
+ }
+
+ /* length */
+ val8 = (u8)my_len - 2;
+ rtw_set_fixed_ie(plen, 1, &val8, &i);
+
+ pattr->pktlen += my_len;
+
+ pattr->last_txcmdsz = pattr->pktlen;
+ dump_mgntframe(padapter, pmgntframe);
+
+ return _SUCCESS;
+}
+
+/* noise histogram */
+static u8 rm_get_anpi(struct rm_obj *prm, struct wlan_network *pnetwork)
+{
+ return translate_percentage_to_rcpi(
+ pnetwork->network.PhyInfo.SignalStrength);
+}
+
+int rm_radio_meas_report_cond(struct rm_obj *prm)
+{
+ u8 val8;
+ int i;
+
+
+ switch (prm->q.m_type) {
+ case ch_load_req:
+
+ val8 = prm->p.ch_load;
+ switch (prm->q.opt.clm.rep_cond.cond) {
+ case ch_load_cond_immediately:
+ return _SUCCESS;
+ case ch_load_cond_anpi_equal_greater:
+ if (val8 >= prm->q.opt.clm.rep_cond.threshold)
+ return _SUCCESS;
+ case ch_load_cond_anpi_equal_less:
+ if (val8 <= prm->q.opt.clm.rep_cond.threshold)
+ return _SUCCESS;
+ default:
+ break;
+ }
+ break;
+ case noise_histo_req:
+ val8 = prm->p.anpi;
+ switch (prm->q.opt.nhm.rep_cond.cond) {
+ case noise_histo_cond_immediately:
+ return _SUCCESS;
+ case noise_histo_cond_anpi_equal_greater:
+ if (val8 >= prm->q.opt.nhm.rep_cond.threshold)
+ return _SUCCESS;
+ break;
+ case noise_histo_cond_anpi_equal_less:
+ if (val8 <= prm->q.opt.nhm.rep_cond.threshold)
+ return _SUCCESS;
+ break;
+ default:
+ break;
+ }
+ break;
+ default:
+ break;
+ }
+ return _FAIL;
+}
+
+int retrieve_radio_meas_result(struct rm_obj *prm)
+{
+ HAL_DATA_TYPE *hal_data = GET_HAL_DATA(prm->psta->padapter);
+ int i, ch = -1;
+ u8 val8;
+
+
+ ch = rtw_chset_search_ch(adapter_to_chset(prm->psta->padapter),
+ prm->q.ch_num);
+
+ if ((ch == -1) || (ch >= MAX_CHANNEL_NUM)) {
+ RTW_ERR("RM: get ch(CH:%d) fail\n", prm->q.ch_num);
+ ch = 0;
+ }
+
+ switch (prm->q.m_type) {
+ case ch_load_req:
+#ifdef CONFIG_RTW_ACS
+ val8 = hal_data->acs.clm_ratio[ch];
+#else
+ val8 = 0;
+#endif
+ prm->p.ch_load = val8;
+ break;
+ case noise_histo_req:
+#ifdef CONFIG_RTW_ACS
+ /* ANPI */
+ prm->p.anpi = hal_data->acs.nhm_ratio[ch];
+
+ /* IPI 0~10 */
+ for (i=0;i<11;i++)
+ prm->p.ipi[i] = hal_data->acs.nhm[ch][i];
+
+#else
+ val8 = 0;
+ prm->p.anpi = val8;
+ for (i=0;i<11;i++)
+ prm->p.ipi[i] = val8;
+#endif
+ break;
+ default:
+ break;
+ }
+ return _SUCCESS;
+}
+
+int issue_radio_meas_rep(struct rm_obj *prm)
+{
+ u8 val8;
+ u8 *pframe;
+ u8 *plen;
+ u16 val16;
+ u64 val64;
+ unsigned int my_len;
+ _adapter *padapter = prm->psta->padapter;
+ struct xmit_frame *pmgntframe;
+ struct pkt_attrib *pattr;
+ struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
+ struct sta_info *psta = prm->psta;
+ int i;
+
+
+ RTW_INFO("RM: %s\n", __func__);
+
+ pmgntframe = alloc_mgtxmitframe(pxmitpriv);
+ if (pmgntframe == NULL) {
+ RTW_ERR("RM: ERR %s alloc xmit_frame fail\n",__func__);
+ return _FALSE;
+ }
+ pattr = &pmgntframe->attrib;
+ pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION);
+ pframe = rtw_set_fixed_ie(pframe, 3,
+ &prm->p.category, &pattr->pktlen);
+
+ my_len = 0;
+ plen = pframe + 1;
+ pframe = rtw_set_fixed_ie(pframe, 7, &prm->p.e_id, &my_len);
+
+ /* Actual Meas start time - 8 bytes */
+ val64 = cpu_to_le64(prm->meas_start_time);
+ pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len);
+
+ /* measurement duration */
+ val16 = prm->meas_end_time - prm->meas_start_time;
+ val16 = cpu_to_le16(val16);
+ pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len);
+
+ /* optional subelement */
+ switch (prm->q.m_type) {
+ case ch_load_req:
+ val8 = prm->p.ch_load;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+ break;
+ case noise_histo_req:
+ /*
+ * AntennaID
+ * 0: unknown
+ * 255: multiple antenna (Diversity)
+ */
+ val8 = 0;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+ /* ANPI */
+ val8 = prm->p.anpi;
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+ /* IPI 0~10 */
+ for (i=0;i<11;i++) {
+ val8 = prm->p.ipi[i];
+ pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len);
+ }
+ break;
+ default:
+ break;
+ }
+done:
+ /* length */
+ val8 = (u8)my_len-2;
+ rtw_set_fixed_ie(plen, 1, &val8, &i); /* use variable i to ignore it */
+
+ pattr->pktlen += my_len;
+ pattr->last_txcmdsz = pattr->pktlen;
+ dump_mgntframe(padapter, pmgntframe);
+
+ return _SUCCESS;
+}
+
+void rtw_ap_parse_sta_rm_en_cap(_adapter *padapter,
+ struct sta_info *psta, struct rtw_ieee802_11_elems *elem)
+{
+ if (elem->rm_en_cap) {
+ RTW_INFO("assoc.rm_en_cap="RM_CAP_FMT"\n",
+ RM_CAP_ARG(elem->rm_en_cap));
+ _rtw_memcpy(psta->rm_en_cap,
+ (elem->rm_en_cap), elem->rm_en_cap_len);
+ }
+}
+
+void RM_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE)
+{
+ int i;
+
+ _rtw_memcpy(&padapter->rmpriv.rm_en_cap_assoc, pIE->data, pIE->Length);
+ RTW_INFO("assoc.rm_en_cap="RM_CAP_FMT"\n", RM_CAP_ARG(pIE->data));
+}
+
+/* Debug command */
+
+#if (RM_SUPPORT_IWPRIV_DBG)
+static int hex2num(char c)
+{
+ if (c >= '0' && c <= '9')
+ return c - '0';
+ if (c >= 'a' && c <= 'f')
+ return c - 'a' + 10;
+ if (c >= 'A' && c <= 'F')
+ return c - 'A' + 10;
+ return -1;
+}
+
+int hex2byte(const char *hex)
+{
+ int a, b;
+ a = hex2num(*hex++);
+ if (a < 0)
+ return -1;
+ b = hex2num(*hex++);
+ if (b < 0)
+ return -1;
+ return (a << 4) | b;
+}
+
+static char * hwaddr_parse(char *txt, u8 *addr)
+{
+ size_t i;
+
+ for (i = 0; i < ETH_ALEN; i++) {
+ int a;
+
+ a = hex2byte(txt);
+ if (a < 0)
+ return NULL;
+ txt += 2;
+ addr[i] = a;
+ if (i < ETH_ALEN - 1 && *txt++ != ':')
+ return NULL;
+ }
+ return txt;
+}
+
+void rm_dbg_list_sta(_adapter *padapter, char *s)
+{
+ int i;
+ _irqL irqL;
+ struct sta_info *psta;
+ struct sta_priv *pstapriv = &padapter->stapriv;
+ _list *plist, *phead;
+
+
+ sprintf(pstr(s), "\n");
+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
+ for (i = 0; i < NUM_STA; i++) {
+ phead = &(pstapriv->sta_hash[i]);
+ plist = get_next(phead);
+
+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) {
+ psta = LIST_CONTAINOR(plist,
+ struct sta_info, hash_list);
+
+ plist = get_next(plist);
+
+ sprintf(pstr(s), "=========================================\n");
+ sprintf(pstr(s), "mac=" MAC_FMT "\n",
+ MAC_ARG(psta->cmn.mac_addr));
+ sprintf(pstr(s), "state=0x%x, aid=%d, macid=%d\n",
+ psta->state, psta->cmn.aid, psta->cmn.mac_id);
+ sprintf(pstr(s), "rm_cap="RM_CAP_FMT"\n",
+ RM_CAP_ARG(psta->rm_en_cap));
+ }
+
+ }
+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
+ sprintf(pstr(s), "=========================================\n");
+}
+
+void rm_dbg_help(_adapter *padapter, char *s)
+{
+ int i;
+
+
+ sprintf(pstr(s), "\n");
+ sprintf(pstr(s), "rrm list_sta\n");
+ sprintf(pstr(s), "rrm list_meas\n");
+
+ sprintf(pstr(s), "rrm add_meas <aid=1|mac=>,m=<bcn|clm|nhm|nb>,rpt=\n");
+ sprintf(pstr(s), "rrm run_meas <aid=1|evid=>\n");
+ sprintf(pstr(s), "rrm del_meas\n");
+
+ sprintf(pstr(s), "rrm run_meas rmid=xxxx,ev=xx\n");
+ sprintf(pstr(s), "rrm activate\n");
+
+ for (i=0;i<RM_EV_max;i++)
+ sprintf(pstr(s), "\t%2d %s\n",i, rm_event_name(i) );
+ sprintf(pstr(s), "\n");
+}
+
+struct sta_info *rm_get_sta(_adapter *padapter, u16 aid, u8* pbssid)
+{
+ int i;
+ _irqL irqL;
+ struct sta_info *psta = NULL;
+ struct sta_priv *pstapriv = &padapter->stapriv;
+ _list *plist, *phead;
+
+
+ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
+
+ for (i = 0; i < NUM_STA; i++) {
+ phead = &(pstapriv->sta_hash[i]);
+ plist = get_next(phead);
+
+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) {
+ psta = LIST_CONTAINOR(plist,
+ struct sta_info, hash_list);
+
+ plist = get_next(plist);
+
+ if (psta->cmn.aid == aid)
+ goto done;
+
+ if (pbssid && _rtw_memcmp(psta->cmn.mac_addr,
+ pbssid, 6))
+ goto done;
+ }
+
+ }
+ psta = NULL;
+done:
+ _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
+ return psta;
+}
+
+static int rm_dbg_modify_meas(_adapter *padapter, char *s)
+{
+ struct rm_priv *prmpriv = &padapter->rmpriv;
+ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info;
+ struct rm_obj *prm;
+ struct sta_info *psta;
+ char *pmac, *ptr, *paid, *prpt, *pnbp, *pclm, *pnhm, *pbcn;
+ unsigned val;
+ u8 bssid[ETH_ALEN];
+
+
+ /* example :
+ * rrm add_meas <aid=1|mac=>,m=<nb|clm|nhm|bcn>,<rept=>
+ * rrm run_meas <aid=1|evid=>
+ */
+ paid = strstr(s, "aid=");
+ pmac = strstr(s, "mac=");
+ pbcn = strstr(s, "m=bcn");
+ pclm = strstr(s, "m=clm");
+ pnhm = strstr(s, "m=nhm");
+ pnbp = strstr(s, "m=nb");
+ prpt = strstr(s, "rpt=");
+
+ /* set all ',' to NULL (end of line) */
+ ptr = s;
+ while (ptr) {
+ ptr = strchr(ptr, ',');
+ if (ptr) {
+ *(ptr) = 0x0;
+ ptr++;
+ }
+ }
+ prm = (struct rm_obj *)prmpriv->prm_sel;
+ prm->q.m_token = 1;
+ psta = prm->psta;
+
+ if (paid) { /* find sta_info according to aid */
+ paid += 4; /* skip aid= */
+ sscanf(paid, "%u", &val); /* aid=x */
+ psta = rm_get_sta(padapter, val, NULL);
+
+ } else if (pmac) { /* find sta_info according to bssid */
+ pmac += 4; /* skip mac= */
+ if (hwaddr_parse(pmac, bssid) == NULL) {
+ sprintf(pstr(s), "Err: \nincorrect mac format\n");
+ return _FAIL;
+ }
+ psta = rm_get_sta(padapter, 0xff, bssid);
+ }
+
+ if (psta) {
+ prm->psta = psta;
+
+#if 0
+ prm->q.diag_token = psta->rm_diag_token++;
+#else
+ /* TODO dialog should base on sta_info */
+ prm->q.diag_token = pmlmeinfo->dialogToken++;
+#endif
+ prm->rmid = psta->cmn.aid << 16
+ | prm->q.diag_token << 8
+ | RM_MASTER;
+ } else
+ return _FAIL;
+
+ prm->q.action_code = RM_ACT_RADIO_MEAS_REQ;
+ if (pbcn) {
+ prm->q.m_type = bcn_req;
+ } else if (pnhm) {
+ prm->q.m_type = noise_histo_req;
+ } else if (pclm) {
+ prm->q.m_type = ch_load_req;
+ } else if (pnbp) {
+ prm->q.action_code = RM_ACT_NB_REP_REQ;
+ } else
+ return _FAIL;
+
+ if (prpt) {
+ prpt += 4; /* skip rpt= */
+ sscanf(prpt, "%u", &val);
+ prm->q.rpt = (u8)val;
+ }
+
+ return _SUCCESS;
+}
+
+static void rm_dbg_activate_meas(_adapter *padapter, char *s)
+{
+ struct rm_priv *prmpriv = &(padapter->rmpriv);
+ struct rm_obj *prm;
+
+
+ if (prmpriv->prm_sel == NULL) {
+ sprintf(pstr(s), "\nErr: No inActivate measurement\n");
+ return;
+ }
+ prm = (struct rm_obj *)prmpriv->prm_sel;
+
+ /* verify attributes */
+ if (prm->psta == NULL) {
+ sprintf(pstr(s), "\nErr: inActivate meas has no psta\n");
+ return;
+ }
+
+ /* measure current channel */
+ prm->q.ch_num = padapter->mlmeextpriv.cur_channel;
+ prm->q.op_class = rm_get_oper_class_via_ch(prm->q.ch_num);
+
+ /* enquee rmobj */
+ rm_enqueue_rmobj(padapter, prm, _FALSE);
+
+ sprintf(pstr(s), "\nActivate rmid=%x, state=%s, meas_type=%s\n",
+ prm->rmid, rm_state_name(prm->state),
+ rm_type_req_name(prm->q.m_type));
+
+ sprintf(pstr(s), "aid=%d, mac=" MAC_FMT "\n",
+ prm->psta->cmn.aid, MAC_ARG(prm->psta->cmn.mac_addr));
+
+ /* clearn inActivate prm info */
+ prmpriv->prm_sel = NULL;
+}
+
+static void rm_dbg_add_meas(_adapter *padapter, char *s)
+{
+ struct rm_priv *prmpriv = &(padapter->rmpriv);
+ struct rm_obj *prm;
+ char *pact;
+
+
+ /* example :
+ * rrm add_meas <aid=1|mac=>,m=<nb_req|clm_req|nhm_req>
+ * rrm run_meas <aid=1|evid=>
+ */
+ prm = (struct rm_obj *)prmpriv->prm_sel;
+ if (prm == NULL)
+ prm = rm_alloc_rmobj(padapter);
+
+ if (prm == NULL) {
+ sprintf(pstr(s), "\nErr: alloc meas fail\n");
+ return;
+ }
+
+ prmpriv->prm_sel = prm;
+
+ pact = strstr(s, "act");
+ if (rm_dbg_modify_meas(padapter, s) == _FAIL) {
+
+ sprintf(pstr(s), "\nErr: add meas fail\n");
+ rm_free_rmobj(prm);
+ prmpriv->prm_sel = NULL;
+ return;
+ }
+ prm->q.category = RTW_WLAN_CATEGORY_RADIO_MEAS;
+ prm->q.e_id = _MEAS_REQ_IE_; /* 38 */
+
+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ)
+ sprintf(pstr(s), "\nAdd rmid=%x, meas_type=%s ok\n",
+ prm->rmid, rm_type_req_name(prm->q.m_type));
+ else if (prm->q.action_code == RM_ACT_NB_REP_REQ)
+ sprintf(pstr(s), "\nAdd rmid=%x, meas_type=bcn_req ok\n",
+ prm->rmid);
+
+ if (prm->psta)
+ sprintf(pstr(s), "mac="MAC_FMT"\n",
+ MAC_ARG(prm->psta->cmn.mac_addr));
+
+ if (pact)
+ rm_dbg_activate_meas(padapter, pstr(s));
+}
+
+static void rm_dbg_del_meas(_adapter *padapter, char *s)
+{
+ struct rm_priv *prmpriv = &padapter->rmpriv;
+ struct rm_obj *prm = (struct rm_obj *)prmpriv->prm_sel;
+
+
+ if (prm) {
+ sprintf(pstr(s), "\ndelete rmid=%x\n",prm->rmid);
+
+ /* free inActivate meas - enqueue yet */
+ prmpriv->prm_sel = NULL;
+ rtw_mfree(prmpriv->prm_sel, sizeof(struct rm_obj));
+ } else
+ sprintf(pstr(s), "Err: no inActivate measurement\n");
+}
+
+static void rm_dbg_run_meas(_adapter *padapter, char *s)
+{
+ struct rm_obj *prm;
+ char *pevid, *prmid;
+ u32 rmid, evid;
+
+
+ prmid = strstr(s, "rmid="); /* hex */
+ pevid = strstr(s, "evid="); /* dec */
+
+ if (prmid && pevid) {
+ prmid += 5; /* rmid= */
+ sscanf(prmid, "%x", &rmid);
+
+ pevid += 5; /* evid= */
+ sscanf(pevid, "%u", &evid);
+ } else {
+ sprintf(pstr(s), "\nErr: incorrect attribute\n");
+ return;
+ }
+
+ prm = rm_get_rmobj(padapter, rmid);
+
+ if (!prm) {
+ sprintf(pstr(s), "\nErr: measurement not found\n");
+ return;
+ }
+
+ if (evid >= RM_EV_max) {
+ sprintf(pstr(s), "\nErr: wrong event id\n");
+ return;
+ }
+
+ rm_post_event(padapter, prm->rmid, evid);
+ sprintf(pstr(s), "\npost %s to rmid=%x\n",rm_event_name(evid), rmid);
+}
+
+static void rm_dbg_show_meas(struct rm_obj *prm, char *s)
+{
+ struct sta_info *psta;
+
+ psta = prm->psta;
+
+ if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) {
+
+ sprintf(pstr(s), "\nrmid=%x, meas_type=%s\n",
+ prm->rmid, rm_type_req_name(prm->q.m_type));
+
+ } else if (prm->q.action_code == RM_ACT_NB_REP_REQ) {
+
+ sprintf(pstr(s), "\nrmid=%x, action=neighbor_req\n",
+ prm->rmid);
+ } else
+ sprintf(pstr(s), "\nrmid=%x, action=unknown\n",
+ prm->rmid);
+
+ if (psta)
+ sprintf(pstr(s), "aid=%d, mac="MAC_FMT"\n",
+ psta->cmn.aid, MAC_ARG(psta->cmn.mac_addr));
+
+ sprintf(pstr(s), "clock=%d, state=%s, rpt=%u/%u\n",
+ (int)ATOMIC_READ(&prm->pclock->counter),
+ rm_state_name(prm->state), prm->p.rpt, prm->q.rpt);
+}
+
+static void rm_dbg_list_meas(_adapter *padapter, char *s)
+{
+ int meas_amount;
+ _irqL irqL;
+ struct rm_obj *prm;
+ struct sta_info *psta;
+ struct rm_priv *prmpriv = &padapter->rmpriv;
+ _queue *queue = &prmpriv->rm_queue;
+ _list *plist, *phead;
+
+
+ sprintf(pstr(s), "\n");
+ _enter_critical(&queue->lock, &irqL);
+ phead = get_list_head(queue);
+ plist = get_next(phead);
+ meas_amount = 0;
+
+ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) {
+ prm = LIST_CONTAINOR(plist, struct rm_obj, list);
+ meas_amount++;
+ plist = get_next(plist);
+ psta = prm->psta;
+ sprintf(pstr(s), "=========================================\n");
+
+ rm_dbg_show_meas(prm, s);
+ }
+ _exit_critical(&queue->lock, &irqL);
+
+ sprintf(pstr(s), "=========================================\n");
+
+ if (meas_amount==0) {
+ sprintf(pstr(s), "No Activate measurement\n");
+ sprintf(pstr(s), "=========================================\n");
+ }
+
+ if (prmpriv->prm_sel == NULL)
+ sprintf(pstr(s), "\nNo inActivate measurement\n");
+ else {
+ sprintf(pstr(s), "\ninActivate measurement\n");
+ rm_dbg_show_meas((struct rm_obj *)prmpriv->prm_sel, s);
+ }
+}
+#endif /* RM_SUPPORT_IWPRIV_DBG */
+
+void rm_dbg_cmd(_adapter *padapter, char *s)
+{
+ unsigned val;
+ char *paid;
+ struct sta_info *psta=NULL;
+
+#if (RM_SUPPORT_IWPRIV_DBG)
+ if (_rtw_memcmp(s, "help", 4)) {
+ rm_dbg_help(padapter, s);
+
+ } else if (_rtw_memcmp(s, "list_sta", 8)) {
+ rm_dbg_list_sta(padapter, s);
+
+ } else if (_rtw_memcmp(s, "list_meas", 9)) {
+ rm_dbg_list_meas(padapter, s);
+
+ } else if (_rtw_memcmp(s, "add_meas", 8)) {
+ rm_dbg_add_meas(padapter, s);
+
+ } else if (_rtw_memcmp(s, "del_meas", 8)) {
+ rm_dbg_del_meas(padapter, s);
+
+ } else if (_rtw_memcmp(s, "activate", 8)) {
+ rm_dbg_activate_meas(padapter, s);
+
+ } else if (_rtw_memcmp(s, "run_meas", 8)) {
+ rm_dbg_run_meas(padapter, s);
+ } else if (_rtw_memcmp(s, "nb", 2)) {
+
+ paid = strstr(s, "aid=");
+
+ if (paid) { /* find sta_info according to aid */
+ paid += 4; /* skip aid= */
+ sscanf(paid, "%u", &val); /* aid=x */
+ psta = rm_get_sta(padapter, val, NULL);
+
+ if (psta)
+ rm_add_nb_req(padapter, psta);
+ }
+ }
+#else
+ sprintf(pstr(s), "\n");
+ sprintf(pstr(s), "rrm debug command was disabled\n");
+#endif
+}
+#endif /* CONFIG_RTW_80211K */