cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

util.c (22976B)


      1/*
      2 * NXP Wireless LAN device driver: utility functions
      3 *
      4 * Copyright 2011-2020 NXP
      5 *
      6 * This software file (the "File") is distributed by NXP
      7 * under the terms of the GNU General Public License Version 2, June 1991
      8 * (the "License").  You may use, redistribute and/or modify this File in
      9 * accordance with the terms and conditions of the License, a copy of which
     10 * is available by writing to the Free Software Foundation, Inc.,
     11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
     12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
     13 *
     14 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
     15 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
     16 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
     17 * this warranty disclaimer.
     18 */
     19
     20#include "decl.h"
     21#include "ioctl.h"
     22#include "util.h"
     23#include "fw.h"
     24#include "main.h"
     25#include "wmm.h"
     26#include "11n.h"
     27
     28static struct mwifiex_debug_data items[] = {
     29	{"debug_mask", item_size(debug_mask),
     30	 item_addr(debug_mask), 1},
     31	{"int_counter", item_size(int_counter),
     32	 item_addr(int_counter), 1},
     33	{"wmm_ac_vo", item_size(packets_out[WMM_AC_VO]),
     34	 item_addr(packets_out[WMM_AC_VO]), 1},
     35	{"wmm_ac_vi", item_size(packets_out[WMM_AC_VI]),
     36	 item_addr(packets_out[WMM_AC_VI]), 1},
     37	{"wmm_ac_be", item_size(packets_out[WMM_AC_BE]),
     38	 item_addr(packets_out[WMM_AC_BE]), 1},
     39	{"wmm_ac_bk", item_size(packets_out[WMM_AC_BK]),
     40	 item_addr(packets_out[WMM_AC_BK]), 1},
     41	{"tx_buf_size", item_size(tx_buf_size),
     42	 item_addr(tx_buf_size), 1},
     43	{"curr_tx_buf_size", item_size(curr_tx_buf_size),
     44	 item_addr(curr_tx_buf_size), 1},
     45	{"ps_mode", item_size(ps_mode),
     46	 item_addr(ps_mode), 1},
     47	{"ps_state", item_size(ps_state),
     48	 item_addr(ps_state), 1},
     49	{"is_deep_sleep", item_size(is_deep_sleep),
     50	 item_addr(is_deep_sleep), 1},
     51	{"wakeup_dev_req", item_size(pm_wakeup_card_req),
     52	 item_addr(pm_wakeup_card_req), 1},
     53	{"wakeup_tries", item_size(pm_wakeup_fw_try),
     54	 item_addr(pm_wakeup_fw_try), 1},
     55	{"hs_configured", item_size(is_hs_configured),
     56	 item_addr(is_hs_configured), 1},
     57	{"hs_activated", item_size(hs_activated),
     58	 item_addr(hs_activated), 1},
     59	{"num_tx_timeout", item_size(num_tx_timeout),
     60	 item_addr(num_tx_timeout), 1},
     61	{"is_cmd_timedout", item_size(is_cmd_timedout),
     62	 item_addr(is_cmd_timedout), 1},
     63	{"timeout_cmd_id", item_size(timeout_cmd_id),
     64	 item_addr(timeout_cmd_id), 1},
     65	{"timeout_cmd_act", item_size(timeout_cmd_act),
     66	 item_addr(timeout_cmd_act), 1},
     67	{"last_cmd_id", item_size(last_cmd_id),
     68	 item_addr(last_cmd_id), DBG_CMD_NUM},
     69	{"last_cmd_act", item_size(last_cmd_act),
     70	 item_addr(last_cmd_act), DBG_CMD_NUM},
     71	{"last_cmd_index", item_size(last_cmd_index),
     72	 item_addr(last_cmd_index), 1},
     73	{"last_cmd_resp_id", item_size(last_cmd_resp_id),
     74	 item_addr(last_cmd_resp_id), DBG_CMD_NUM},
     75	{"last_cmd_resp_index", item_size(last_cmd_resp_index),
     76	 item_addr(last_cmd_resp_index), 1},
     77	{"last_event", item_size(last_event),
     78	 item_addr(last_event), DBG_CMD_NUM},
     79	{"last_event_index", item_size(last_event_index),
     80	 item_addr(last_event_index), 1},
     81	{"last_mp_wr_bitmap", item_size(last_mp_wr_bitmap),
     82	 item_addr(last_mp_wr_bitmap), MWIFIEX_DBG_SDIO_MP_NUM},
     83	{"last_mp_wr_ports", item_size(last_mp_wr_ports),
     84	 item_addr(last_mp_wr_ports), MWIFIEX_DBG_SDIO_MP_NUM},
     85	{"last_mp_wr_len", item_size(last_mp_wr_len),
     86	 item_addr(last_mp_wr_len), MWIFIEX_DBG_SDIO_MP_NUM},
     87	{"last_mp_curr_wr_port", item_size(last_mp_curr_wr_port),
     88	 item_addr(last_mp_curr_wr_port), MWIFIEX_DBG_SDIO_MP_NUM},
     89	{"last_sdio_mp_index", item_size(last_sdio_mp_index),
     90	 item_addr(last_sdio_mp_index), 1},
     91	{"num_cmd_h2c_fail", item_size(num_cmd_host_to_card_failure),
     92	 item_addr(num_cmd_host_to_card_failure), 1},
     93	{"num_cmd_sleep_cfm_fail",
     94	 item_size(num_cmd_sleep_cfm_host_to_card_failure),
     95	 item_addr(num_cmd_sleep_cfm_host_to_card_failure), 1},
     96	{"num_tx_h2c_fail", item_size(num_tx_host_to_card_failure),
     97	 item_addr(num_tx_host_to_card_failure), 1},
     98	{"num_evt_deauth", item_size(num_event_deauth),
     99	 item_addr(num_event_deauth), 1},
    100	{"num_evt_disassoc", item_size(num_event_disassoc),
    101	 item_addr(num_event_disassoc), 1},
    102	{"num_evt_link_lost", item_size(num_event_link_lost),
    103	 item_addr(num_event_link_lost), 1},
    104	{"num_cmd_deauth", item_size(num_cmd_deauth),
    105	 item_addr(num_cmd_deauth), 1},
    106	{"num_cmd_assoc_ok", item_size(num_cmd_assoc_success),
    107	 item_addr(num_cmd_assoc_success), 1},
    108	{"num_cmd_assoc_fail", item_size(num_cmd_assoc_failure),
    109	 item_addr(num_cmd_assoc_failure), 1},
    110	{"cmd_sent", item_size(cmd_sent),
    111	 item_addr(cmd_sent), 1},
    112	{"data_sent", item_size(data_sent),
    113	 item_addr(data_sent), 1},
    114	{"cmd_resp_received", item_size(cmd_resp_received),
    115	 item_addr(cmd_resp_received), 1},
    116	{"event_received", item_size(event_received),
    117	 item_addr(event_received), 1},
    118
    119	/* variables defined in struct mwifiex_adapter */
    120	{"cmd_pending", adapter_item_size(cmd_pending),
    121	 adapter_item_addr(cmd_pending), 1},
    122	{"tx_pending", adapter_item_size(tx_pending),
    123	 adapter_item_addr(tx_pending), 1},
    124	{"rx_pending", adapter_item_size(rx_pending),
    125	 adapter_item_addr(rx_pending), 1},
    126};
    127
    128static int num_of_items = ARRAY_SIZE(items);
    129
    130/*
    131 * Firmware initialization complete callback handler.
    132 *
    133 * This function wakes up the function waiting on the init
    134 * wait queue for the firmware initialization to complete.
    135 */
    136int mwifiex_init_fw_complete(struct mwifiex_adapter *adapter)
    137{
    138
    139	if (adapter->hw_status == MWIFIEX_HW_STATUS_READY)
    140		if (adapter->if_ops.init_fw_port)
    141			adapter->if_ops.init_fw_port(adapter);
    142
    143	adapter->init_wait_q_woken = true;
    144	wake_up_interruptible(&adapter->init_wait_q);
    145	return 0;
    146}
    147
    148/*
    149 * This function sends init/shutdown command
    150 * to firmware.
    151 */
    152int mwifiex_init_shutdown_fw(struct mwifiex_private *priv,
    153			     u32 func_init_shutdown)
    154{
    155	u16 cmd;
    156
    157	if (func_init_shutdown == MWIFIEX_FUNC_INIT) {
    158		cmd = HostCmd_CMD_FUNC_INIT;
    159	} else if (func_init_shutdown == MWIFIEX_FUNC_SHUTDOWN) {
    160		cmd = HostCmd_CMD_FUNC_SHUTDOWN;
    161	} else {
    162		mwifiex_dbg(priv->adapter, ERROR,
    163			    "unsupported parameter\n");
    164		return -1;
    165	}
    166
    167	return mwifiex_send_cmd(priv, cmd, HostCmd_ACT_GEN_SET, 0, NULL, true);
    168}
    169EXPORT_SYMBOL_GPL(mwifiex_init_shutdown_fw);
    170
    171/*
    172 * IOCTL request handler to set/get debug information.
    173 *
    174 * This function collates/sets the information from/to different driver
    175 * structures.
    176 */
    177int mwifiex_get_debug_info(struct mwifiex_private *priv,
    178			   struct mwifiex_debug_info *info)
    179{
    180	struct mwifiex_adapter *adapter = priv->adapter;
    181
    182	if (info) {
    183		info->debug_mask = adapter->debug_mask;
    184		memcpy(info->packets_out,
    185		       priv->wmm.packets_out,
    186		       sizeof(priv->wmm.packets_out));
    187		info->curr_tx_buf_size = (u32) adapter->curr_tx_buf_size;
    188		info->tx_buf_size = (u32) adapter->tx_buf_size;
    189		info->rx_tbl_num = mwifiex_get_rx_reorder_tbl(priv,
    190							      info->rx_tbl);
    191		info->tx_tbl_num = mwifiex_get_tx_ba_stream_tbl(priv,
    192								info->tx_tbl);
    193		info->tdls_peer_num = mwifiex_get_tdls_list(priv,
    194							    info->tdls_list);
    195		info->ps_mode = adapter->ps_mode;
    196		info->ps_state = adapter->ps_state;
    197		info->is_deep_sleep = adapter->is_deep_sleep;
    198		info->pm_wakeup_card_req = adapter->pm_wakeup_card_req;
    199		info->pm_wakeup_fw_try = adapter->pm_wakeup_fw_try;
    200		info->is_hs_configured = test_bit(MWIFIEX_IS_HS_CONFIGURED,
    201						  &adapter->work_flags);
    202		info->hs_activated = adapter->hs_activated;
    203		info->is_cmd_timedout = test_bit(MWIFIEX_IS_CMD_TIMEDOUT,
    204						 &adapter->work_flags);
    205		info->num_cmd_host_to_card_failure
    206				= adapter->dbg.num_cmd_host_to_card_failure;
    207		info->num_cmd_sleep_cfm_host_to_card_failure
    208			= adapter->dbg.num_cmd_sleep_cfm_host_to_card_failure;
    209		info->num_tx_host_to_card_failure
    210				= adapter->dbg.num_tx_host_to_card_failure;
    211		info->num_event_deauth = adapter->dbg.num_event_deauth;
    212		info->num_event_disassoc = adapter->dbg.num_event_disassoc;
    213		info->num_event_link_lost = adapter->dbg.num_event_link_lost;
    214		info->num_cmd_deauth = adapter->dbg.num_cmd_deauth;
    215		info->num_cmd_assoc_success =
    216					adapter->dbg.num_cmd_assoc_success;
    217		info->num_cmd_assoc_failure =
    218					adapter->dbg.num_cmd_assoc_failure;
    219		info->num_tx_timeout = adapter->dbg.num_tx_timeout;
    220		info->timeout_cmd_id = adapter->dbg.timeout_cmd_id;
    221		info->timeout_cmd_act = adapter->dbg.timeout_cmd_act;
    222		memcpy(info->last_cmd_id, adapter->dbg.last_cmd_id,
    223		       sizeof(adapter->dbg.last_cmd_id));
    224		memcpy(info->last_cmd_act, adapter->dbg.last_cmd_act,
    225		       sizeof(adapter->dbg.last_cmd_act));
    226		info->last_cmd_index = adapter->dbg.last_cmd_index;
    227		memcpy(info->last_cmd_resp_id, adapter->dbg.last_cmd_resp_id,
    228		       sizeof(adapter->dbg.last_cmd_resp_id));
    229		info->last_cmd_resp_index = adapter->dbg.last_cmd_resp_index;
    230		memcpy(info->last_event, adapter->dbg.last_event,
    231		       sizeof(adapter->dbg.last_event));
    232		info->last_event_index = adapter->dbg.last_event_index;
    233		memcpy(info->last_mp_wr_bitmap, adapter->dbg.last_mp_wr_bitmap,
    234		       sizeof(adapter->dbg.last_mp_wr_bitmap));
    235		memcpy(info->last_mp_wr_ports, adapter->dbg.last_mp_wr_ports,
    236		       sizeof(adapter->dbg.last_mp_wr_ports));
    237		memcpy(info->last_mp_curr_wr_port,
    238		       adapter->dbg.last_mp_curr_wr_port,
    239		       sizeof(adapter->dbg.last_mp_curr_wr_port));
    240		memcpy(info->last_mp_wr_len, adapter->dbg.last_mp_wr_len,
    241		       sizeof(adapter->dbg.last_mp_wr_len));
    242		info->last_sdio_mp_index = adapter->dbg.last_sdio_mp_index;
    243		info->data_sent = adapter->data_sent;
    244		info->cmd_sent = adapter->cmd_sent;
    245		info->cmd_resp_received = adapter->cmd_resp_received;
    246	}
    247
    248	return 0;
    249}
    250
    251int mwifiex_debug_info_to_buffer(struct mwifiex_private *priv, char *buf,
    252				 struct mwifiex_debug_info *info)
    253{
    254	char *p = buf;
    255	struct mwifiex_debug_data *d = &items[0];
    256	size_t size, addr;
    257	long val;
    258	int i, j;
    259
    260	if (!info)
    261		return 0;
    262
    263	for (i = 0; i < num_of_items; i++) {
    264		p += sprintf(p, "%s=", d[i].name);
    265
    266		size = d[i].size / d[i].num;
    267
    268		if (i < (num_of_items - 3))
    269			addr = d[i].addr + (size_t)info;
    270		else /* The last 3 items are struct mwifiex_adapter variables */
    271			addr = d[i].addr + (size_t)priv->adapter;
    272
    273		for (j = 0; j < d[i].num; j++) {
    274			switch (size) {
    275			case 1:
    276				val = *((u8 *)addr);
    277				break;
    278			case 2:
    279				val = get_unaligned((u16 *)addr);
    280				break;
    281			case 4:
    282				val = get_unaligned((u32 *)addr);
    283				break;
    284			case 8:
    285				val = get_unaligned((long long *)addr);
    286				break;
    287			default:
    288				val = -1;
    289				break;
    290			}
    291
    292			p += sprintf(p, "%#lx ", val);
    293			addr += size;
    294		}
    295
    296		p += sprintf(p, "\n");
    297	}
    298
    299	if (info->tx_tbl_num) {
    300		p += sprintf(p, "Tx BA stream table:\n");
    301		for (i = 0; i < info->tx_tbl_num; i++)
    302			p += sprintf(p, "tid = %d, ra = %pM\n",
    303				     info->tx_tbl[i].tid, info->tx_tbl[i].ra);
    304	}
    305
    306	if (info->rx_tbl_num) {
    307		p += sprintf(p, "Rx reorder table:\n");
    308		for (i = 0; i < info->rx_tbl_num; i++) {
    309			p += sprintf(p, "tid = %d, ta = %pM, ",
    310				     info->rx_tbl[i].tid,
    311				     info->rx_tbl[i].ta);
    312			p += sprintf(p, "start_win = %d, ",
    313				     info->rx_tbl[i].start_win);
    314			p += sprintf(p, "win_size = %d, buffer: ",
    315				     info->rx_tbl[i].win_size);
    316
    317			for (j = 0; j < info->rx_tbl[i].win_size; j++)
    318				p += sprintf(p, "%c ",
    319					     info->rx_tbl[i].buffer[j] ?
    320					     '1' : '0');
    321
    322			p += sprintf(p, "\n");
    323		}
    324	}
    325
    326	if (info->tdls_peer_num) {
    327		p += sprintf(p, "TDLS peer table:\n");
    328		for (i = 0; i < info->tdls_peer_num; i++) {
    329			p += sprintf(p, "peer = %pM",
    330				     info->tdls_list[i].peer_addr);
    331			p += sprintf(p, "\n");
    332		}
    333	}
    334
    335	return p - buf;
    336}
    337
    338static int
    339mwifiex_parse_mgmt_packet(struct mwifiex_private *priv, u8 *payload, u16 len,
    340			  struct rxpd *rx_pd)
    341{
    342	u16 stype;
    343	u8 category, action_code, *addr2;
    344	struct ieee80211_hdr *ieee_hdr = (void *)payload;
    345
    346	stype = (le16_to_cpu(ieee_hdr->frame_control) & IEEE80211_FCTL_STYPE);
    347
    348	switch (stype) {
    349	case IEEE80211_STYPE_ACTION:
    350		category = *(payload + sizeof(struct ieee80211_hdr));
    351		switch (category) {
    352		case WLAN_CATEGORY_PUBLIC:
    353			action_code = *(payload + sizeof(struct ieee80211_hdr)
    354					+ 1);
    355			if (action_code == WLAN_PUB_ACTION_TDLS_DISCOVER_RES) {
    356				addr2 = ieee_hdr->addr2;
    357				mwifiex_dbg(priv->adapter, INFO,
    358					    "TDLS discovery response %pM nf=%d, snr=%d\n",
    359					    addr2, rx_pd->nf, rx_pd->snr);
    360				mwifiex_auto_tdls_update_peer_signal(priv,
    361								     addr2,
    362								     rx_pd->snr,
    363								     rx_pd->nf);
    364			}
    365			break;
    366		case WLAN_CATEGORY_BACK:
    367			/*we dont indicate BACK action frames to cfg80211*/
    368			mwifiex_dbg(priv->adapter, INFO,
    369				    "drop BACK action frames");
    370			return -1;
    371		default:
    372			mwifiex_dbg(priv->adapter, INFO,
    373				    "unknown public action frame category %d\n",
    374				    category);
    375		}
    376		break;
    377	default:
    378		mwifiex_dbg(priv->adapter, INFO,
    379		    "unknown mgmt frame subtype %#x\n", stype);
    380		return 0;
    381	}
    382
    383	return 0;
    384}
    385/*
    386 * This function processes the received management packet and send it
    387 * to the kernel.
    388 */
    389int
    390mwifiex_process_mgmt_packet(struct mwifiex_private *priv,
    391			    struct sk_buff *skb)
    392{
    393	struct rxpd *rx_pd;
    394	u16 pkt_len;
    395	struct ieee80211_hdr *ieee_hdr;
    396
    397	if (!skb)
    398		return -1;
    399
    400	if (!priv->mgmt_frame_mask ||
    401	    priv->wdev.iftype == NL80211_IFTYPE_UNSPECIFIED) {
    402		mwifiex_dbg(priv->adapter, ERROR,
    403			    "do not receive mgmt frames on uninitialized intf");
    404		return -1;
    405	}
    406
    407	rx_pd = (struct rxpd *)skb->data;
    408
    409	skb_pull(skb, le16_to_cpu(rx_pd->rx_pkt_offset));
    410	skb_pull(skb, sizeof(pkt_len));
    411
    412	pkt_len = le16_to_cpu(rx_pd->rx_pkt_length);
    413
    414	ieee_hdr = (void *)skb->data;
    415	if (ieee80211_is_mgmt(ieee_hdr->frame_control)) {
    416		if (mwifiex_parse_mgmt_packet(priv, (u8 *)ieee_hdr,
    417					      pkt_len, rx_pd))
    418			return -1;
    419	}
    420	/* Remove address4 */
    421	memmove(skb->data + sizeof(struct ieee80211_hdr_3addr),
    422		skb->data + sizeof(struct ieee80211_hdr),
    423		pkt_len - sizeof(struct ieee80211_hdr));
    424
    425	pkt_len -= ETH_ALEN + sizeof(pkt_len);
    426	rx_pd->rx_pkt_length = cpu_to_le16(pkt_len);
    427
    428	cfg80211_rx_mgmt(&priv->wdev, priv->roc_cfg.chan.center_freq,
    429			 CAL_RSSI(rx_pd->snr, rx_pd->nf), skb->data, pkt_len,
    430			 0);
    431
    432	return 0;
    433}
    434
    435/*
    436 * This function processes the received packet before sending it to the
    437 * kernel.
    438 *
    439 * It extracts the SKB from the received buffer and sends it to kernel.
    440 * In case the received buffer does not contain the data in SKB format,
    441 * the function creates a blank SKB, fills it with the data from the
    442 * received buffer and then sends this new SKB to the kernel.
    443 */
    444int mwifiex_recv_packet(struct mwifiex_private *priv, struct sk_buff *skb)
    445{
    446	struct mwifiex_sta_node *src_node;
    447	struct ethhdr *p_ethhdr;
    448
    449	if (!skb)
    450		return -1;
    451
    452	priv->stats.rx_bytes += skb->len;
    453	priv->stats.rx_packets++;
    454
    455	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) {
    456		p_ethhdr = (void *)skb->data;
    457		src_node = mwifiex_get_sta_entry(priv, p_ethhdr->h_source);
    458		if (src_node) {
    459			src_node->stats.last_rx = jiffies;
    460			src_node->stats.rx_bytes += skb->len;
    461			src_node->stats.rx_packets++;
    462		}
    463	}
    464
    465	skb->dev = priv->netdev;
    466	skb->protocol = eth_type_trans(skb, priv->netdev);
    467	skb->ip_summed = CHECKSUM_NONE;
    468
    469	/* This is required only in case of 11n and USB/PCIE as we alloc
    470	 * a buffer of 4K only if its 11N (to be able to receive 4K
    471	 * AMSDU packets). In case of SD we allocate buffers based
    472	 * on the size of packet and hence this is not needed.
    473	 *
    474	 * Modifying the truesize here as our allocation for each
    475	 * skb is 4K but we only receive 2K packets and this cause
    476	 * the kernel to start dropping packets in case where
    477	 * application has allocated buffer based on 2K size i.e.
    478	 * if there a 64K packet received (in IP fragments and
    479	 * application allocates 64K to receive this packet but
    480	 * this packet would almost double up because we allocate
    481	 * each 1.5K fragment in 4K and pass it up. As soon as the
    482	 * 64K limit hits kernel will start to drop rest of the
    483	 * fragments. Currently we fail the Filesndl-ht.scr script
    484	 * for UDP, hence this fix
    485	 */
    486	if ((priv->adapter->iface_type == MWIFIEX_USB ||
    487	     priv->adapter->iface_type == MWIFIEX_PCIE) &&
    488	    (skb->truesize > MWIFIEX_RX_DATA_BUF_SIZE))
    489		skb->truesize += (skb->len - MWIFIEX_RX_DATA_BUF_SIZE);
    490
    491	netif_rx(skb);
    492	return 0;
    493}
    494
    495/*
    496 * IOCTL completion callback handler.
    497 *
    498 * This function is called when a pending IOCTL is completed.
    499 *
    500 * If work queue support is enabled, the function wakes up the
    501 * corresponding waiting function. Otherwise, it processes the
    502 * IOCTL response and frees the response buffer.
    503 */
    504int mwifiex_complete_cmd(struct mwifiex_adapter *adapter,
    505			 struct cmd_ctrl_node *cmd_node)
    506{
    507	WARN_ON(!cmd_node->wait_q_enabled);
    508	mwifiex_dbg(adapter, CMD, "cmd completed: status=%d\n",
    509		    adapter->cmd_wait_q.status);
    510
    511	*cmd_node->condition = true;
    512	wake_up_interruptible(&adapter->cmd_wait_q.wait);
    513
    514	return 0;
    515}
    516
    517/* This function will return the pointer to station entry in station list
    518 * table which matches specified mac address.
    519 * This function should be called after acquiring RA list spinlock.
    520 * NULL is returned if station entry is not found in associated STA list.
    521 */
    522struct mwifiex_sta_node *
    523mwifiex_get_sta_entry(struct mwifiex_private *priv, const u8 *mac)
    524{
    525	struct mwifiex_sta_node *node;
    526
    527	if (!mac)
    528		return NULL;
    529
    530	list_for_each_entry(node, &priv->sta_list, list) {
    531		if (!memcmp(node->mac_addr, mac, ETH_ALEN))
    532			return node;
    533	}
    534
    535	return NULL;
    536}
    537
    538static struct mwifiex_sta_node *
    539mwifiex_get_tdls_sta_entry(struct mwifiex_private *priv, u8 status)
    540{
    541	struct mwifiex_sta_node *node;
    542
    543	list_for_each_entry(node, &priv->sta_list, list) {
    544		if (node->tdls_status == status)
    545			return node;
    546	}
    547
    548	return NULL;
    549}
    550
    551/* If tdls channel switching is on-going, tx data traffic should be
    552 * blocked until the switching stage completed.
    553 */
    554u8 mwifiex_is_tdls_chan_switching(struct mwifiex_private *priv)
    555{
    556	struct mwifiex_sta_node *sta_ptr;
    557
    558	if (!priv || !ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info))
    559		return false;
    560
    561	sta_ptr = mwifiex_get_tdls_sta_entry(priv, TDLS_CHAN_SWITCHING);
    562	if (sta_ptr)
    563		return true;
    564
    565	return false;
    566}
    567
    568u8 mwifiex_is_tdls_off_chan(struct mwifiex_private *priv)
    569{
    570	struct mwifiex_sta_node *sta_ptr;
    571
    572	if (!priv || !ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info))
    573		return false;
    574
    575	sta_ptr = mwifiex_get_tdls_sta_entry(priv, TDLS_IN_OFF_CHAN);
    576	if (sta_ptr)
    577		return true;
    578
    579	return false;
    580}
    581
    582/* If tdls channel switching is on-going or tdls operate on off-channel,
    583 * cmd path should be blocked until tdls switched to base-channel.
    584 */
    585u8 mwifiex_is_send_cmd_allowed(struct mwifiex_private *priv)
    586{
    587	if (!priv || !ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info))
    588		return true;
    589
    590	if (mwifiex_is_tdls_chan_switching(priv) ||
    591	    mwifiex_is_tdls_off_chan(priv))
    592		return false;
    593
    594	return true;
    595}
    596
    597/* This function will add a sta_node entry to associated station list
    598 * table with the given mac address.
    599 * If entry exist already, existing entry is returned.
    600 * If received mac address is NULL, NULL is returned.
    601 */
    602struct mwifiex_sta_node *
    603mwifiex_add_sta_entry(struct mwifiex_private *priv, const u8 *mac)
    604{
    605	struct mwifiex_sta_node *node;
    606
    607	if (!mac)
    608		return NULL;
    609
    610	spin_lock_bh(&priv->sta_list_spinlock);
    611	node = mwifiex_get_sta_entry(priv, mac);
    612	if (node)
    613		goto done;
    614
    615	node = kzalloc(sizeof(*node), GFP_ATOMIC);
    616	if (!node)
    617		goto done;
    618
    619	memcpy(node->mac_addr, mac, ETH_ALEN);
    620	list_add_tail(&node->list, &priv->sta_list);
    621
    622done:
    623	spin_unlock_bh(&priv->sta_list_spinlock);
    624	return node;
    625}
    626
    627/* This function will search for HT IE in association request IEs
    628 * and set station HT parameters accordingly.
    629 */
    630void
    631mwifiex_set_sta_ht_cap(struct mwifiex_private *priv, const u8 *ies,
    632		       int ies_len, struct mwifiex_sta_node *node)
    633{
    634	struct ieee_types_header *ht_cap_ie;
    635	const struct ieee80211_ht_cap *ht_cap;
    636
    637	if (!ies)
    638		return;
    639
    640	ht_cap_ie = (void *)cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies,
    641					     ies_len);
    642	if (ht_cap_ie) {
    643		ht_cap = (void *)(ht_cap_ie + 1);
    644		node->is_11n_enabled = 1;
    645		node->max_amsdu = le16_to_cpu(ht_cap->cap_info) &
    646				  IEEE80211_HT_CAP_MAX_AMSDU ?
    647				  MWIFIEX_TX_DATA_BUF_SIZE_8K :
    648				  MWIFIEX_TX_DATA_BUF_SIZE_4K;
    649	} else {
    650		node->is_11n_enabled = 0;
    651	}
    652
    653	return;
    654}
    655
    656/* This function will delete a station entry from station list */
    657void mwifiex_del_sta_entry(struct mwifiex_private *priv, const u8 *mac)
    658{
    659	struct mwifiex_sta_node *node;
    660
    661	spin_lock_bh(&priv->sta_list_spinlock);
    662
    663	node = mwifiex_get_sta_entry(priv, mac);
    664	if (node) {
    665		list_del(&node->list);
    666		kfree(node);
    667	}
    668
    669	spin_unlock_bh(&priv->sta_list_spinlock);
    670	return;
    671}
    672
    673/* This function will delete all stations from associated station list. */
    674void mwifiex_del_all_sta_list(struct mwifiex_private *priv)
    675{
    676	struct mwifiex_sta_node *node, *tmp;
    677
    678	spin_lock_bh(&priv->sta_list_spinlock);
    679
    680	list_for_each_entry_safe(node, tmp, &priv->sta_list, list) {
    681		list_del(&node->list);
    682		kfree(node);
    683	}
    684
    685	INIT_LIST_HEAD(&priv->sta_list);
    686	spin_unlock_bh(&priv->sta_list_spinlock);
    687	return;
    688}
    689
    690/* This function adds histogram data to histogram array*/
    691void mwifiex_hist_data_add(struct mwifiex_private *priv,
    692			   u8 rx_rate, s8 snr, s8 nflr)
    693{
    694	struct mwifiex_histogram_data *phist_data = priv->hist_data;
    695
    696	if (atomic_read(&phist_data->num_samples) > MWIFIEX_HIST_MAX_SAMPLES)
    697		mwifiex_hist_data_reset(priv);
    698	mwifiex_hist_data_set(priv, rx_rate, snr, nflr);
    699}
    700
    701/* function to add histogram record */
    702void mwifiex_hist_data_set(struct mwifiex_private *priv, u8 rx_rate, s8 snr,
    703			   s8 nflr)
    704{
    705	struct mwifiex_histogram_data *phist_data = priv->hist_data;
    706	s8 nf   = -nflr;
    707	s8 rssi = snr - nflr;
    708
    709	atomic_inc(&phist_data->num_samples);
    710	atomic_inc(&phist_data->rx_rate[rx_rate]);
    711	atomic_inc(&phist_data->snr[snr + 128]);
    712	atomic_inc(&phist_data->noise_flr[nf + 128]);
    713	atomic_inc(&phist_data->sig_str[rssi + 128]);
    714}
    715
    716/* function to reset histogram data during init/reset */
    717void mwifiex_hist_data_reset(struct mwifiex_private *priv)
    718{
    719	int ix;
    720	struct mwifiex_histogram_data *phist_data = priv->hist_data;
    721
    722	atomic_set(&phist_data->num_samples, 0);
    723	for (ix = 0; ix < MWIFIEX_MAX_AC_RX_RATES; ix++)
    724		atomic_set(&phist_data->rx_rate[ix], 0);
    725	for (ix = 0; ix < MWIFIEX_MAX_SNR; ix++)
    726		atomic_set(&phist_data->snr[ix], 0);
    727	for (ix = 0; ix < MWIFIEX_MAX_NOISE_FLR; ix++)
    728		atomic_set(&phist_data->noise_flr[ix], 0);
    729	for (ix = 0; ix < MWIFIEX_MAX_SIG_STRENGTH; ix++)
    730		atomic_set(&phist_data->sig_str[ix], 0);
    731}
    732
    733void *mwifiex_alloc_dma_align_buf(int rx_len, gfp_t flags)
    734{
    735	struct sk_buff *skb;
    736	int buf_len, pad;
    737
    738	buf_len = rx_len + MWIFIEX_RX_HEADROOM + MWIFIEX_DMA_ALIGN_SZ;
    739
    740	skb = __dev_alloc_skb(buf_len, flags);
    741
    742	if (!skb)
    743		return NULL;
    744
    745	skb_reserve(skb, MWIFIEX_RX_HEADROOM);
    746
    747	pad = MWIFIEX_ALIGN_ADDR(skb->data, MWIFIEX_DMA_ALIGN_SZ) -
    748	      (long)skb->data;
    749
    750	skb_reserve(skb, pad);
    751
    752	return skb;
    753}
    754EXPORT_SYMBOL_GPL(mwifiex_alloc_dma_align_buf);
    755
    756void mwifiex_fw_dump_event(struct mwifiex_private *priv)
    757{
    758	mwifiex_send_cmd(priv, HostCmd_CMD_FW_DUMP_EVENT, HostCmd_ACT_GEN_SET,
    759			 0, NULL, true);
    760}
    761EXPORT_SYMBOL_GPL(mwifiex_fw_dump_event);