qcacmn: Add scan database init and deinit changes
Add changes to initialize and de-initialize the scan database.
Also registers callback to TXRX module to handle
beacon and probe resp and convert it to scan entry.
Change-Id: Ic55e4fc6dc1b23bdf50165aea219e112dcad676d
CRs-Fixed: 1095299
diff --git a/umac/scan/dispatcher/src/wlan_scan_utils_api.c b/umac/scan/dispatcher/src/wlan_scan_utils_api.c
index ec32f82..7dcee98 100644
--- a/umac/scan/dispatcher/src/wlan_scan_utils_api.c
+++ b/umac/scan/dispatcher/src/wlan_scan_utils_api.c
@@ -20,6 +20,7 @@
* DOC: Defines scan utility functions
*/
+#include <wlan_cmn.h>
#include <wlan_scan_ucfg_api.h>
#include <wlan_scan_utils_api.h>
#include <../../core/src/wlan_scan_cache_db.h>
@@ -103,3 +104,511 @@
return scan_obj->pdev_info[pdev_id].last_scan_time;
}
+
+static enum wlan_band scm_chan_to_band(uint32_t chan)
+{
+ if (WLAN_CHAN_IS_2GHZ(chan))
+ return WLAN_BAND_2_4_GHZ;
+
+ return WLAN_BAND_5_GHZ;
+}
+
+static bool util_is_pureg_rate(uint8_t *rates, uint8_t nrates)
+{
+ static const uint8_t g_rates[] = {12, 18, 24, 36, 48, 72, 96, 108};
+ bool pureg = false;
+ uint8_t i, j;
+
+ for (i = 0; i < nrates; i++) {
+ for (j = 0; j < QDF_ARRAY_SIZE(g_rates); j++) {
+ if (WLAN_RV(rates[i]) == g_rates[j]) {
+ pureg = true;
+ break;
+ }
+ }
+ if (pureg)
+ break;
+ }
+
+ return pureg;
+}
+static enum wlan_phymode
+util_scan_get_phymode_5g(struct scan_cache_entry *scan_params)
+{
+ enum wlan_phymode phymode = WLAN_PHYMODE_AUTO;
+ uint16_t ht_cap = 0;
+ struct htcap_cmn_ie *htcap;
+ struct wlan_ie_htinfo_cmn *htinfo;
+ struct wlan_ie_vhtop *vhtop;
+
+ htcap = (struct htcap_cmn_ie *)
+ util_scan_entry_htcap(scan_params);
+ htinfo = (struct wlan_ie_htinfo_cmn *)
+ util_scan_entry_htinfo(scan_params);
+ vhtop = (struct wlan_ie_vhtop *)
+ util_scan_entry_vhtop(scan_params);
+
+ if (!(htcap && htinfo))
+ return WLAN_PHYMODE_11A;
+
+ if (htcap)
+ ht_cap = le16toh(htcap->hc_cap);
+
+ if (util_scan_entry_vhtcap(scan_params) && vhtop) {
+ switch (vhtop->vht_op_chwidth) {
+ case WLAN_VHTOP_CHWIDTH_2040:
+ if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
+ (htinfo->hi_extchoff ==
+ WLAN_HTINFO_EXTOFFSET_ABOVE))
+ phymode = WLAN_PHYMODE_11AC_VHT40PLUS;
+ else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
+ (htinfo->hi_extchoff ==
+ WLAN_HTINFO_EXTOFFSET_BELOW))
+ phymode = WLAN_PHYMODE_11AC_VHT40MINUS;
+ else
+ phymode = WLAN_PHYMODE_11AC_VHT20;
+ break;
+ case WLAN_VHTOP_CHWIDTH_80:
+ if (WLAN_IS_REVSIG_VHT80_80(vhtop))
+ phymode = WLAN_PHYMODE_11AC_VHT80_80;
+ else if (WLAN_IS_REVSIG_VHT160(vhtop))
+ phymode = WLAN_PHYMODE_11AC_VHT160;
+ else
+ phymode = WLAN_PHYMODE_11AC_VHT80;
+ break;
+ case WLAN_VHTOP_CHWIDTH_160:
+ phymode = WLAN_PHYMODE_11AC_VHT160;
+ break;
+ case WLAN_VHTOP_CHWIDTH_80_80:
+ phymode = WLAN_PHYMODE_11AC_VHT80_80;
+ break;
+ default:
+ scm_err("bad channel: %d",
+ vhtop->vht_op_chwidth);
+ break;
+ }
+ } else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
+ (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_ABOVE))
+ phymode = WLAN_PHYMODE_11NA_HT40PLUS;
+ else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
+ (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_BELOW))
+ phymode = WLAN_PHYMODE_11NA_HT40MINUS;
+ else
+ phymode = WLAN_PHYMODE_11NA_HT20;
+
+ return phymode;
+}
+
+static enum wlan_phymode
+util_scan_get_phymode_2g(struct scan_cache_entry *scan_params)
+{
+ enum wlan_phymode phymode = WLAN_PHYMODE_AUTO;
+ uint16_t ht_cap = 0;
+ struct htcap_cmn_ie *htcap;
+ struct wlan_ie_htinfo_cmn *htinfo;
+ struct wlan_ie_vhtop *vhtop;
+
+ htcap = (struct htcap_cmn_ie *)
+ util_scan_entry_htcap(scan_params);
+ htinfo = (struct wlan_ie_htinfo_cmn *)
+ util_scan_entry_htinfo(scan_params);
+ vhtop = (struct wlan_ie_vhtop *)
+ util_scan_entry_vhtop(scan_params);
+
+ if (htcap)
+ ht_cap = le16toh(htcap->hc_cap);
+
+ if (htcap && htinfo) {
+ if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
+ (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_ABOVE))
+ phymode = WLAN_PHYMODE_11NG_HT40PLUS;
+ else if ((ht_cap & WLAN_HTCAP_C_CHWIDTH40) &&
+ (htinfo->hi_extchoff == WLAN_HTINFO_EXTOFFSET_BELOW))
+ phymode = WLAN_PHYMODE_11NG_HT40MINUS;
+ else
+ phymode = WLAN_PHYMODE_11NG_HT20;
+ } else if (util_scan_entry_xrates(scan_params)) {
+ /* only 11G stations will have more than 8 rates */
+ phymode = WLAN_PHYMODE_11G;
+ } else {
+ /* Some mischievous g-only APs do not set extended rates */
+ if (util_scan_entry_rates(scan_params)) {
+ if (util_is_pureg_rate(&scan_params->ie_list.rates[2],
+ scan_params->ie_list.rates[1]))
+ phymode = WLAN_PHYMODE_11G;
+ else
+ phymode = WLAN_PHYMODE_11B;
+ } else {
+ phymode = WLAN_PHYMODE_11B;
+ }
+ }
+
+ return phymode;
+}
+
+static QDF_STATUS
+util_scan_parse_chan_switch_wrapper_ie(struct scan_cache_entry *scan_params,
+ struct ie_header *sub_ie, qdf_size_t sub_ie_len)
+{
+ /* Walk through to check nothing is malformed */
+ while (sub_ie_len >= sizeof(struct ie_header)) {
+ /* At least one more header is present */
+ sub_ie_len -= sizeof(struct ie_header);
+
+ if (sub_ie->ie_len == 0) {
+ sub_ie += 1;
+ continue;
+ }
+ if (sub_ie_len < sub_ie->ie_len) {
+ scm_err("Incomplete corrupted IE:%x",
+ WLAN_ELEMID_CHAN_SWITCH_WRAP);
+ return QDF_STATUS_E_INVAL;
+ }
+ switch (sub_ie->ie_id) {
+ case WLAN_ELEMID_COUNTRY:
+ scan_params->ie_list.country = (uint8_t *)sub_ie;
+ break;
+ case WLAN_ELEMID_WIDE_BAND_CHAN_SWITCH:
+ scan_params->ie_list.widebw = (uint8_t *)sub_ie;
+ break;
+ case WLAN_ELEMID_VHT_TX_PWR_ENVLP:
+ scan_params->ie_list.txpwrenvlp = (uint8_t *)sub_ie;
+ break;
+ }
+ /* Consume sub info element */
+ sub_ie_len -= sub_ie->ie_len;
+ /* go to next Sub IE */
+ sub_ie = (struct ie_header *)
+ (((uint8_t *) sub_ie) +
+ sizeof(struct ie_header) + sub_ie->ie_len);
+ }
+
+ return QDF_STATUS_SUCCESS;
+}
+
+static bool
+util_scan_is_hidden_ssid(struct ie_ssid *ssid)
+{
+ uint8_t i;
+
+ /*
+ * We flag this as Hidden SSID if the Length is 0
+ * of the SSID only contains 0's
+ */
+ if (!ssid || !ssid->ssid_len)
+ return true;
+
+ for (i = 0; i < ssid->ssid_len; i++)
+ if (ssid->ssid[i] != 0)
+ return false;
+
+ /* All 0's */
+ return true;
+}
+
+static void
+util_scan_parse_vendor_ie(struct scan_cache_entry *scan_params,
+ struct ie_header *ie)
+{
+
+ if (scan_params->ie_list.vendor == NULL)
+ scan_params->ie_list.vendor = (uint8_t *)ie;
+
+ if (is_wpa_oui((uint8_t *)ie)) {
+ scan_params->ie_list.wpa = (uint8_t *)ie;
+ } else if (is_wps_oui((uint8_t *)ie)) {
+ scan_params->ie_list.wps = (uint8_t *)ie;
+ /* WCN IE should be a subset of WPS IE */
+ if (is_wcn_oui((uint8_t *)ie))
+ scan_params->ie_list.wcn = (uint8_t *)ie;
+ } else if (is_wme_param((uint8_t *)ie)) {
+ scan_params->ie_list.wmeparam = (uint8_t *)ie;
+ } else if (is_wme_info((uint8_t *)ie)) {
+ scan_params->ie_list.wmeinfo = (uint8_t *)ie;
+ } else if (is_atheros_oui((uint8_t *)ie)) {
+ scan_params->ie_list.athcaps = (uint8_t *)ie;
+ } else if (is_atheros_extcap_oui((uint8_t *)ie)) {
+ scan_params->ie_list.athextcaps = (uint8_t *)ie;
+ } else if (is_sfa_oui((uint8_t *)ie)) {
+ scan_params->ie_list.sfa = (uint8_t *)ie;
+ } else if (is_p2p_oui((uint8_t *)ie)) {
+ scan_params->ie_list.p2p = (uint8_t *)ie;
+ } else if (is_qca_whc_oui((uint8_t *)ie,
+ QCA_OUI_WHC_AP_INFO_SUBTYPE)) {
+ scan_params->ie_list.sonadv = (uint8_t *)ie;
+ } else if (is_ht_cap((uint8_t *)ie)) {
+ /* we only care if there isn't already an HT IE (ANA) */
+ if (scan_params->ie_list.htcap == NULL)
+ scan_params->ie_list.htcap =
+ (uint8_t *)&(((struct wlan_vendor_ie_htcap *)ie)->ie);
+ } else if (is_ht_info((uint8_t *)ie)) {
+ /* we only care if there isn't already an HT IE (ANA) */
+ if (scan_params->ie_list.htinfo == NULL)
+ scan_params->ie_list.htinfo =
+ (uint8_t *)&(((struct wlan_vendor_ie_htinfo *)
+ ie)->hi_ie);
+ } else if (is_interop_vht((uint8_t *)ie) &&
+ !(scan_params->ie_list.vhtop)) {
+ /* location where Interop Vht Cap IE and VHT OP IE Present */
+ scan_params->ie_list.vhtcap = (((uint8_t *)(ie)) + 7);
+ scan_params->ie_list.vhtop = (((uint8_t *)(ie)) + 21);
+ } else if (is_bwnss_oui((uint8_t *)ie)) {
+ /*
+ * Bandwidth-NSS map has sub-type & version.
+ * hence copy data just after version byte
+ */
+ scan_params->ie_list.bwnss_map = (((uint8_t *)ie) + 8);
+ }
+}
+
+static QDF_STATUS
+util_scan_populate_bcn_ie_list(struct scan_cache_entry *scan_params)
+{
+ struct ie_header *ie, *sub_ie;
+ uint32_t ie_len, sub_ie_len;
+ QDF_STATUS status;
+
+ ie_len = util_scan_entry_ie_len(scan_params);
+ ie = (struct ie_header *)
+ util_scan_entry_ie_data(scan_params);
+
+ while (ie_len >= sizeof(struct ie_header)) {
+ ie_len -= sizeof(struct ie_header);
+
+ if (!ie->ie_len) {
+ ie += 1;
+ continue;
+ }
+
+ if (ie_len < ie->ie_len) {
+ scm_err("Incomplete corrupted IE:%x",
+ ie->ie_id);
+ return QDF_STATUS_E_INVAL;
+ }
+
+ switch (ie->ie_id) {
+ case WLAN_ELEMID_SSID:
+ scan_params->ie_list.ssid = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_RATES:
+ scan_params->ie_list.rates = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_DSPARMS:
+ scan_params->channel.chan_idx =
+ ((struct ds_ie *)ie)->cur_chan;
+ break;
+ case WLAN_ELEMID_TIM:
+ scan_params->ie_list.tim = (uint8_t *)ie;
+ scan_params->dtim_period =
+ ((struct wlan_tim_ie *)ie)->tim_period;
+ break;
+ case WLAN_ELEMID_COUNTRY:
+ scan_params->ie_list.country = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_QBSS_LOAD:
+ scan_params->ie_list.qbssload = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_CHANSWITCHANN:
+ scan_params->ie_list.csa = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_IBSSDFS:
+ scan_params->ie_list.ibssdfs = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_QUIET:
+ scan_params->ie_list.quiet = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_ERP:
+ scan_params->erp = ((struct erp_ie *)ie)->value;
+ break;
+ case WLAN_ELEMID_HTCAP_ANA:
+ scan_params->ie_list.htcap =
+ (uint8_t *)&(((struct htcap_ie *)ie)->ie);
+ break;
+ case WLAN_ELEMID_RSN:
+ scan_params->ie_list.rsn = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_XRATES:
+ scan_params->ie_list.xrates = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_EXTCHANSWITCHANN:
+ scan_params->ie_list.xcsa = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_SECCHANOFFSET:
+ scan_params->ie_list.secchanoff = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_HTINFO_ANA:
+ scan_params->ie_list.htinfo =
+ (uint8_t *)&(((struct wlan_ie_htinfo *) ie)->hi_ie);
+ scan_params->channel.chan_idx =
+ ((struct wlan_ie_htinfo_cmn *)
+ (scan_params->ie_list.htinfo))->hi_ctrlchannel;
+ break;
+ case WLAN_ELEMID_WAPI:
+ scan_params->ie_list.wapi = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_XCAPS:
+ scan_params->ie_list.extcaps = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_VHTCAP:
+ scan_params->ie_list.vhtcap = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_VHTOP:
+ scan_params->ie_list.vhtop = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_OP_MODE_NOTIFY:
+ scan_params->ie_list.opmode = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_MOBILITY_DOMAIN:
+ scan_params->ie_list.mdie = (uint8_t *)ie;
+ break;
+ case WLAN_ELEMID_VENDOR:
+ util_scan_parse_vendor_ie(scan_params,
+ ie);
+ break;
+ case WLAN_ELEMID_CHAN_SWITCH_WRAP:
+ scan_params->ie_list.cswrp = (uint8_t *)ie;
+ /* Go to next sub IE */
+ sub_ie = (struct ie_header *)
+ (((uint8_t *)ie) + sizeof(struct ie_header));
+ sub_ie_len = ie->ie_len;
+ status =
+ util_scan_parse_chan_switch_wrapper_ie(
+ scan_params, sub_ie, sub_ie_len);
+ if (QDF_IS_STATUS_ERROR(status)) {
+ scm_err("failed to parse chan_switch_wrapper_ie");
+ return status;
+ }
+ break;
+ default:
+ break;
+ }
+
+ /* Consume info element */
+ ie_len -= ie->ie_len;
+ /* Go to next IE */
+ ie = (struct ie_header *)
+ (((uint8_t *) ie) +
+ sizeof(struct ie_header) +
+ ie->ie_len);
+ }
+
+ return QDF_STATUS_SUCCESS;
+}
+
+struct scan_cache_entry *
+util_scan_unpack_beacon_frame(uint8_t *frame,
+ qdf_size_t frame_len, uint32_t frm_subtype,
+ struct mgmt_rx_event_params *rx_param)
+{
+ struct wlan_frame_hdr *hdr;
+ struct wlan_bcn_frame *bcn;
+ QDF_STATUS status;
+ struct ie_ssid *ssid;
+ struct scan_cache_entry *scan_entry = NULL;
+
+ scan_entry = qdf_mem_malloc(sizeof(*scan_entry));
+ if (!scan_entry) {
+ scm_err("failed to allocate memory for scan_entry");
+ return NULL;
+ }
+ scan_entry->raw_frame.ptr =
+ qdf_mem_malloc(frame_len);
+ if (!scan_entry->raw_frame.ptr) {
+ scm_err("failed to allocate memory for frame");
+ qdf_mem_free(scan_entry);
+ return NULL;
+ }
+
+ bcn = (struct wlan_bcn_frame *)
+ (frame + sizeof(*hdr));
+ hdr = (struct wlan_frame_hdr *)frame;
+
+ scan_entry->frm_subtype = frm_subtype;
+ qdf_mem_copy(scan_entry->bssid.bytes,
+ hdr->i_addr3, QDF_MAC_ADDR_SIZE);
+ /* Scr addr */
+ qdf_mem_copy(scan_entry->mac_addr.bytes,
+ hdr->i_addr2, QDF_MAC_ADDR_SIZE);
+ scan_entry->seq_num =
+ (le16toh(*(uint16_t *)hdr->i_seq) >> WLAN_SEQ_SEQ_SHIFT);
+
+ scan_entry->rssi_raw = rx_param->rssi;
+ scan_entry->tsf_delta = rx_param->tsf_delta;
+
+ /* store jiffies */
+ scan_entry->rrm_parent_tsf = (u_int32_t) qdf_system_ticks();
+
+ scan_entry->bcn_int = le16toh(bcn->beacon_interval);
+
+ /*
+ * In case if the beacon dosnt have
+ * valid beacon interval falback to def
+ */
+ if (!scan_entry->bcn_int)
+ scan_entry->bcn_int = 100;
+ scan_entry->cap_info.value = le16toh(bcn->capability.value);
+ qdf_mem_copy(scan_entry->tsf_info.data,
+ bcn->timestamp, 8);
+ scan_entry->erp = ERP_NON_ERP_PRESENT;
+
+
+ scan_entry->rssi_timestamp =
+ scan_entry->scan_entry_time =
+ qdf_mc_timer_get_system_time();
+
+ scan_entry->raw_frame.len = frame_len;
+ qdf_mem_copy(scan_entry->raw_frame.ptr,
+ frame, frame_len);
+ status = util_scan_populate_bcn_ie_list(scan_entry);
+ if (QDF_IS_STATUS_ERROR(status)) {
+ scm_err("failed to parse beacon IE");
+ qdf_mem_free(scan_entry->raw_frame.ptr);
+ qdf_mem_free(scan_entry);
+ return NULL;
+ }
+
+ if (!scan_entry->ie_list.rates) {
+ qdf_mem_free(scan_entry->raw_frame.ptr);
+ qdf_mem_free(scan_entry);
+ return NULL;
+ }
+
+ ssid = (struct ie_ssid *)
+ scan_entry->ie_list.ssid;
+
+ if (ssid && (ssid->ssid_len > WLAN_SSID_MAX_LEN)) {
+ qdf_mem_free(scan_entry->raw_frame.ptr);
+ qdf_mem_free(scan_entry);
+ return NULL;
+ }
+
+ if (scan_entry->ie_list.p2p)
+ scan_entry->is_p2p = true;
+
+ /* If no channel info is present in beacon use meta channel */
+ if (!scan_entry->channel.chan_idx) {
+ scan_entry->channel.chan_idx =
+ rx_param->channel;
+ } else if (rx_param->channel !=
+ scan_entry->channel.chan_idx) {
+ scan_entry->channel_mismatch = true;
+ }
+
+ if (util_scan_is_hidden_ssid(ssid)) {
+ scan_entry->ie_list.ssid = NULL;
+ } else {
+ qdf_mem_copy(scan_entry->ssid.ssid,
+ ssid->ssid, WLAN_SSID_MAX_LEN);
+ scan_entry->ssid.length = ssid->ssid_len;
+ scan_entry->hidden_ssid_timestamp =
+ scan_entry->scan_entry_time;
+ }
+
+ if (WLAN_CHAN_IS_5GHZ(scan_entry->channel.chan_idx))
+ scan_entry->phy_mode = util_scan_get_phymode_5g(scan_entry);
+ else
+ scan_entry->phy_mode = util_scan_get_phymode_2g(scan_entry);
+
+ /* TODO calculate channel struct */
+ return scan_entry;
+}