xref: /linux/drivers/net/wireless/nxp/nxpwifi/cfg80211.c (revision 91ec2035134982b98fab0609a9fd8480e8217dc1)
173b01e57SJeff Chen // SPDX-License-Identifier: GPL-2.0-only
273b01e57SJeff Chen /*
373b01e57SJeff Chen  * nxpwifi: cfg80211 support
473b01e57SJeff Chen  *
573b01e57SJeff Chen  * Copyright 2011-2024 NXP
673b01e57SJeff Chen  */
773b01e57SJeff Chen 
873b01e57SJeff Chen #include "cfg80211.h"
973b01e57SJeff Chen #include "main.h"
1073b01e57SJeff Chen #include "cmdevt.h"
1173b01e57SJeff Chen #include "11n.h"
1273b01e57SJeff Chen #include "wmm.h"
1373b01e57SJeff Chen 
1473b01e57SJeff Chen static const struct ieee80211_iface_limit nxpwifi_ap_sta_limits[] = {
1573b01e57SJeff Chen 	{
1673b01e57SJeff Chen 		.max = NXPWIFI_MAX_BSS_NUM,
1773b01e57SJeff Chen 		.types = BIT(NL80211_IFTYPE_STATION) |
1873b01e57SJeff Chen 			 BIT(NL80211_IFTYPE_AP) |
1973b01e57SJeff Chen 			 BIT(NL80211_IFTYPE_MONITOR),
2073b01e57SJeff Chen 	},
2173b01e57SJeff Chen };
2273b01e57SJeff Chen 
2373b01e57SJeff Chen static const struct ieee80211_iface_combination
2473b01e57SJeff Chen nxpwifi_iface_comb_ap_sta = {
2573b01e57SJeff Chen 	.limits = nxpwifi_ap_sta_limits,
2673b01e57SJeff Chen 	.num_different_channels = 1,
2773b01e57SJeff Chen 	.n_limits = ARRAY_SIZE(nxpwifi_ap_sta_limits),
2873b01e57SJeff Chen 	.max_interfaces = NXPWIFI_MAX_BSS_NUM,
2973b01e57SJeff Chen 	.beacon_int_infra_match = true,
3073b01e57SJeff Chen 	.radar_detect_widths =	BIT(NL80211_CHAN_WIDTH_20_NOHT) |
3173b01e57SJeff Chen 				BIT(NL80211_CHAN_WIDTH_20) |
3273b01e57SJeff Chen 				BIT(NL80211_CHAN_WIDTH_40),
3373b01e57SJeff Chen };
3473b01e57SJeff Chen 
3573b01e57SJeff Chen static const struct ieee80211_iface_combination
3673b01e57SJeff Chen nxpwifi_iface_comb_ap_sta_vht = {
3773b01e57SJeff Chen 	.limits = nxpwifi_ap_sta_limits,
3873b01e57SJeff Chen 	.num_different_channels = 1,
3973b01e57SJeff Chen 	.n_limits = ARRAY_SIZE(nxpwifi_ap_sta_limits),
4073b01e57SJeff Chen 	.max_interfaces = NXPWIFI_MAX_BSS_NUM,
4173b01e57SJeff Chen 	.beacon_int_infra_match = true,
4273b01e57SJeff Chen 	.radar_detect_widths =	BIT(NL80211_CHAN_WIDTH_20_NOHT) |
4373b01e57SJeff Chen 				BIT(NL80211_CHAN_WIDTH_20) |
4473b01e57SJeff Chen 				BIT(NL80211_CHAN_WIDTH_40) |
4573b01e57SJeff Chen 				BIT(NL80211_CHAN_WIDTH_80),
4673b01e57SJeff Chen };
4773b01e57SJeff Chen 
4873b01e57SJeff Chen /* Map nl80211 channel types to secondary channel offsets */
nxpwifi_chan_type_to_sec_chan_offset(enum nl80211_channel_type chan_type)4973b01e57SJeff Chen u8 nxpwifi_chan_type_to_sec_chan_offset(enum nl80211_channel_type chan_type)
5073b01e57SJeff Chen {
5173b01e57SJeff Chen 	switch (chan_type) {
5273b01e57SJeff Chen 	case NL80211_CHAN_NO_HT:
5373b01e57SJeff Chen 	case NL80211_CHAN_HT20:
5473b01e57SJeff Chen 		return IEEE80211_HT_PARAM_CHA_SEC_NONE;
5573b01e57SJeff Chen 	case NL80211_CHAN_HT40PLUS:
5673b01e57SJeff Chen 		return IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
5773b01e57SJeff Chen 	case NL80211_CHAN_HT40MINUS:
5873b01e57SJeff Chen 		return IEEE80211_HT_PARAM_CHA_SEC_BELOW;
5973b01e57SJeff Chen 	default:
6073b01e57SJeff Chen 		return IEEE80211_HT_PARAM_CHA_SEC_NONE;
6173b01e57SJeff Chen 	}
6273b01e57SJeff Chen }
6373b01e57SJeff Chen 
6473b01e57SJeff Chen /* Map IEEE HT secondary‑channel type to nl80211 channel type */
nxpwifi_get_chan_type(struct nxpwifi_private * priv)6573b01e57SJeff Chen u8 nxpwifi_get_chan_type(struct nxpwifi_private *priv)
6673b01e57SJeff Chen {
6773b01e57SJeff Chen 	struct nxpwifi_channel_band channel_band;
6873b01e57SJeff Chen 	int ret;
6973b01e57SJeff Chen 
7073b01e57SJeff Chen 	ret = nxpwifi_get_chan_info(priv, &channel_band);
7173b01e57SJeff Chen 
7273b01e57SJeff Chen 	if (!ret) {
7373b01e57SJeff Chen 		switch (channel_band.band_config.chan_width) {
7473b01e57SJeff Chen 		case CHAN_BW_20MHZ:
7573b01e57SJeff Chen 			if (IS_11N_ENABLED(priv))
7673b01e57SJeff Chen 				return NL80211_CHAN_HT20;
7773b01e57SJeff Chen 			else
7873b01e57SJeff Chen 				return NL80211_CHAN_NO_HT;
7973b01e57SJeff Chen 		case CHAN_BW_40MHZ:
8073b01e57SJeff Chen 			if (channel_band.band_config.chan2_offset ==
8173b01e57SJeff Chen 			    IEEE80211_HT_PARAM_CHA_SEC_ABOVE)
8273b01e57SJeff Chen 				return NL80211_CHAN_HT40PLUS;
8373b01e57SJeff Chen 			else
8473b01e57SJeff Chen 				return NL80211_CHAN_HT40MINUS;
8573b01e57SJeff Chen 		default:
8673b01e57SJeff Chen 			return NL80211_CHAN_HT20;
8773b01e57SJeff Chen 		}
8873b01e57SJeff Chen 	}
8973b01e57SJeff Chen 
9073b01e57SJeff Chen 	return NL80211_CHAN_HT20;
9173b01e57SJeff Chen }
9273b01e57SJeff Chen 
9373b01e57SJeff Chen /* Retrieve the driver private data from the wiphy */
nxpwifi_cfg80211_get_adapter(struct wiphy * wiphy)9473b01e57SJeff Chen static void *nxpwifi_cfg80211_get_adapter(struct wiphy *wiphy)
9573b01e57SJeff Chen {
9673b01e57SJeff Chen 	return (void *)(*(unsigned long *)wiphy_priv(wiphy));
9773b01e57SJeff Chen }
9873b01e57SJeff Chen 
9973b01e57SJeff Chen /* cfg80211 operation handler to delete a network key. */
10073b01e57SJeff Chen static int
nxpwifi_cfg80211_del_key(struct wiphy * wiphy,struct wireless_dev * wdev,int link_id,u8 key_index,bool pairwise,const u8 * mac_addr)10173b01e57SJeff Chen nxpwifi_cfg80211_del_key(struct wiphy *wiphy, struct wireless_dev *wdev,
10273b01e57SJeff Chen 			 int link_id, u8 key_index, bool pairwise,
10373b01e57SJeff Chen 			 const u8 *mac_addr)
10473b01e57SJeff Chen {
10573b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
10673b01e57SJeff Chen 	static const u8 bc_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
10773b01e57SJeff Chen 	const u8 *peer_mac = pairwise ? mac_addr : bc_mac;
10873b01e57SJeff Chen 	int ret;
10973b01e57SJeff Chen 
11073b01e57SJeff Chen 	ret = nxpwifi_set_encode(priv, NULL, NULL, 0, key_index, peer_mac, 1);
11173b01e57SJeff Chen 	if (ret)
11273b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
11373b01e57SJeff Chen 			    "crypto keys deleted failed %d\n", ret);
11473b01e57SJeff Chen 	else
11573b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO, "info: crypto keys deleted\n");
11673b01e57SJeff Chen 
11773b01e57SJeff Chen 	return ret;
11873b01e57SJeff Chen }
11973b01e57SJeff Chen 
12073b01e57SJeff Chen /* Build an skb containing a management frame */
12173b01e57SJeff Chen static void
nxpwifi_form_mgmt_frame(struct sk_buff * skb,const u8 * buf,size_t len)12273b01e57SJeff Chen nxpwifi_form_mgmt_frame(struct sk_buff *skb, const u8 *buf, size_t len)
12373b01e57SJeff Chen {
12473b01e57SJeff Chen 	u8 addr[ETH_ALEN];
12573b01e57SJeff Chen 	u16 pkt_len;
12673b01e57SJeff Chen 	u32 tx_control = 0, pkt_type = PKT_TYPE_MGMT;
12773b01e57SJeff Chen 
12873b01e57SJeff Chen 	eth_broadcast_addr(addr);
12973b01e57SJeff Chen 	pkt_len = len + ETH_ALEN;
13073b01e57SJeff Chen 
13173b01e57SJeff Chen 	skb_reserve(skb, NXPWIFI_MIN_DATA_HEADER_LEN +
13273b01e57SJeff Chen 		    NXPWIFI_MGMT_FRAME_HEADER_SIZE + sizeof(pkt_len));
13373b01e57SJeff Chen 	memcpy(skb_push(skb, sizeof(pkt_len)), &pkt_len, sizeof(pkt_len));
13473b01e57SJeff Chen 
13573b01e57SJeff Chen 	memcpy(skb_push(skb, sizeof(tx_control)),
13673b01e57SJeff Chen 	       &tx_control, sizeof(tx_control));
13773b01e57SJeff Chen 
13873b01e57SJeff Chen 	memcpy(skb_push(skb, sizeof(pkt_type)), &pkt_type, sizeof(pkt_type));
13973b01e57SJeff Chen 
14073b01e57SJeff Chen 	/* Add packet data and address4 */
14173b01e57SJeff Chen 	skb_put_data(skb, buf, sizeof(struct ieee80211_hdr_3addr));
14273b01e57SJeff Chen 	skb_put_data(skb, addr, ETH_ALEN);
14373b01e57SJeff Chen 	skb_put_data(skb, buf + sizeof(struct ieee80211_hdr_3addr),
14473b01e57SJeff Chen 		     len - sizeof(struct ieee80211_hdr_3addr));
14573b01e57SJeff Chen 
14673b01e57SJeff Chen 	skb->priority = TC_PRIO_BESTEFFORT;
14773b01e57SJeff Chen 	__net_timestamp(skb);
14873b01e57SJeff Chen }
14973b01e57SJeff Chen 
15073b01e57SJeff Chen /* cfg80211 operation handler to transmit a management frame. */
15173b01e57SJeff Chen static int
nxpwifi_cfg80211_mgmt_tx(struct wiphy * wiphy,struct wireless_dev * wdev,struct cfg80211_mgmt_tx_params * params,u64 cookie)15273b01e57SJeff Chen nxpwifi_cfg80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
153914781c7SArend van Spriel 			 struct cfg80211_mgmt_tx_params *params, u64 cookie)
15473b01e57SJeff Chen {
15573b01e57SJeff Chen 	const u8 *buf = params->buf;
15673b01e57SJeff Chen 	size_t len = params->len;
15773b01e57SJeff Chen 	struct sk_buff *skb;
15873b01e57SJeff Chen 	u16 pkt_len;
15973b01e57SJeff Chen 	const struct ieee80211_mgmt *mgmt;
16073b01e57SJeff Chen 	struct nxpwifi_txinfo *tx_info;
16173b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
16273b01e57SJeff Chen 
16373b01e57SJeff Chen 	if (!buf || !len) {
16473b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR, "invalid buffer and length\n");
16573b01e57SJeff Chen 		return -EINVAL;
16673b01e57SJeff Chen 	}
16773b01e57SJeff Chen 
16873b01e57SJeff Chen 	mgmt = (const struct ieee80211_mgmt *)buf;
16973b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) != NXPWIFI_BSS_ROLE_STA &&
17073b01e57SJeff Chen 	    ieee80211_is_probe_resp(mgmt->frame_control)) {
17173b01e57SJeff Chen 		/* Offloaded probe responses; skip TX in AP/GO mode */
17273b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
17373b01e57SJeff Chen 			    "info: skip to send probe resp in AP or GO mode\n");
17473b01e57SJeff Chen 		return 0;
17573b01e57SJeff Chen 	}
17673b01e57SJeff Chen 
17773b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP) {
17873b01e57SJeff Chen 		if (ieee80211_is_auth(mgmt->frame_control))
17973b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, MSG,
18073b01e57SJeff Chen 				    "auth: send auth to %pM\n", mgmt->da);
18173b01e57SJeff Chen 		if (ieee80211_is_deauth(mgmt->frame_control))
18273b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, MSG,
18373b01e57SJeff Chen 				    "auth: send deauth to %pM\n", mgmt->da);
18473b01e57SJeff Chen 		if (ieee80211_is_disassoc(mgmt->frame_control))
18573b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, MSG,
18673b01e57SJeff Chen 				    "assoc: send disassoc to %pM\n", mgmt->da);
18773b01e57SJeff Chen 		if (ieee80211_is_assoc_resp(mgmt->frame_control))
18873b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, MSG,
18973b01e57SJeff Chen 				    "assoc: send assoc resp to %pM\n",
19073b01e57SJeff Chen 				    mgmt->da);
19173b01e57SJeff Chen 		if (ieee80211_is_reassoc_resp(mgmt->frame_control))
19273b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, MSG,
19373b01e57SJeff Chen 				    "assoc: send reassoc resp to %pM\n",
19473b01e57SJeff Chen 				    mgmt->da);
19573b01e57SJeff Chen 	}
19673b01e57SJeff Chen 
19773b01e57SJeff Chen 	pkt_len = len + ETH_ALEN;
19873b01e57SJeff Chen 	skb = dev_alloc_skb(NXPWIFI_MIN_DATA_HEADER_LEN +
19973b01e57SJeff Chen 			    NXPWIFI_MGMT_FRAME_HEADER_SIZE +
20073b01e57SJeff Chen 			    pkt_len + sizeof(pkt_len));
20173b01e57SJeff Chen 
20273b01e57SJeff Chen 	if (!skb) {
20373b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
20473b01e57SJeff Chen 			    "allocate skb failed for management frame\n");
20573b01e57SJeff Chen 		return -ENOMEM;
20673b01e57SJeff Chen 	}
20773b01e57SJeff Chen 
20873b01e57SJeff Chen 	tx_info = NXPWIFI_SKB_TXCB(skb);
20973b01e57SJeff Chen 	memset(tx_info, 0, sizeof(*tx_info));
21073b01e57SJeff Chen 	tx_info->bss_num = priv->bss_num;
21173b01e57SJeff Chen 	tx_info->bss_type = priv->bss_type;
21273b01e57SJeff Chen 	tx_info->pkt_len = pkt_len;
21373b01e57SJeff Chen 
21473b01e57SJeff Chen 	nxpwifi_form_mgmt_frame(skb, buf, len);
21573b01e57SJeff Chen 
21673b01e57SJeff Chen 	if (ieee80211_is_action(mgmt->frame_control))
21773b01e57SJeff Chen 		skb = nxpwifi_clone_skb_for_tx_status(priv,
21873b01e57SJeff Chen 						      skb,
219914781c7SArend van Spriel 				NXPWIFI_BUF_FLAG_ACTION_TX_STATUS, &cookie);
22073b01e57SJeff Chen 	else
221914781c7SArend van Spriel 		cfg80211_mgmt_tx_status(wdev, cookie, buf, len, true,
22273b01e57SJeff Chen 					GFP_ATOMIC);
22373b01e57SJeff Chen 
22473b01e57SJeff Chen 	nxpwifi_queue_tx_pkt(priv, skb);
22573b01e57SJeff Chen 
22673b01e57SJeff Chen 	nxpwifi_dbg(priv->adapter, INFO, "info: management frame transmitted\n");
22773b01e57SJeff Chen 	return 0;
22873b01e57SJeff Chen }
22973b01e57SJeff Chen 
23073b01e57SJeff Chen /* cfg80211 operation handler to register a mgmt frame. */
23173b01e57SJeff Chen static void
nxpwifi_cfg80211_update_mgmt_frame_registrations(struct wiphy * wiphy,struct wireless_dev * wdev,struct mgmt_frame_regs * upd)23273b01e57SJeff Chen nxpwifi_cfg80211_update_mgmt_frame_registrations(struct wiphy *wiphy,
23373b01e57SJeff Chen 						 struct wireless_dev *wdev,
23473b01e57SJeff Chen 						 struct mgmt_frame_regs *upd)
23573b01e57SJeff Chen {
23673b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
23773b01e57SJeff Chen 	u32 mask = upd->interface_stypes;
23873b01e57SJeff Chen 
23973b01e57SJeff Chen 	if (mask != priv->mgmt_frame_mask) {
24073b01e57SJeff Chen 		priv->mgmt_frame_mask = mask;
24173b01e57SJeff Chen 		if (priv->host_mlme_reg &&
24273b01e57SJeff Chen 		    GET_BSS_ROLE(priv) != NXPWIFI_BSS_ROLE_UAP)
24373b01e57SJeff Chen 			priv->mgmt_frame_mask |= HOST_MLME_MGMT_MASK;
24473b01e57SJeff Chen 
24573b01e57SJeff Chen 		nxpwifi_mgmt_frame_reg(priv, priv->mgmt_frame_mask);
24673b01e57SJeff Chen 
24773b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO, "info: mgmt frame registered\n");
24873b01e57SJeff Chen 	}
24973b01e57SJeff Chen }
25073b01e57SJeff Chen 
25173b01e57SJeff Chen /* cfg80211 operation handler to remain on channel. */
25273b01e57SJeff Chen static int
nxpwifi_cfg80211_remain_on_channel(struct wiphy * wiphy,struct wireless_dev * wdev,struct ieee80211_channel * chan,unsigned int duration,u64 cookie,const u8 * rx_addr)25373b01e57SJeff Chen nxpwifi_cfg80211_remain_on_channel(struct wiphy *wiphy,
25473b01e57SJeff Chen 				   struct wireless_dev *wdev,
25573b01e57SJeff Chen 				   struct ieee80211_channel *chan,
256914781c7SArend van Spriel 				   unsigned int duration, u64 cookie,
25773b01e57SJeff Chen 				   const u8 *rx_addr)
25873b01e57SJeff Chen {
25973b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
26073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
26173b01e57SJeff Chen 	int ret;
26273b01e57SJeff Chen 
263914781c7SArend van Spriel 	if (!chan) {
26473b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "Invalid parameter for ROC\n");
26573b01e57SJeff Chen 		return -EINVAL;
26673b01e57SJeff Chen 	}
26773b01e57SJeff Chen 
26873b01e57SJeff Chen 	if (priv->roc_cfg.cookie) {
26973b01e57SJeff Chen 		nxpwifi_dbg(adapter, INFO,
27073b01e57SJeff Chen 			    "info: ongoing ROC, cookie = 0x%llx\n",
27173b01e57SJeff Chen 			    priv->roc_cfg.cookie);
27273b01e57SJeff Chen 		return -EBUSY;
27373b01e57SJeff Chen 	}
27473b01e57SJeff Chen 
27573b01e57SJeff Chen 	ret = nxpwifi_remain_on_chan_cfg(priv, HOST_ACT_GEN_SET, chan,
27673b01e57SJeff Chen 					 duration);
27773b01e57SJeff Chen 
27873b01e57SJeff Chen 	if (!ret) {
279914781c7SArend van Spriel 		priv->roc_cfg.cookie = cookie;
28073b01e57SJeff Chen 		priv->roc_cfg.chan = *chan;
28173b01e57SJeff Chen 
282914781c7SArend van Spriel 		cfg80211_ready_on_channel(wdev, cookie, chan,
28373b01e57SJeff Chen 					  duration, GFP_ATOMIC);
28473b01e57SJeff Chen 
28573b01e57SJeff Chen 		nxpwifi_dbg(adapter, INFO,
286914781c7SArend van Spriel 			    "info: ROC, cookie = 0x%llx\n", cookie);
28773b01e57SJeff Chen 	}
28873b01e57SJeff Chen 
28973b01e57SJeff Chen 	return ret;
29073b01e57SJeff Chen }
29173b01e57SJeff Chen 
29273b01e57SJeff Chen /* cfg80211 operation handler to cancel remain on channel. */
29373b01e57SJeff Chen static int
nxpwifi_cfg80211_cancel_remain_on_channel(struct wiphy * wiphy,struct wireless_dev * wdev,u64 cookie)29473b01e57SJeff Chen nxpwifi_cfg80211_cancel_remain_on_channel(struct wiphy *wiphy,
29573b01e57SJeff Chen 					  struct wireless_dev *wdev, u64 cookie)
29673b01e57SJeff Chen {
29773b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
29873b01e57SJeff Chen 	int ret;
29973b01e57SJeff Chen 
30073b01e57SJeff Chen 	if (cookie != priv->roc_cfg.cookie)
30173b01e57SJeff Chen 		return -ENOENT;
30273b01e57SJeff Chen 
30373b01e57SJeff Chen 	ret = nxpwifi_remain_on_chan_cfg(priv, HOST_ACT_GEN_REMOVE,
30473b01e57SJeff Chen 					 &priv->roc_cfg.chan, 0);
30573b01e57SJeff Chen 
30673b01e57SJeff Chen 	if (!ret) {
30773b01e57SJeff Chen 		cfg80211_remain_on_channel_expired(wdev, cookie,
30873b01e57SJeff Chen 						   &priv->roc_cfg.chan,
30973b01e57SJeff Chen 						   GFP_ATOMIC);
31073b01e57SJeff Chen 
31173b01e57SJeff Chen 		memset(&priv->roc_cfg, 0, sizeof(struct nxpwifi_roc_cfg));
31273b01e57SJeff Chen 
31373b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
31473b01e57SJeff Chen 			    "info: cancel ROC, cookie = 0x%llx\n", cookie);
31573b01e57SJeff Chen 	}
31673b01e57SJeff Chen 
31773b01e57SJeff Chen 	return ret;
31873b01e57SJeff Chen }
31973b01e57SJeff Chen 
32073b01e57SJeff Chen /* cfg80211 operation handler to set Tx power. */
32173b01e57SJeff Chen static int
nxpwifi_cfg80211_set_tx_power(struct wiphy * wiphy,struct wireless_dev * wdev,int radio_idx,enum nl80211_tx_power_setting type,int mbm)32273b01e57SJeff Chen nxpwifi_cfg80211_set_tx_power(struct wiphy *wiphy,
32373b01e57SJeff Chen 			      struct wireless_dev *wdev,
32473b01e57SJeff Chen 			      int radio_idx,
32573b01e57SJeff Chen 			      enum nl80211_tx_power_setting type,
32673b01e57SJeff Chen 			      int mbm)
32773b01e57SJeff Chen {
32873b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
32973b01e57SJeff Chen 	struct nxpwifi_private *priv;
33073b01e57SJeff Chen 	struct nxpwifi_power_cfg power_cfg;
33173b01e57SJeff Chen 	int dbm = MBM_TO_DBM(mbm);
33273b01e57SJeff Chen 
33373b01e57SJeff Chen 	switch (type) {
33473b01e57SJeff Chen 	case NL80211_TX_POWER_FIXED:
33573b01e57SJeff Chen 		power_cfg.is_power_auto = 0;
33673b01e57SJeff Chen 		power_cfg.is_power_fixed = 1;
33773b01e57SJeff Chen 		power_cfg.power_level = dbm;
33873b01e57SJeff Chen 		break;
33973b01e57SJeff Chen 	case NL80211_TX_POWER_LIMITED:
34073b01e57SJeff Chen 		power_cfg.is_power_auto = 0;
34173b01e57SJeff Chen 		power_cfg.is_power_fixed = 0;
34273b01e57SJeff Chen 		power_cfg.power_level = dbm;
34373b01e57SJeff Chen 		break;
34473b01e57SJeff Chen 	case NL80211_TX_POWER_AUTOMATIC:
34573b01e57SJeff Chen 		power_cfg.is_power_auto = 1;
34673b01e57SJeff Chen 		break;
34773b01e57SJeff Chen 	}
34873b01e57SJeff Chen 
34973b01e57SJeff Chen 	priv = nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_ANY);
35073b01e57SJeff Chen 
35173b01e57SJeff Chen 	return nxpwifi_set_tx_power(priv, &power_cfg);
35273b01e57SJeff Chen }
35373b01e57SJeff Chen 
35473b01e57SJeff Chen /* cfg80211 operation handler to get Tx power. */
35573b01e57SJeff Chen static int
nxpwifi_cfg80211_get_tx_power(struct wiphy * wiphy,struct wireless_dev * wdev,int radio_idx,unsigned int link_id,int * dbm)35673b01e57SJeff Chen nxpwifi_cfg80211_get_tx_power(struct wiphy *wiphy,
35773b01e57SJeff Chen 			      struct wireless_dev *wdev,
35873b01e57SJeff Chen 			      int radio_idx,
35973b01e57SJeff Chen 			      unsigned int link_id,
36073b01e57SJeff Chen 			      int *dbm)
36173b01e57SJeff Chen {
36273b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
36373b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_ANY);
36473b01e57SJeff Chen 	int ret = nxpwifi_get_tx_pwr(priv);
36573b01e57SJeff Chen 
36673b01e57SJeff Chen 	if (ret < 0)
36773b01e57SJeff Chen 		return ret;
36873b01e57SJeff Chen 
36973b01e57SJeff Chen 	*dbm = priv->tx_power_level;
37073b01e57SJeff Chen 
37173b01e57SJeff Chen 	return 0;
37273b01e57SJeff Chen }
37373b01e57SJeff Chen 
37473b01e57SJeff Chen /*
37573b01e57SJeff Chen  * cfg80211 handler for setting IEEE 802.11 Power Save mode.
37673b01e57SJeff Chen  *
37773b01e57SJeff Chen  * The 'timeout' parameter is not supported and is ignored.
37873b01e57SJeff Chen  */
37973b01e57SJeff Chen static int
nxpwifi_cfg80211_set_power_mgmt(struct wiphy * wiphy,struct net_device * dev,bool enabled,int timeout)38073b01e57SJeff Chen nxpwifi_cfg80211_set_power_mgmt(struct wiphy *wiphy,
38173b01e57SJeff Chen 				struct net_device *dev,
38273b01e57SJeff Chen 				bool enabled, int timeout)
38373b01e57SJeff Chen {
38473b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
38573b01e57SJeff Chen 	u32 ps_mode;
38673b01e57SJeff Chen 
38773b01e57SJeff Chen 	if (timeout)
38873b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
38973b01e57SJeff Chen 			    "info: ignore timeout value for IEEE Power Save\n");
39073b01e57SJeff Chen 
39173b01e57SJeff Chen 	ps_mode = enabled;
39273b01e57SJeff Chen 
39373b01e57SJeff Chen 	return nxpwifi_drv_set_power(priv, &ps_mode);
39473b01e57SJeff Chen }
39573b01e57SJeff Chen 
39673b01e57SJeff Chen /*
39773b01e57SJeff Chen  * cfg80211 handler for setting the default WEP key.
39873b01e57SJeff Chen  *
39973b01e57SJeff Chen  * Ignored if WEP is not enabled.
40073b01e57SJeff Chen  */
40173b01e57SJeff Chen static int
nxpwifi_cfg80211_set_default_key(struct wiphy * wiphy,struct net_device * netdev,int link_id,u8 key_index,bool unicast,bool multicast)40273b01e57SJeff Chen nxpwifi_cfg80211_set_default_key(struct wiphy *wiphy, struct net_device *netdev,
40373b01e57SJeff Chen 				 int link_id, u8 key_index, bool unicast,
40473b01e57SJeff Chen 				 bool multicast)
40573b01e57SJeff Chen {
40673b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(netdev);
40773b01e57SJeff Chen 	int ret = 0;
40873b01e57SJeff Chen 
40973b01e57SJeff Chen 	/* Return if WEP key not configured */
41073b01e57SJeff Chen 	if (!priv->sec_info.wep_enabled)
41173b01e57SJeff Chen 		return 0;
41273b01e57SJeff Chen 
41373b01e57SJeff Chen 	if (priv->bss_type == NXPWIFI_BSS_TYPE_UAP) {
41473b01e57SJeff Chen 		priv->wep_key_curr_index = key_index;
41573b01e57SJeff Chen 	} else {
41673b01e57SJeff Chen 		ret = nxpwifi_set_encode(priv, NULL, NULL, 0, key_index,
41773b01e57SJeff Chen 					 NULL, 0);
41873b01e57SJeff Chen 		if (ret)
41973b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, ERROR,
42073b01e57SJeff Chen 				    "failed to set default Tx key index\n");
42173b01e57SJeff Chen 	}
42273b01e57SJeff Chen 
42373b01e57SJeff Chen 	return ret;
42473b01e57SJeff Chen }
42573b01e57SJeff Chen 
42673b01e57SJeff Chen /* cfg80211 handler for adding an 802.11 encryption key. */
42773b01e57SJeff Chen static int
nxpwifi_cfg80211_add_key(struct wiphy * wiphy,struct wireless_dev * wdev,int link_id,u8 key_index,bool pairwise,const u8 * mac_addr,struct key_params * params)42873b01e57SJeff Chen nxpwifi_cfg80211_add_key(struct wiphy *wiphy, struct wireless_dev *wdev,
42973b01e57SJeff Chen 			 int link_id, u8 key_index, bool pairwise,
43073b01e57SJeff Chen 			 const u8 *mac_addr, struct key_params *params)
43173b01e57SJeff Chen {
43273b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
43373b01e57SJeff Chen 	struct nxpwifi_wep_key *wep_key;
43473b01e57SJeff Chen 	u8 bc_mac[ETH_ALEN];
43573b01e57SJeff Chen 	const u8 *peer_mac;
43673b01e57SJeff Chen 	int ret;
43773b01e57SJeff Chen 
43873b01e57SJeff Chen 	eth_broadcast_addr(bc_mac);
43973b01e57SJeff Chen 	peer_mac = pairwise ? mac_addr : bc_mac;
44073b01e57SJeff Chen 
44173b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP &&
44273b01e57SJeff Chen 	    (params->cipher == WLAN_CIPHER_SUITE_WEP40 ||
44373b01e57SJeff Chen 	     params->cipher == WLAN_CIPHER_SUITE_WEP104)) {
44473b01e57SJeff Chen 		if (params->key && params->key_len) {
44573b01e57SJeff Chen 			wep_key = &priv->wep_key[key_index];
44673b01e57SJeff Chen 			memset(wep_key, 0, sizeof(struct nxpwifi_wep_key));
44773b01e57SJeff Chen 			memcpy(wep_key->key_material, params->key,
44873b01e57SJeff Chen 			       params->key_len);
44973b01e57SJeff Chen 			wep_key->key_index = key_index;
45073b01e57SJeff Chen 			wep_key->key_length = params->key_len;
45173b01e57SJeff Chen 			priv->sec_info.wep_enabled = 1;
45273b01e57SJeff Chen 		}
45373b01e57SJeff Chen 		return 0;
45473b01e57SJeff Chen 	}
45573b01e57SJeff Chen 
45673b01e57SJeff Chen 	ret = nxpwifi_set_encode(priv, params, params->key, params->key_len,
45773b01e57SJeff Chen 				 key_index, peer_mac, 0);
45873b01e57SJeff Chen 	if (ret)
45973b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
46073b01e57SJeff Chen 			    "failed to add crypto keys\n");
46173b01e57SJeff Chen 
46273b01e57SJeff Chen 	return ret;
46373b01e57SJeff Chen }
46473b01e57SJeff Chen 
46573b01e57SJeff Chen /* cfg80211 handler for setting the default management key. */
46673b01e57SJeff Chen static int
nxpwifi_cfg80211_set_default_mgmt_key(struct wiphy * wiphy,struct wireless_dev * wdev,int link_id,u8 key_index)46773b01e57SJeff Chen nxpwifi_cfg80211_set_default_mgmt_key(struct wiphy *wiphy,
46873b01e57SJeff Chen 				      struct wireless_dev *wdev,
46973b01e57SJeff Chen 				      int link_id,
47073b01e57SJeff Chen 				      u8 key_index)
47173b01e57SJeff Chen {
47273b01e57SJeff Chen 	return 0;
47373b01e57SJeff Chen }
47473b01e57SJeff Chen 
47573b01e57SJeff Chen /*
47673b01e57SJeff Chen  * Sends regulatory domain information to the firmware.
47773b01e57SJeff Chen  *
47873b01e57SJeff Chen  * Includes:
47973b01e57SJeff Chen  *   - Country code
48073b01e57SJeff Chen  *   - Sub-band definitions (first channel, channel count, max TX power)
48173b01e57SJeff Chen  */
nxpwifi_send_domain_info_cmd_fw(struct wiphy * wiphy,enum nl80211_band band)48273b01e57SJeff Chen int nxpwifi_send_domain_info_cmd_fw(struct wiphy *wiphy, enum nl80211_band band)
48373b01e57SJeff Chen {
48473b01e57SJeff Chen 	u8 no_of_triplet = 0;
48573b01e57SJeff Chen 	struct ieee80211_country_ie_triplet *t;
48673b01e57SJeff Chen 	u8 no_of_parsed_chan = 0;
48773b01e57SJeff Chen 	u8 first_chan = 0, next_chan = 0, max_pwr = 0;
48873b01e57SJeff Chen 	u8 i, flag = 0;
48973b01e57SJeff Chen 	struct ieee80211_supported_band *sband;
49073b01e57SJeff Chen 	struct ieee80211_channel *ch;
49173b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
49273b01e57SJeff Chen 	struct nxpwifi_private *priv;
49373b01e57SJeff Chen 	struct nxpwifi_802_11d_domain_reg *domain_info = &adapter->domain_reg;
49473b01e57SJeff Chen 	int ret;
49573b01e57SJeff Chen 
49673b01e57SJeff Chen 	domain_info->dfs_region = adapter->dfs_region;
49773b01e57SJeff Chen 
49873b01e57SJeff Chen 	/* Set country code */
49973b01e57SJeff Chen 	domain_info->country_code[0] = adapter->country_code[0];
50073b01e57SJeff Chen 	domain_info->country_code[1] = adapter->country_code[1];
50173b01e57SJeff Chen 	domain_info->country_code[2] = ' ';
50273b01e57SJeff Chen 
50373b01e57SJeff Chen 	if (!wiphy->bands[band]) {
50473b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
50573b01e57SJeff Chen 			    "11D: setting domain info in FW\n");
50673b01e57SJeff Chen 		return -EINVAL;
50773b01e57SJeff Chen 	}
50873b01e57SJeff Chen 
50973b01e57SJeff Chen 	sband = wiphy->bands[band];
51073b01e57SJeff Chen 
51173b01e57SJeff Chen 	for (i = 0; i < sband->n_channels ; i++) {
51273b01e57SJeff Chen 		ch = &sband->channels[i];
51373b01e57SJeff Chen 		if (ch->flags & IEEE80211_CHAN_DISABLED)
51473b01e57SJeff Chen 			continue;
51573b01e57SJeff Chen 
51673b01e57SJeff Chen 		if (!flag) {
51773b01e57SJeff Chen 			flag = 1;
51873b01e57SJeff Chen 			first_chan = (u32)ch->hw_value;
51973b01e57SJeff Chen 			next_chan = first_chan;
52073b01e57SJeff Chen 			max_pwr = ch->max_power;
52173b01e57SJeff Chen 			no_of_parsed_chan = 1;
52273b01e57SJeff Chen 			continue;
52373b01e57SJeff Chen 		}
52473b01e57SJeff Chen 
52573b01e57SJeff Chen 		if (ch->hw_value == next_chan + 1 &&
52673b01e57SJeff Chen 		    ch->max_power == max_pwr) {
52773b01e57SJeff Chen 			next_chan++;
52873b01e57SJeff Chen 			no_of_parsed_chan++;
52973b01e57SJeff Chen 		} else {
53073b01e57SJeff Chen 			t = &domain_info->triplet[no_of_triplet];
53173b01e57SJeff Chen 			t->chans.first_channel = first_chan;
53273b01e57SJeff Chen 			t->chans.num_channels = no_of_parsed_chan;
53373b01e57SJeff Chen 			t->chans.max_power = max_pwr;
53473b01e57SJeff Chen 			no_of_triplet++;
53573b01e57SJeff Chen 			first_chan = (u32)ch->hw_value;
53673b01e57SJeff Chen 			next_chan = first_chan;
53773b01e57SJeff Chen 			max_pwr = ch->max_power;
53873b01e57SJeff Chen 			no_of_parsed_chan = 1;
53973b01e57SJeff Chen 		}
54073b01e57SJeff Chen 	}
54173b01e57SJeff Chen 
54273b01e57SJeff Chen 	if (flag) {
54373b01e57SJeff Chen 		t = &domain_info->triplet[no_of_triplet];
54473b01e57SJeff Chen 		t->chans.first_channel = first_chan;
54573b01e57SJeff Chen 		t->chans.num_channels = no_of_parsed_chan;
54673b01e57SJeff Chen 		t->chans.max_power = max_pwr;
54773b01e57SJeff Chen 		no_of_triplet++;
54873b01e57SJeff Chen 	}
54973b01e57SJeff Chen 
55073b01e57SJeff Chen 	domain_info->no_of_triplet = no_of_triplet;
55173b01e57SJeff Chen 
55273b01e57SJeff Chen 	priv = nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_ANY);
55373b01e57SJeff Chen 
55473b01e57SJeff Chen 	ret = nxpwifi_apply_regdomain(priv);
55573b01e57SJeff Chen 
55673b01e57SJeff Chen 	if (ret)
55773b01e57SJeff Chen 		nxpwifi_dbg(adapter, INFO,
55873b01e57SJeff Chen 			    "11D: failed to set domain info in FW\n");
55973b01e57SJeff Chen 
56073b01e57SJeff Chen 	return ret;
56173b01e57SJeff Chen }
56273b01e57SJeff Chen 
nxpwifi_reg_apply_radar_flags(struct wiphy * wiphy)56373b01e57SJeff Chen static void nxpwifi_reg_apply_radar_flags(struct wiphy *wiphy)
56473b01e57SJeff Chen {
56573b01e57SJeff Chen 	struct ieee80211_supported_band *sband;
56673b01e57SJeff Chen 	struct ieee80211_channel *chan;
56773b01e57SJeff Chen 	unsigned int i;
56873b01e57SJeff Chen 
56973b01e57SJeff Chen 	if (!wiphy->bands[NL80211_BAND_5GHZ])
57073b01e57SJeff Chen 		return;
57173b01e57SJeff Chen 	sband = wiphy->bands[NL80211_BAND_5GHZ];
57273b01e57SJeff Chen 
57373b01e57SJeff Chen 	for (i = 0; i < sband->n_channels; i++) {
57473b01e57SJeff Chen 		chan = &sband->channels[i];
57573b01e57SJeff Chen 		if ((!(chan->flags & IEEE80211_CHAN_DISABLED)) &&
57673b01e57SJeff Chen 		    (chan->flags & IEEE80211_CHAN_RADAR))
57773b01e57SJeff Chen 			chan->flags |= IEEE80211_CHAN_NO_IR;
57873b01e57SJeff Chen 	}
57973b01e57SJeff Chen }
58073b01e57SJeff Chen 
58173b01e57SJeff Chen /*
58273b01e57SJeff Chen  * cfg80211 regulatory domain change callback.
58373b01e57SJeff Chen  *
58473b01e57SJeff Chen  * Invoked when the regulatory domain is updated by:
58573b01e57SJeff Chen  *   - the driver
58673b01e57SJeff Chen  *   - the system core
58773b01e57SJeff Chen  *   - the user
58873b01e57SJeff Chen  *   - a received Country IE
58973b01e57SJeff Chen  */
nxpwifi_reg_notifier(struct wiphy * wiphy,struct regulatory_request * request)59073b01e57SJeff Chen static void nxpwifi_reg_notifier(struct wiphy *wiphy,
59173b01e57SJeff Chen 				 struct regulatory_request *request)
59273b01e57SJeff Chen {
59373b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
59473b01e57SJeff Chen 
59573b01e57SJeff Chen 	nxpwifi_dbg(adapter, INFO,
59673b01e57SJeff Chen 		    "info: cfg80211 regulatory domain callback for %c%c\n",
59773b01e57SJeff Chen 		    request->alpha2[0], request->alpha2[1]);
59873b01e57SJeff Chen 	nxpwifi_reg_apply_radar_flags(wiphy);
59973b01e57SJeff Chen 
60073b01e57SJeff Chen 	switch (request->initiator) {
60173b01e57SJeff Chen 	case NL80211_REGDOM_SET_BY_DRIVER:
60273b01e57SJeff Chen 	case NL80211_REGDOM_SET_BY_CORE:
60373b01e57SJeff Chen 	case NL80211_REGDOM_SET_BY_USER:
60473b01e57SJeff Chen 	case NL80211_REGDOM_SET_BY_COUNTRY_IE:
60573b01e57SJeff Chen 		break;
60673b01e57SJeff Chen 	default:
60773b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
60873b01e57SJeff Chen 			    "unknown regdom initiator: %d\n",
60973b01e57SJeff Chen 			    request->initiator);
61073b01e57SJeff Chen 		return;
61173b01e57SJeff Chen 	}
61273b01e57SJeff Chen 
61373b01e57SJeff Chen 	/* Skip world/unchanged regulatory domains. */
61473b01e57SJeff Chen 	if (strncmp(request->alpha2, "00", 2) &&
61573b01e57SJeff Chen 	    strncmp(request->alpha2, adapter->country_code,
61673b01e57SJeff Chen 		    sizeof(request->alpha2))) {
61773b01e57SJeff Chen 		memcpy(adapter->country_code, request->alpha2,
61873b01e57SJeff Chen 		       sizeof(request->alpha2));
61973b01e57SJeff Chen 		adapter->dfs_region = request->dfs_region;
62073b01e57SJeff Chen 		nxpwifi_send_domain_info_cmd_fw(wiphy, NL80211_BAND_2GHZ);
62173b01e57SJeff Chen 		if (adapter->fw_bands & BAND_A)
62273b01e57SJeff Chen 			nxpwifi_send_domain_info_cmd_fw(wiphy,
62373b01e57SJeff Chen 							NL80211_BAND_5GHZ);
62473b01e57SJeff Chen 	}
62573b01e57SJeff Chen }
62673b01e57SJeff Chen 
62773b01e57SJeff Chen /*
62873b01e57SJeff Chen  * cfg80211 op: set wiphy parameters.
62973b01e57SJeff Chen  * Updates RTS/fragmentation thresholds and retry limits based on 'changed'
63073b01e57SJeff Chen  * flags.
63173b01e57SJeff Chen  */
63273b01e57SJeff Chen static int
nxpwifi_cfg80211_set_wiphy_params(struct wiphy * wiphy,int radio_idx,u32 changed)63373b01e57SJeff Chen nxpwifi_cfg80211_set_wiphy_params(struct wiphy *wiphy, int radio_idx, u32 changed)
63473b01e57SJeff Chen {
63573b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
63673b01e57SJeff Chen 	struct nxpwifi_private *priv;
63773b01e57SJeff Chen 	struct nxpwifi_uap_bss_param *bss_cfg;
63873b01e57SJeff Chen 	int ret = 0;
63973b01e57SJeff Chen 
64073b01e57SJeff Chen 	priv = nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_ANY);
64173b01e57SJeff Chen 
64273b01e57SJeff Chen 	switch (priv->bss_role) {
64373b01e57SJeff Chen 	case NXPWIFI_BSS_ROLE_UAP:
64473b01e57SJeff Chen 		bss_cfg = kzalloc_obj(*bss_cfg, GFP_KERNEL);
64573b01e57SJeff Chen 		if (!bss_cfg) {
64673b01e57SJeff Chen 			ret = -ENOMEM;
64773b01e57SJeff Chen 			break;
64873b01e57SJeff Chen 		}
64973b01e57SJeff Chen 
65073b01e57SJeff Chen 		nxpwifi_set_sys_config_invalid_data(bss_cfg);
65173b01e57SJeff Chen 
65273b01e57SJeff Chen 		if (changed & WIPHY_PARAM_RTS_THRESHOLD)
65373b01e57SJeff Chen 			bss_cfg->rts_threshold = wiphy->rts_threshold;
65473b01e57SJeff Chen 		if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
65573b01e57SJeff Chen 			bss_cfg->frag_threshold = wiphy->frag_threshold;
65673b01e57SJeff Chen 		if (changed & WIPHY_PARAM_RETRY_LONG)
65773b01e57SJeff Chen 			bss_cfg->retry_limit = wiphy->retry_long;
65873b01e57SJeff Chen 
65973b01e57SJeff Chen 		ret = nxpwifi_set_uap_sys_cfg(priv, bss_cfg);
66073b01e57SJeff Chen 
66173b01e57SJeff Chen 		kfree(bss_cfg);
66273b01e57SJeff Chen 		if (ret)
66373b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
66473b01e57SJeff Chen 				    "Failed to set wiphy phy params\n");
66573b01e57SJeff Chen 		break;
66673b01e57SJeff Chen 
66773b01e57SJeff Chen 	case NXPWIFI_BSS_ROLE_STA:
66873b01e57SJeff Chen 		if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
66973b01e57SJeff Chen 			ret = nxpwifi_set_rts(priv,
67073b01e57SJeff Chen 					      wiphy->rts_threshold);
67173b01e57SJeff Chen 			if (ret)
67273b01e57SJeff Chen 				break;
67373b01e57SJeff Chen 		}
67473b01e57SJeff Chen 		if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
67573b01e57SJeff Chen 			ret = nxpwifi_set_frag(priv,
67673b01e57SJeff Chen 					       wiphy->frag_threshold);
67773b01e57SJeff Chen 		break;
67873b01e57SJeff Chen 	}
67973b01e57SJeff Chen 
68073b01e57SJeff Chen 	return ret;
68173b01e57SJeff Chen }
68273b01e57SJeff Chen 
nxpwifi_deinit_priv_params(struct nxpwifi_private * priv)68373b01e57SJeff Chen static int nxpwifi_deinit_priv_params(struct nxpwifi_private *priv)
68473b01e57SJeff Chen {
68573b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
68673b01e57SJeff Chen 	int ret = 0;
68773b01e57SJeff Chen 
68873b01e57SJeff Chen 	if (priv->mgmt_frame_mask) {
68973b01e57SJeff Chen 		priv->mgmt_frame_mask = 0;
69073b01e57SJeff Chen 		ret = nxpwifi_mgmt_frame_reg(priv, priv->mgmt_frame_mask);
69173b01e57SJeff Chen 
69273b01e57SJeff Chen 		if (ret) {
69373b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
69473b01e57SJeff Chen 				    "could not unregister mgmt frame rx\n");
69573b01e57SJeff Chen 			return ret;
69673b01e57SJeff Chen 		}
69773b01e57SJeff Chen 		priv->host_mlme_reg = false;
69873b01e57SJeff Chen 
69973b01e57SJeff Chen 	}
70073b01e57SJeff Chen 
70173b01e57SJeff Chen 	nxpwifi_deauthenticate(priv, NULL);
70273b01e57SJeff Chen 
70373b01e57SJeff Chen 	atomic_set(&adapter->iface_changing, 1);
70473b01e57SJeff Chen 	flush_workqueue(adapter->workqueue);
70573b01e57SJeff Chen 	flush_workqueue(adapter->rx_workqueue);
70673b01e57SJeff Chen 	nxpwifi_free_priv(priv);
70773b01e57SJeff Chen 	priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
70873b01e57SJeff Chen 	priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
70973b01e57SJeff Chen 	priv->sec_info.authentication_mode = NL80211_AUTHTYPE_OPEN_SYSTEM;
71073b01e57SJeff Chen 
71173b01e57SJeff Chen 	return ret;
71273b01e57SJeff Chen }
71373b01e57SJeff Chen 
71473b01e57SJeff Chen static int
nxpwifi_init_new_priv_params(struct nxpwifi_private * priv,struct net_device * dev,enum nl80211_iftype type)71573b01e57SJeff Chen nxpwifi_init_new_priv_params(struct nxpwifi_private *priv,
71673b01e57SJeff Chen 			     struct net_device *dev,
71773b01e57SJeff Chen 			     enum nl80211_iftype type)
71873b01e57SJeff Chen {
71973b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
720*00c786a7SJeff Chen 	int ret;
72173b01e57SJeff Chen 
72273b01e57SJeff Chen 	nxpwifi_init_priv(priv);
72373b01e57SJeff Chen 
72473b01e57SJeff Chen 	priv->bss_mode = type;
72573b01e57SJeff Chen 	priv->wdev.iftype = type;
72673b01e57SJeff Chen 
72773b01e57SJeff Chen 	nxpwifi_init_priv_params(priv, priv->netdev);
72873b01e57SJeff Chen 	priv->bss_started = 0;
72973b01e57SJeff Chen 
73073b01e57SJeff Chen 	switch (type) {
73173b01e57SJeff Chen 	case NL80211_IFTYPE_STATION:
73273b01e57SJeff Chen 		priv->bss_role = NXPWIFI_BSS_ROLE_STA;
73373b01e57SJeff Chen 		break;
73473b01e57SJeff Chen 	case NL80211_IFTYPE_AP:
73573b01e57SJeff Chen 		priv->bss_role = NXPWIFI_BSS_ROLE_UAP;
73673b01e57SJeff Chen 		break;
73773b01e57SJeff Chen 	default:
73873b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
73973b01e57SJeff Chen 			    "%s: changing to %d not supported\n",
74073b01e57SJeff Chen 			    dev->name, type);
74173b01e57SJeff Chen 		return -EOPNOTSUPP;
74273b01e57SJeff Chen 	}
74373b01e57SJeff Chen 
744*00c786a7SJeff Chen 	ret = nxpwifi_get_unused_bss_num(adapter, priv->bss_type,
745*00c786a7SJeff Chen 					 &priv->bss_num);
746*00c786a7SJeff Chen 
747*00c786a7SJeff Chen 	if (ret) {
748*00c786a7SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
749*00c786a7SJeff Chen 			    "%s: no unused bss_num for type %d\n",
750*00c786a7SJeff Chen 			    dev->name, priv->bss_type);
751*00c786a7SJeff Chen 		return ret;
752*00c786a7SJeff Chen 	}
75373b01e57SJeff Chen 
75473b01e57SJeff Chen 	flush_workqueue(adapter->workqueue);
75573b01e57SJeff Chen 	atomic_set(&adapter->iface_changing, 0);
75673b01e57SJeff Chen 
75773b01e57SJeff Chen 	nxpwifi_set_mac_address(priv, dev, false, NULL);
75873b01e57SJeff Chen 
75973b01e57SJeff Chen 	return 0;
76073b01e57SJeff Chen }
76173b01e57SJeff Chen 
76273b01e57SJeff Chen static bool
is_vif_type_change_allowed(struct nxpwifi_adapter * adapter,enum nl80211_iftype old_iftype,enum nl80211_iftype new_iftype)76373b01e57SJeff Chen is_vif_type_change_allowed(struct nxpwifi_adapter *adapter,
76473b01e57SJeff Chen 			   enum nl80211_iftype old_iftype,
76573b01e57SJeff Chen 			   enum nl80211_iftype new_iftype)
76673b01e57SJeff Chen {
76773b01e57SJeff Chen 	switch (old_iftype) {
76873b01e57SJeff Chen 	case NL80211_IFTYPE_STATION:
76973b01e57SJeff Chen 		switch (new_iftype) {
77073b01e57SJeff Chen 		case NL80211_IFTYPE_AP:
77173b01e57SJeff Chen 			return adapter->curr_iface_comb.uap_intf !=
77273b01e57SJeff Chen 			       adapter->iface_limit.uap_intf;
77373b01e57SJeff Chen 		default:
77473b01e57SJeff Chen 			return false;
77573b01e57SJeff Chen 		}
77673b01e57SJeff Chen 
77773b01e57SJeff Chen 	case NL80211_IFTYPE_AP:
77873b01e57SJeff Chen 		switch (new_iftype) {
77973b01e57SJeff Chen 		case NL80211_IFTYPE_STATION:
78073b01e57SJeff Chen 			return adapter->curr_iface_comb.sta_intf !=
78173b01e57SJeff Chen 			       adapter->iface_limit.sta_intf;
78273b01e57SJeff Chen 		default:
78373b01e57SJeff Chen 			return false;
78473b01e57SJeff Chen 		}
78573b01e57SJeff Chen 
78673b01e57SJeff Chen 	default:
78773b01e57SJeff Chen 		break;
78873b01e57SJeff Chen 	}
78973b01e57SJeff Chen 
79073b01e57SJeff Chen 	return false;
79173b01e57SJeff Chen }
79273b01e57SJeff Chen 
79373b01e57SJeff Chen static void
update_vif_type_counter(struct nxpwifi_adapter * adapter,enum nl80211_iftype iftype,int change)79473b01e57SJeff Chen update_vif_type_counter(struct nxpwifi_adapter *adapter,
79573b01e57SJeff Chen 			enum nl80211_iftype iftype,
79673b01e57SJeff Chen 			int change)
79773b01e57SJeff Chen {
79873b01e57SJeff Chen 	switch (iftype) {
79973b01e57SJeff Chen 	case NL80211_IFTYPE_UNSPECIFIED:
80073b01e57SJeff Chen 	case NL80211_IFTYPE_STATION:
80173b01e57SJeff Chen 		adapter->curr_iface_comb.sta_intf += change;
80273b01e57SJeff Chen 		break;
80373b01e57SJeff Chen 	case NL80211_IFTYPE_AP:
80473b01e57SJeff Chen 		adapter->curr_iface_comb.uap_intf += change;
80573b01e57SJeff Chen 		break;
80673b01e57SJeff Chen 	case NL80211_IFTYPE_MONITOR:
80773b01e57SJeff Chen 		break;
80873b01e57SJeff Chen 	default:
80973b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
81073b01e57SJeff Chen 			    "%s: Unsupported iftype passed: %d\n",
81173b01e57SJeff Chen 			    __func__, iftype);
81273b01e57SJeff Chen 		break;
81373b01e57SJeff Chen 	}
81473b01e57SJeff Chen }
81573b01e57SJeff Chen 
81673b01e57SJeff Chen static int
nxpwifi_change_vif_to_sta(struct net_device * dev,enum nl80211_iftype curr_iftype,enum nl80211_iftype type,struct vif_params * params)81773b01e57SJeff Chen nxpwifi_change_vif_to_sta(struct net_device *dev,
81873b01e57SJeff Chen 			  enum nl80211_iftype curr_iftype,
81973b01e57SJeff Chen 			  enum nl80211_iftype type,
82073b01e57SJeff Chen 			  struct vif_params *params)
82173b01e57SJeff Chen {
82273b01e57SJeff Chen 	struct nxpwifi_private *priv;
82373b01e57SJeff Chen 	struct nxpwifi_adapter *adapter;
82473b01e57SJeff Chen 	int ret;
82573b01e57SJeff Chen 
82673b01e57SJeff Chen 	priv = nxpwifi_netdev_get_priv(dev);
82773b01e57SJeff Chen 
82873b01e57SJeff Chen 	if (!priv)
82973b01e57SJeff Chen 		return -EINVAL;
83073b01e57SJeff Chen 
83173b01e57SJeff Chen 	adapter = priv->adapter;
83273b01e57SJeff Chen 
83373b01e57SJeff Chen 	nxpwifi_dbg(adapter, INFO,
83473b01e57SJeff Chen 		    "%s: changing role to station\n", dev->name);
83573b01e57SJeff Chen 
83673b01e57SJeff Chen 	ret = nxpwifi_deinit_priv_params(priv);
83773b01e57SJeff Chen 	if (ret)
83873b01e57SJeff Chen 		goto done;
83973b01e57SJeff Chen 	ret = nxpwifi_init_new_priv_params(priv, dev, type);
84073b01e57SJeff Chen 	if (ret)
84173b01e57SJeff Chen 		goto done;
84273b01e57SJeff Chen 
84373b01e57SJeff Chen 	update_vif_type_counter(adapter, curr_iftype, -1);
84473b01e57SJeff Chen 	update_vif_type_counter(adapter, type, 1);
84573b01e57SJeff Chen 	dev->ieee80211_ptr->iftype = type;
84673b01e57SJeff Chen 
84773b01e57SJeff Chen 	if (nxpwifi_set_bss_mode(priv))
84873b01e57SJeff Chen 		return -1;
84973b01e57SJeff Chen 
85073b01e57SJeff Chen 	if (ret)
85173b01e57SJeff Chen 		goto done;
85273b01e57SJeff Chen 
85373b01e57SJeff Chen 	ret = nxpwifi_sta_init_cmd(priv, false, false);
85473b01e57SJeff Chen 
85573b01e57SJeff Chen done:
85673b01e57SJeff Chen 	return ret;
85773b01e57SJeff Chen }
85873b01e57SJeff Chen 
85973b01e57SJeff Chen static int
nxpwifi_change_vif_to_ap(struct net_device * dev,enum nl80211_iftype curr_iftype,enum nl80211_iftype type,struct vif_params * params)86073b01e57SJeff Chen nxpwifi_change_vif_to_ap(struct net_device *dev,
86173b01e57SJeff Chen 			 enum nl80211_iftype curr_iftype,
86273b01e57SJeff Chen 			 enum nl80211_iftype type,
86373b01e57SJeff Chen 			 struct vif_params *params)
86473b01e57SJeff Chen {
86573b01e57SJeff Chen 	struct nxpwifi_private *priv;
86673b01e57SJeff Chen 	struct nxpwifi_adapter *adapter;
86773b01e57SJeff Chen 	int ret;
86873b01e57SJeff Chen 
86973b01e57SJeff Chen 	priv = nxpwifi_netdev_get_priv(dev);
87073b01e57SJeff Chen 
87173b01e57SJeff Chen 	if (!priv)
87273b01e57SJeff Chen 		return -EINVAL;
87373b01e57SJeff Chen 
87473b01e57SJeff Chen 	adapter = priv->adapter;
87573b01e57SJeff Chen 
87673b01e57SJeff Chen 	nxpwifi_dbg(adapter, INFO,
87773b01e57SJeff Chen 		    "%s: changing role to AP\n", dev->name);
87873b01e57SJeff Chen 
87973b01e57SJeff Chen 	ret = nxpwifi_deinit_priv_params(priv);
88073b01e57SJeff Chen 	if (ret)
88173b01e57SJeff Chen 		goto done;
88273b01e57SJeff Chen 
88373b01e57SJeff Chen 	ret = nxpwifi_init_new_priv_params(priv, dev, type);
88473b01e57SJeff Chen 	if (ret)
88573b01e57SJeff Chen 		goto done;
88673b01e57SJeff Chen 
88773b01e57SJeff Chen 	update_vif_type_counter(adapter, curr_iftype, -1);
88873b01e57SJeff Chen 	update_vif_type_counter(adapter, type, 1);
88973b01e57SJeff Chen 	dev->ieee80211_ptr->iftype = type;
89073b01e57SJeff Chen 
89173b01e57SJeff Chen 	if (nxpwifi_set_bss_mode(priv))
89273b01e57SJeff Chen 		return -1;
89373b01e57SJeff Chen 
89473b01e57SJeff Chen 	if (ret)
89573b01e57SJeff Chen 		goto done;
89673b01e57SJeff Chen 
89773b01e57SJeff Chen 	ret = nxpwifi_sta_init_cmd(priv, false, false);
89873b01e57SJeff Chen 
89973b01e57SJeff Chen done:
90073b01e57SJeff Chen 	return ret;
90173b01e57SJeff Chen }
90273b01e57SJeff Chen 
90373b01e57SJeff Chen /* cfg80211 operation handler to change interface type. */
90473b01e57SJeff Chen static int
nxpwifi_cfg80211_change_virtual_intf(struct wiphy * wiphy,struct net_device * dev,enum nl80211_iftype type,struct vif_params * params)90573b01e57SJeff Chen nxpwifi_cfg80211_change_virtual_intf(struct wiphy *wiphy,
90673b01e57SJeff Chen 				     struct net_device *dev,
90773b01e57SJeff Chen 				     enum nl80211_iftype type,
90873b01e57SJeff Chen 				     struct vif_params *params)
90973b01e57SJeff Chen {
91073b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
91173b01e57SJeff Chen 	enum nl80211_iftype curr_iftype = dev->ieee80211_ptr->iftype;
91273b01e57SJeff Chen 
91373b01e57SJeff Chen 	if (priv->scan_request) {
91473b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
91573b01e57SJeff Chen 			    "change virtual interface: scan in process\n");
91673b01e57SJeff Chen 		return -EBUSY;
91773b01e57SJeff Chen 	}
91873b01e57SJeff Chen 
91973b01e57SJeff Chen 	if (type == NL80211_IFTYPE_UNSPECIFIED) {
92073b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
92173b01e57SJeff Chen 			    "%s: no new type specified, keeping old type %d\n",
92273b01e57SJeff Chen 			    dev->name, curr_iftype);
92373b01e57SJeff Chen 		return 0;
92473b01e57SJeff Chen 	}
92573b01e57SJeff Chen 
92673b01e57SJeff Chen 	if (curr_iftype == type) {
92773b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
92873b01e57SJeff Chen 			    "%s: interface already is of type %d\n",
92973b01e57SJeff Chen 			    dev->name, curr_iftype);
93073b01e57SJeff Chen 		return 0;
93173b01e57SJeff Chen 	}
93273b01e57SJeff Chen 
93373b01e57SJeff Chen 	if (!is_vif_type_change_allowed(priv->adapter, curr_iftype, type)) {
93473b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
93573b01e57SJeff Chen 			    "%s: change from type %d to %d is not allowed\n",
93673b01e57SJeff Chen 			    dev->name, curr_iftype, type);
93773b01e57SJeff Chen 		return -EOPNOTSUPP;
93873b01e57SJeff Chen 	}
93973b01e57SJeff Chen 
94073b01e57SJeff Chen 	switch (curr_iftype) {
94173b01e57SJeff Chen 	case NL80211_IFTYPE_STATION:
94273b01e57SJeff Chen 		switch (type) {
94373b01e57SJeff Chen 		case NL80211_IFTYPE_AP:
94473b01e57SJeff Chen 			return nxpwifi_change_vif_to_ap(dev, curr_iftype, type,
94573b01e57SJeff Chen 							params);
94673b01e57SJeff Chen 		default:
94773b01e57SJeff Chen 			goto errnotsupp;
94873b01e57SJeff Chen 		}
94973b01e57SJeff Chen 
95073b01e57SJeff Chen 	case NL80211_IFTYPE_AP:
95173b01e57SJeff Chen 		switch (type) {
95273b01e57SJeff Chen 		case NL80211_IFTYPE_STATION:
95373b01e57SJeff Chen 			return nxpwifi_change_vif_to_sta(dev, curr_iftype,
95473b01e57SJeff Chen 							 type, params);
95573b01e57SJeff Chen 		default:
95673b01e57SJeff Chen 			goto errnotsupp;
95773b01e57SJeff Chen 		}
95873b01e57SJeff Chen 
95973b01e57SJeff Chen 	default:
96073b01e57SJeff Chen 		goto errnotsupp;
96173b01e57SJeff Chen 	}
96273b01e57SJeff Chen 
96373b01e57SJeff Chen errnotsupp:
96473b01e57SJeff Chen 	nxpwifi_dbg(priv->adapter, ERROR,
96573b01e57SJeff Chen 		    "unsupported interface type transition: %d to %d\n",
96673b01e57SJeff Chen 		    curr_iftype, type);
96773b01e57SJeff Chen 	return -EOPNOTSUPP;
96873b01e57SJeff Chen }
96973b01e57SJeff Chen 
97073b01e57SJeff Chen #define RATE_FORMAT_LG  0
97173b01e57SJeff Chen #define RATE_FORMAT_HT  1
97273b01e57SJeff Chen #define RATE_FORMAT_VHT 2
97373b01e57SJeff Chen #define RATE_FORMAT_HE  3
97473b01e57SJeff Chen 
97573b01e57SJeff Chen static void
nxpwifi_parse_htinfo(struct nxpwifi_private * priv,u8 rateinfo,u8 htinfo,struct rate_info * rate)97673b01e57SJeff Chen nxpwifi_parse_htinfo(struct nxpwifi_private *priv, u8 rateinfo, u8 htinfo,
97773b01e57SJeff Chen 		     struct rate_info *rate)
97873b01e57SJeff Chen {
97973b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
98073b01e57SJeff Chen 	u8 rate_format;
98173b01e57SJeff Chen 	u8 he_dcm;
98273b01e57SJeff Chen 	u8 stbc;
98373b01e57SJeff Chen 	u8 gi;
98473b01e57SJeff Chen 	u8 bw;
98573b01e57SJeff Chen 	/* Bitrates in multiples of 100kb/s. */
98673b01e57SJeff Chen 	static const int legacy_rates[] = {
98773b01e57SJeff Chen 		[0] = 10,
98873b01e57SJeff Chen 		[1] = 20,
98973b01e57SJeff Chen 		[2] = 55,
99073b01e57SJeff Chen 		[3] = 110,
99173b01e57SJeff Chen 		[4] = 60, /* NXPWIFI_RATE_INDEX_OFDM0 */
99273b01e57SJeff Chen 		[5] = 60,
99373b01e57SJeff Chen 		[6] = 90,
99473b01e57SJeff Chen 		[7] = 120,
99573b01e57SJeff Chen 		[8] = 180,
99673b01e57SJeff Chen 		[9] = 240,
99773b01e57SJeff Chen 		[10] = 360,
99873b01e57SJeff Chen 		[11] = 480,
99973b01e57SJeff Chen 		[12] = 540,
100073b01e57SJeff Chen 	};
100173b01e57SJeff Chen 
100273b01e57SJeff Chen 	rate_format = htinfo & 0x3;
100373b01e57SJeff Chen 
100473b01e57SJeff Chen 	switch (rate_format) {
100573b01e57SJeff Chen 	case RATE_FORMAT_LG:
100673b01e57SJeff Chen 		if (rateinfo < ARRAY_SIZE(legacy_rates))
100773b01e57SJeff Chen 			rate->legacy = legacy_rates[rateinfo];
100873b01e57SJeff Chen 		break;
100973b01e57SJeff Chen 	case RATE_FORMAT_HT:
101073b01e57SJeff Chen 		rate->mcs = rateinfo;
101173b01e57SJeff Chen 		rate->flags |= RATE_INFO_FLAGS_MCS;
101273b01e57SJeff Chen 		break;
101373b01e57SJeff Chen 	case RATE_FORMAT_VHT:
101473b01e57SJeff Chen 		rate->mcs = rateinfo & 0xF;
101573b01e57SJeff Chen 		rate->flags |= RATE_INFO_FLAGS_VHT_MCS;
101673b01e57SJeff Chen 		break;
101773b01e57SJeff Chen 	case RATE_FORMAT_HE:
101873b01e57SJeff Chen 		rate->mcs = rateinfo & 0xF;
101973b01e57SJeff Chen 		rate->flags |= RATE_INFO_FLAGS_HE_MCS;
102073b01e57SJeff Chen 		he_dcm = 0; /* ToDo: ext_rate_info */
102173b01e57SJeff Chen 		gi = (htinfo & BIT(4)) >> 4 |
102273b01e57SJeff Chen 		     (htinfo & BIT(7)) >> 6;
102373b01e57SJeff Chen 		stbc = (htinfo & BIT(5)) >> 5;
102473b01e57SJeff Chen 		if (gi > 3) {
102573b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR, "Invalid gi value\n");
102673b01e57SJeff Chen 			break;
102773b01e57SJeff Chen 		}
102873b01e57SJeff Chen 		if (gi == 3 && stbc && he_dcm) {
102973b01e57SJeff Chen 			gi = 0;
103073b01e57SJeff Chen 			stbc = 0;
103173b01e57SJeff Chen 			he_dcm = 0;
103273b01e57SJeff Chen 		}
103373b01e57SJeff Chen 		if (gi > 0)
103473b01e57SJeff Chen 			gi -= 1;
103573b01e57SJeff Chen 		rate->he_gi = gi;
103673b01e57SJeff Chen 		rate->he_dcm = he_dcm;
103773b01e57SJeff Chen 		break;
103873b01e57SJeff Chen 	}
103973b01e57SJeff Chen 
104073b01e57SJeff Chen 	bw = (htinfo & 0xC) >> 2;
104173b01e57SJeff Chen 
104273b01e57SJeff Chen 	switch (bw) {
104373b01e57SJeff Chen 	case 0:
104473b01e57SJeff Chen 		rate->bw = RATE_INFO_BW_20;
104573b01e57SJeff Chen 		break;
104673b01e57SJeff Chen 	case 1:
104773b01e57SJeff Chen 		rate->bw = RATE_INFO_BW_40;
104873b01e57SJeff Chen 		break;
104973b01e57SJeff Chen 	case 2:
105073b01e57SJeff Chen 		rate->bw = RATE_INFO_BW_80;
105173b01e57SJeff Chen 		break;
105273b01e57SJeff Chen 	case 3:
105373b01e57SJeff Chen 		rate->bw = RATE_INFO_BW_160;
105473b01e57SJeff Chen 		break;
105573b01e57SJeff Chen 	}
105673b01e57SJeff Chen 
105773b01e57SJeff Chen 	if (rate_format != RATE_FORMAT_HE && (htinfo & BIT(4)))
105873b01e57SJeff Chen 		rate->flags |= RATE_INFO_FLAGS_SHORT_GI;
105973b01e57SJeff Chen 
106073b01e57SJeff Chen 	if ((rateinfo >> 4) == 1)
106173b01e57SJeff Chen 		rate->nss = 2;
106273b01e57SJeff Chen 	else
106373b01e57SJeff Chen 		rate->nss = 1;
106473b01e57SJeff Chen }
106573b01e57SJeff Chen 
106673b01e57SJeff Chen /*
106773b01e57SJeff Chen  * Dump station statistics into station_info.
106873b01e57SJeff Chen  * Includes bytes/packets counters, signal level, and TX/RX rates.
106973b01e57SJeff Chen  */
107073b01e57SJeff Chen static int
nxpwifi_dump_station_info(struct nxpwifi_private * priv,struct nxpwifi_sta_node * node,struct station_info * sinfo)107173b01e57SJeff Chen nxpwifi_dump_station_info(struct nxpwifi_private *priv,
107273b01e57SJeff Chen 			  struct nxpwifi_sta_node *node,
107373b01e57SJeff Chen 			  struct station_info *sinfo)
107473b01e57SJeff Chen {
107573b01e57SJeff Chen 	u32 rate;
107673b01e57SJeff Chen 	int ret;
107773b01e57SJeff Chen 
107873b01e57SJeff Chen 	sinfo->filled = BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
107973b01e57SJeff Chen 			BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
108073b01e57SJeff Chen 			BIT_ULL(NL80211_STA_INFO_RX_PACKETS) |
108173b01e57SJeff Chen 			BIT_ULL(NL80211_STA_INFO_TX_PACKETS) |
108273b01e57SJeff Chen 			BIT_ULL(NL80211_STA_INFO_TX_BITRATE) |
108373b01e57SJeff Chen 			BIT_ULL(NL80211_STA_INFO_SIGNAL) |
108473b01e57SJeff Chen 			BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG);
108573b01e57SJeff Chen 
108673b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP) {
108773b01e57SJeff Chen 		if (!node)
108873b01e57SJeff Chen 			return -ENOENT;
108973b01e57SJeff Chen 
109073b01e57SJeff Chen 		sinfo->filled |= BIT_ULL(NL80211_STA_INFO_INACTIVE_TIME) |
109173b01e57SJeff Chen 				BIT_ULL(NL80211_STA_INFO_TX_FAILED);
109273b01e57SJeff Chen 		sinfo->inactive_time =
109373b01e57SJeff Chen 			jiffies_to_msecs(jiffies - node->stats.last_rx);
109473b01e57SJeff Chen 
109573b01e57SJeff Chen 		sinfo->signal = node->stats.rssi;
109673b01e57SJeff Chen 		sinfo->signal_avg = node->stats.rssi;
109773b01e57SJeff Chen 		sinfo->rx_bytes = node->stats.rx_bytes;
109873b01e57SJeff Chen 		sinfo->tx_bytes = node->stats.tx_bytes;
109973b01e57SJeff Chen 		sinfo->rx_packets = node->stats.rx_packets;
110073b01e57SJeff Chen 		sinfo->tx_packets = node->stats.tx_packets;
110173b01e57SJeff Chen 		sinfo->tx_failed = node->stats.tx_failed;
110273b01e57SJeff Chen 
110373b01e57SJeff Chen 		nxpwifi_parse_htinfo(priv, priv->tx_rate,
110473b01e57SJeff Chen 				     node->stats.last_tx_htinfo,
110573b01e57SJeff Chen 				     &sinfo->txrate);
110673b01e57SJeff Chen 		sinfo->txrate.legacy = node->stats.last_tx_rate * 5;
110773b01e57SJeff Chen 
110873b01e57SJeff Chen 		return 0;
110973b01e57SJeff Chen 	}
111073b01e57SJeff Chen 
111173b01e57SJeff Chen 	/* Get signal information from the firmware */
111273b01e57SJeff Chen 	ret = nxpwifi_get_rssi_info(priv);
111373b01e57SJeff Chen 	if (ret) {
111473b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
111573b01e57SJeff Chen 			    "failed to get signal information\n");
111673b01e57SJeff Chen 		goto done;
111773b01e57SJeff Chen 	}
111873b01e57SJeff Chen 
111973b01e57SJeff Chen 	ret = nxpwifi_drv_get_data_rate(priv, &rate);
112073b01e57SJeff Chen 	if (ret) {
112173b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
112273b01e57SJeff Chen 			    "getting data rate error\n");
112373b01e57SJeff Chen 		goto done;
112473b01e57SJeff Chen 	}
112573b01e57SJeff Chen 
112673b01e57SJeff Chen 	/* Retrieve DTIM period value from firmware. */
112773b01e57SJeff Chen 	nxpwifi_get_802_11_snmp_mib(priv, DTIM_PERIOD_I, &priv->dtim_period);
112873b01e57SJeff Chen 
112973b01e57SJeff Chen 	nxpwifi_parse_htinfo(priv, priv->tx_rate, priv->tx_htinfo,
113073b01e57SJeff Chen 			     &sinfo->txrate);
113173b01e57SJeff Chen 
113273b01e57SJeff Chen 	sinfo->signal_avg = priv->bcn_rssi_avg;
113373b01e57SJeff Chen 	sinfo->rx_bytes = priv->stats.rx_bytes;
113473b01e57SJeff Chen 	sinfo->tx_bytes = priv->stats.tx_bytes;
113573b01e57SJeff Chen 	sinfo->rx_packets = priv->stats.rx_packets;
113673b01e57SJeff Chen 	sinfo->tx_packets = priv->stats.tx_packets;
113773b01e57SJeff Chen 	sinfo->signal = priv->bcn_rssi_avg;
113873b01e57SJeff Chen 	/* Convert bitrate from 500 kb/s units to 100 kb/s units. */
113973b01e57SJeff Chen 	sinfo->txrate.legacy = rate * 5;
114073b01e57SJeff Chen 
114173b01e57SJeff Chen 	sinfo->filled |= BIT(NL80211_STA_INFO_RX_BITRATE);
114273b01e57SJeff Chen 	nxpwifi_parse_htinfo(priv, priv->rxpd_rate, priv->rxpd_htinfo,
114373b01e57SJeff Chen 			     &sinfo->rxrate);
114473b01e57SJeff Chen 
114573b01e57SJeff Chen 	if (priv->bss_mode == NL80211_IFTYPE_STATION) {
114673b01e57SJeff Chen 		sinfo->filled |= BIT_ULL(NL80211_STA_INFO_BSS_PARAM);
114773b01e57SJeff Chen 		sinfo->bss_param.flags = 0;
114873b01e57SJeff Chen 		if (priv->curr_bss_params.bss_descriptor.cap_info_bitmap &
114973b01e57SJeff Chen 						WLAN_CAPABILITY_SHORT_PREAMBLE)
115073b01e57SJeff Chen 			sinfo->bss_param.flags |=
115173b01e57SJeff Chen 					BSS_PARAM_FLAGS_SHORT_PREAMBLE;
115273b01e57SJeff Chen 		if (priv->curr_bss_params.bss_descriptor.cap_info_bitmap &
115373b01e57SJeff Chen 						WLAN_CAPABILITY_SHORT_SLOT_TIME)
115473b01e57SJeff Chen 			sinfo->bss_param.flags |=
115573b01e57SJeff Chen 					BSS_PARAM_FLAGS_SHORT_SLOT_TIME;
115673b01e57SJeff Chen 		sinfo->bss_param.dtim_period = priv->dtim_period;
115773b01e57SJeff Chen 		sinfo->bss_param.beacon_interval =
115873b01e57SJeff Chen 			priv->curr_bss_params.bss_descriptor.beacon_period;
115973b01e57SJeff Chen 	}
116073b01e57SJeff Chen 
116173b01e57SJeff Chen done:
116273b01e57SJeff Chen 	return ret;
116373b01e57SJeff Chen }
116473b01e57SJeff Chen 
116573b01e57SJeff Chen /*
116673b01e57SJeff Chen  * cfg80211 op: get station information.
116773b01e57SJeff Chen  * Works only when connected and fills station_info with current stats.
116873b01e57SJeff Chen  */
116973b01e57SJeff Chen static int
nxpwifi_cfg80211_get_station(struct wiphy * wiphy,struct wireless_dev * wdev,const u8 * mac,struct station_info * sinfo)117073b01e57SJeff Chen nxpwifi_cfg80211_get_station(struct wiphy *wiphy, struct wireless_dev *wdev,
117173b01e57SJeff Chen 			     const u8 *mac, struct station_info *sinfo)
117273b01e57SJeff Chen {
117373b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
117473b01e57SJeff Chen 	struct nxpwifi_sta_node *node;
117573b01e57SJeff Chen 
117673b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_STA) {
117773b01e57SJeff Chen 		if (!priv->media_connected ||
117873b01e57SJeff Chen 		    memcmp(mac, priv->cfg_bssid, ETH_ALEN))
117973b01e57SJeff Chen 			return -ENOENT;
118073b01e57SJeff Chen 		node = NULL;
118173b01e57SJeff Chen 	} else {
118273b01e57SJeff Chen 		rcu_read_lock();
118373b01e57SJeff Chen 		node = nxpwifi_get_sta_entry(priv, mac);
118473b01e57SJeff Chen 		rcu_read_unlock();
118573b01e57SJeff Chen 	}
118673b01e57SJeff Chen 
118773b01e57SJeff Chen 	return nxpwifi_dump_station_info(priv, node, sinfo);
118873b01e57SJeff Chen }
118973b01e57SJeff Chen 
119073b01e57SJeff Chen /* cfg80211 operation handler to dump station information. */
119173b01e57SJeff Chen static int
nxpwifi_cfg80211_dump_station(struct wiphy * wiphy,struct wireless_dev * wdev,int idx,u8 * mac,struct station_info * sinfo)119273b01e57SJeff Chen nxpwifi_cfg80211_dump_station(struct wiphy *wiphy, struct wireless_dev *wdev,
119373b01e57SJeff Chen 			      int idx, u8 *mac, struct station_info *sinfo)
119473b01e57SJeff Chen {
119573b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
119673b01e57SJeff Chen 	struct nxpwifi_sta_node *node;
119773b01e57SJeff Chen 	struct nxpwifi_sta_node *found = NULL;
119873b01e57SJeff Chen 	int i;
119973b01e57SJeff Chen 
120073b01e57SJeff Chen 	if ((GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_STA) &&
120173b01e57SJeff Chen 	    priv->media_connected && idx == 0) {
120273b01e57SJeff Chen 		ether_addr_copy(mac, priv->cfg_bssid);
120373b01e57SJeff Chen 		return nxpwifi_dump_station_info(priv, NULL, sinfo);
120473b01e57SJeff Chen 	} else if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP) {
120573b01e57SJeff Chen 		nxpwifi_ap_get_sta_list(priv);
120673b01e57SJeff Chen 
120773b01e57SJeff Chen 		i = 0;
120873b01e57SJeff Chen 		rcu_read_lock();
120973b01e57SJeff Chen 		list_for_each_entry_rcu(node, &priv->sta_list, list) {
121073b01e57SJeff Chen 			if (i++ != idx)
121173b01e57SJeff Chen 				continue;
121273b01e57SJeff Chen 			found = node;
121373b01e57SJeff Chen 			break;
121473b01e57SJeff Chen 		}
121573b01e57SJeff Chen 		rcu_read_unlock();
121673b01e57SJeff Chen 
121773b01e57SJeff Chen 		if (found) {
121873b01e57SJeff Chen 			ether_addr_copy(mac, node->mac_addr);
121973b01e57SJeff Chen 			return nxpwifi_dump_station_info(priv, node, sinfo);
122073b01e57SJeff Chen 		}
122173b01e57SJeff Chen 	}
122273b01e57SJeff Chen 
122373b01e57SJeff Chen 	return -ENOENT;
122473b01e57SJeff Chen }
122573b01e57SJeff Chen 
122673b01e57SJeff Chen static int
nxpwifi_cfg80211_dump_survey(struct wiphy * wiphy,struct net_device * dev,int idx,struct survey_info * survey)122773b01e57SJeff Chen nxpwifi_cfg80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
122873b01e57SJeff Chen 			     int idx, struct survey_info *survey)
122973b01e57SJeff Chen {
123073b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
123173b01e57SJeff Chen 	struct nxpwifi_chan_stats *pchan_stats = priv->adapter->chan_stats;
123273b01e57SJeff Chen 	enum nl80211_band band;
123373b01e57SJeff Chen 	u8 chan_num;
123473b01e57SJeff Chen 
123573b01e57SJeff Chen 	nxpwifi_dbg(priv->adapter, DUMP, "dump_survey idx=%d\n", idx);
123673b01e57SJeff Chen 
123773b01e57SJeff Chen 	memset(survey, 0, sizeof(struct survey_info));
123873b01e57SJeff Chen 
123973b01e57SJeff Chen 	if ((GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_STA) &&
124073b01e57SJeff Chen 	    priv->media_connected && idx == 0) {
124173b01e57SJeff Chen 		u8 curr_bss_band = priv->curr_bss_params.band;
124273b01e57SJeff Chen 		u32 chan = priv->curr_bss_params.bss_descriptor.channel;
124373b01e57SJeff Chen 
124473b01e57SJeff Chen 		band = nxpwifi_band_to_radio_type(curr_bss_band);
124573b01e57SJeff Chen 		survey->channel = ieee80211_get_channel
124673b01e57SJeff Chen 				  (wiphy,
124773b01e57SJeff Chen 				   ieee80211_channel_to_frequency(chan, band));
124873b01e57SJeff Chen 
124973b01e57SJeff Chen 		if (priv->bcn_nf_last) {
125073b01e57SJeff Chen 			survey->filled = SURVEY_INFO_NOISE_DBM;
125173b01e57SJeff Chen 			survey->noise = priv->bcn_nf_last;
125273b01e57SJeff Chen 		}
125373b01e57SJeff Chen 		return 0;
125473b01e57SJeff Chen 	}
125573b01e57SJeff Chen 
125673b01e57SJeff Chen 	if (idx >= priv->adapter->num_in_chan_stats)
125773b01e57SJeff Chen 		return -ENOENT;
125873b01e57SJeff Chen 
125973b01e57SJeff Chen 	if (!pchan_stats[idx].cca_scan_dur)
126073b01e57SJeff Chen 		return 0;
126173b01e57SJeff Chen 
126273b01e57SJeff Chen 	band = pchan_stats[idx].bandcfg;
126373b01e57SJeff Chen 	chan_num = pchan_stats[idx].chan_num;
126473b01e57SJeff Chen 	survey->channel = ieee80211_get_channel
126573b01e57SJeff Chen 			  (wiphy,
126673b01e57SJeff Chen 			   ieee80211_channel_to_frequency(chan_num, band));
126773b01e57SJeff Chen 	survey->filled = SURVEY_INFO_NOISE_DBM |
126873b01e57SJeff Chen 			 SURVEY_INFO_TIME |
126973b01e57SJeff Chen 			 SURVEY_INFO_TIME_BUSY;
127073b01e57SJeff Chen 	survey->noise = pchan_stats[idx].noise;
127173b01e57SJeff Chen 	survey->time = pchan_stats[idx].cca_scan_dur;
127273b01e57SJeff Chen 	survey->time_busy = pchan_stats[idx].cca_busy_dur;
127373b01e57SJeff Chen 
127473b01e57SJeff Chen 	return 0;
127573b01e57SJeff Chen }
127673b01e57SJeff Chen 
127773b01e57SJeff Chen /* Supported rates to be advertised to the cfg80211 */
127873b01e57SJeff Chen static struct ieee80211_rate nxpwifi_rates[] = {
127973b01e57SJeff Chen 	{.bitrate = 10, .hw_value = 2, },
128073b01e57SJeff Chen 	{.bitrate = 20, .hw_value = 4, },
128173b01e57SJeff Chen 	{.bitrate = 55, .hw_value = 11, },
128273b01e57SJeff Chen 	{.bitrate = 110, .hw_value = 22, },
128373b01e57SJeff Chen 	{.bitrate = 60, .hw_value = 12, },
128473b01e57SJeff Chen 	{.bitrate = 90, .hw_value = 18, },
128573b01e57SJeff Chen 	{.bitrate = 120, .hw_value = 24, },
128673b01e57SJeff Chen 	{.bitrate = 180, .hw_value = 36, },
128773b01e57SJeff Chen 	{.bitrate = 240, .hw_value = 48, },
128873b01e57SJeff Chen 	{.bitrate = 360, .hw_value = 72, },
128973b01e57SJeff Chen 	{.bitrate = 480, .hw_value = 96, },
129073b01e57SJeff Chen 	{.bitrate = 540, .hw_value = 108, },
129173b01e57SJeff Chen };
129273b01e57SJeff Chen 
129373b01e57SJeff Chen /* Channel definitions to be advertised to cfg80211 */
129473b01e57SJeff Chen static struct ieee80211_channel nxpwifi_channels_2ghz[] = {
129573b01e57SJeff Chen 	{.center_freq = 2412, .hw_value = 1, },
129673b01e57SJeff Chen 	{.center_freq = 2417, .hw_value = 2, },
129773b01e57SJeff Chen 	{.center_freq = 2422, .hw_value = 3, },
129873b01e57SJeff Chen 	{.center_freq = 2427, .hw_value = 4, },
129973b01e57SJeff Chen 	{.center_freq = 2432, .hw_value = 5, },
130073b01e57SJeff Chen 	{.center_freq = 2437, .hw_value = 6, },
130173b01e57SJeff Chen 	{.center_freq = 2442, .hw_value = 7, },
130273b01e57SJeff Chen 	{.center_freq = 2447, .hw_value = 8, },
130373b01e57SJeff Chen 	{.center_freq = 2452, .hw_value = 9, },
130473b01e57SJeff Chen 	{.center_freq = 2457, .hw_value = 10, },
130573b01e57SJeff Chen 	{.center_freq = 2462, .hw_value = 11, },
130673b01e57SJeff Chen 	{.center_freq = 2467, .hw_value = 12, },
130773b01e57SJeff Chen 	{.center_freq = 2472, .hw_value = 13, },
130873b01e57SJeff Chen 	{.center_freq = 2484, .hw_value = 14, },
130973b01e57SJeff Chen };
131073b01e57SJeff Chen 
131173b01e57SJeff Chen static struct ieee80211_supported_band nxpwifi_band_2ghz = {
131273b01e57SJeff Chen 	.band = NL80211_BAND_2GHZ,
131373b01e57SJeff Chen 	.channels = nxpwifi_channels_2ghz,
131473b01e57SJeff Chen 	.n_channels = ARRAY_SIZE(nxpwifi_channels_2ghz),
131573b01e57SJeff Chen 	.bitrates = nxpwifi_rates,
131673b01e57SJeff Chen 	.n_bitrates = ARRAY_SIZE(nxpwifi_rates),
131773b01e57SJeff Chen };
131873b01e57SJeff Chen 
131973b01e57SJeff Chen static struct ieee80211_channel nxpwifi_channels_5ghz[] = {
132073b01e57SJeff Chen 	{.center_freq = 5040, .hw_value = 8, },
132173b01e57SJeff Chen 	{.center_freq = 5060, .hw_value = 12, },
132273b01e57SJeff Chen 	{.center_freq = 5080, .hw_value = 16, },
132373b01e57SJeff Chen 	{.center_freq = 5170, .hw_value = 34, },
132473b01e57SJeff Chen 	{.center_freq = 5190, .hw_value = 38, },
132573b01e57SJeff Chen 	{.center_freq = 5210, .hw_value = 42, },
132673b01e57SJeff Chen 	{.center_freq = 5230, .hw_value = 46, },
132773b01e57SJeff Chen 	{.center_freq = 5180, .hw_value = 36, },
132873b01e57SJeff Chen 	{.center_freq = 5200, .hw_value = 40, },
132973b01e57SJeff Chen 	{.center_freq = 5220, .hw_value = 44, },
133073b01e57SJeff Chen 	{.center_freq = 5240, .hw_value = 48, },
133173b01e57SJeff Chen 	{.center_freq = 5260, .hw_value = 52, },
133273b01e57SJeff Chen 	{.center_freq = 5280, .hw_value = 56, },
133373b01e57SJeff Chen 	{.center_freq = 5300, .hw_value = 60, },
133473b01e57SJeff Chen 	{.center_freq = 5320, .hw_value = 64, },
133573b01e57SJeff Chen 	{.center_freq = 5500, .hw_value = 100, },
133673b01e57SJeff Chen 	{.center_freq = 5520, .hw_value = 104, },
133773b01e57SJeff Chen 	{.center_freq = 5540, .hw_value = 108, },
133873b01e57SJeff Chen 	{.center_freq = 5560, .hw_value = 112, },
133973b01e57SJeff Chen 	{.center_freq = 5580, .hw_value = 116, },
134073b01e57SJeff Chen 	{.center_freq = 5600, .hw_value = 120, },
134173b01e57SJeff Chen 	{.center_freq = 5620, .hw_value = 124, },
134273b01e57SJeff Chen 	{.center_freq = 5640, .hw_value = 128, },
134373b01e57SJeff Chen 	{.center_freq = 5660, .hw_value = 132, },
134473b01e57SJeff Chen 	{.center_freq = 5680, .hw_value = 136, },
134573b01e57SJeff Chen 	{.center_freq = 5700, .hw_value = 140, },
134673b01e57SJeff Chen 	{.center_freq = 5745, .hw_value = 149, },
134773b01e57SJeff Chen 	{.center_freq = 5765, .hw_value = 153, },
134873b01e57SJeff Chen 	{.center_freq = 5785, .hw_value = 157, },
134973b01e57SJeff Chen 	{.center_freq = 5805, .hw_value = 161, },
135073b01e57SJeff Chen 	{.center_freq = 5825, .hw_value = 165, },
135173b01e57SJeff Chen };
135273b01e57SJeff Chen 
135373b01e57SJeff Chen static struct ieee80211_supported_band nxpwifi_band_5ghz = {
135473b01e57SJeff Chen 	.band = NL80211_BAND_5GHZ,
135573b01e57SJeff Chen 	.channels = nxpwifi_channels_5ghz,
135673b01e57SJeff Chen 	.n_channels = ARRAY_SIZE(nxpwifi_channels_5ghz),
135773b01e57SJeff Chen 	.bitrates = nxpwifi_rates + 4,
135873b01e57SJeff Chen 	.n_bitrates = ARRAY_SIZE(nxpwifi_rates) - 4,
135973b01e57SJeff Chen };
136073b01e57SJeff Chen 
136173b01e57SJeff Chen /* Supported crypto cipher suits to be advertised to cfg80211 */
136273b01e57SJeff Chen static const u32 nxpwifi_cipher_suites[] = {
136373b01e57SJeff Chen 	WLAN_CIPHER_SUITE_WEP40,
136473b01e57SJeff Chen 	WLAN_CIPHER_SUITE_WEP104,
136573b01e57SJeff Chen 	WLAN_CIPHER_SUITE_TKIP,
136673b01e57SJeff Chen 	WLAN_CIPHER_SUITE_CCMP,
136773b01e57SJeff Chen 	WLAN_CIPHER_SUITE_SMS4,
136873b01e57SJeff Chen 	WLAN_CIPHER_SUITE_AES_CMAC,
136973b01e57SJeff Chen 	WLAN_CIPHER_SUITE_GCMP_256,
137073b01e57SJeff Chen 	WLAN_CIPHER_SUITE_CCMP_256,
137173b01e57SJeff Chen 	WLAN_CIPHER_SUITE_BIP_GMAC_256,
137273b01e57SJeff Chen 	WLAN_CIPHER_SUITE_BIP_CMAC_256,
137373b01e57SJeff Chen };
137473b01e57SJeff Chen 
137573b01e57SJeff Chen /* Supported mgmt frame types to be advertised to cfg80211 */
137673b01e57SJeff Chen static const struct ieee80211_txrx_stypes
137773b01e57SJeff Chen nxpwifi_mgmt_stypes[NUM_NL80211_IFTYPES] = {
137873b01e57SJeff Chen 	[NL80211_IFTYPE_STATION] = {
137973b01e57SJeff Chen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
138073b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
138173b01e57SJeff Chen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
138273b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
138373b01e57SJeff Chen 	},
138473b01e57SJeff Chen 	[NL80211_IFTYPE_AP] = {
138573b01e57SJeff Chen 		.tx = 0xffff,
138673b01e57SJeff Chen 		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
138773b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
138873b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
138973b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_DISASSOC >> 4) |
139073b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_AUTH >> 4) |
139173b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_DEAUTH >> 4) |
139273b01e57SJeff Chen 		      BIT(IEEE80211_STYPE_ACTION >> 4),
139373b01e57SJeff Chen 	},
139473b01e57SJeff Chen };
139573b01e57SJeff Chen 
139673b01e57SJeff Chen /*
139773b01e57SJeff Chen  * cfg80211 op: set bitrate mask.
139873b01e57SJeff Chen  * Converts cfg80211 bitrate selections into firmware bitmap format.
139973b01e57SJeff Chen  */
140073b01e57SJeff Chen static int
nxpwifi_cfg80211_set_bitrate_mask(struct wiphy * wiphy,struct net_device * dev,unsigned int link_id,const u8 * peer,const struct cfg80211_bitrate_mask * mask)140173b01e57SJeff Chen nxpwifi_cfg80211_set_bitrate_mask(struct wiphy *wiphy,
140273b01e57SJeff Chen 				  struct net_device *dev,
140373b01e57SJeff Chen 				  unsigned int link_id,
140473b01e57SJeff Chen 				  const u8 *peer,
140573b01e57SJeff Chen 				  const struct cfg80211_bitrate_mask *mask)
140673b01e57SJeff Chen {
140773b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
140873b01e57SJeff Chen 	u16 bitmap_rates[MAX_BITMAP_RATES_SIZE];
140973b01e57SJeff Chen 	enum nl80211_band band;
141073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
141173b01e57SJeff Chen 
141273b01e57SJeff Chen 	if (!priv->media_connected) {
141373b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
141473b01e57SJeff Chen 			    "Can not set Tx data rate in disconnected state\n");
141573b01e57SJeff Chen 		return -EINVAL;
141673b01e57SJeff Chen 	}
141773b01e57SJeff Chen 
141873b01e57SJeff Chen 	band = nxpwifi_band_to_radio_type(priv->curr_bss_params.band);
141973b01e57SJeff Chen 
142073b01e57SJeff Chen 	memset(bitmap_rates, 0, sizeof(bitmap_rates));
142173b01e57SJeff Chen 
142273b01e57SJeff Chen 	/* Fill HR/DSSS legacy rates (2.4 GHz only). */
142373b01e57SJeff Chen 	if (band == NL80211_BAND_2GHZ)
142473b01e57SJeff Chen 		bitmap_rates[0] = mask->control[band].legacy & 0x000f;
142573b01e57SJeff Chen 
142673b01e57SJeff Chen 	/* Fill OFDM legacy rates. */
142773b01e57SJeff Chen 	if (band == NL80211_BAND_2GHZ)
142873b01e57SJeff Chen 		bitmap_rates[1] = (mask->control[band].legacy & 0x0ff0) >> 4;
142973b01e57SJeff Chen 	else
143073b01e57SJeff Chen 		bitmap_rates[1] = mask->control[band].legacy;
143173b01e57SJeff Chen 
143273b01e57SJeff Chen 	/* Fill HT MCS bitmap (1x1 or 2x2 depending on hardware). */
143373b01e57SJeff Chen 	bitmap_rates[2] = mask->control[band].ht_mcs[0];
143473b01e57SJeff Chen 	if (adapter->hw_dev_mcs_support == HT_STREAM_2X2)
143573b01e57SJeff Chen 		bitmap_rates[2] |= mask->control[band].ht_mcs[1] << 8;
143673b01e57SJeff Chen 
143773b01e57SJeff Chen 	/* Fill VHT MCS bitmap if supported by firmware. */
143873b01e57SJeff Chen 	if (adapter->fw_api_ver == NXPWIFI_FW_V15) {
143973b01e57SJeff Chen 		bitmap_rates[10] = mask->control[band].vht_mcs[0];
144073b01e57SJeff Chen 		if (adapter->hw_dev_mcs_support == HT_STREAM_2X2)
144173b01e57SJeff Chen 			bitmap_rates[11] = mask->control[band].vht_mcs[1];
144273b01e57SJeff Chen 	}
144373b01e57SJeff Chen 
144473b01e57SJeff Chen 	return nxpwifi_set_tx_rate(priv, bitmap_rates);
144573b01e57SJeff Chen }
144673b01e57SJeff Chen 
144773b01e57SJeff Chen /*
144873b01e57SJeff Chen  * cfg80211 op: configure connection-quality monitoring.
144973b01e57SJeff Chen  * Subscribes or unsubscribes HIGH_RSSI and LOW_RSSI events to firmware.
145073b01e57SJeff Chen  */
nxpwifi_cfg80211_set_cqm_rssi_config(struct wiphy * wiphy,struct net_device * dev,s32 rssi_thold,u32 rssi_hyst)145173b01e57SJeff Chen static int nxpwifi_cfg80211_set_cqm_rssi_config(struct wiphy *wiphy,
145273b01e57SJeff Chen 						struct net_device *dev,
145373b01e57SJeff Chen 						s32 rssi_thold, u32 rssi_hyst)
145473b01e57SJeff Chen {
145573b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
145673b01e57SJeff Chen 	struct nxpwifi_ds_misc_subsc_evt subsc_evt;
145773b01e57SJeff Chen 	int ret = 0;
145873b01e57SJeff Chen 
145973b01e57SJeff Chen 	priv->cqm_rssi_thold = rssi_thold;
146073b01e57SJeff Chen 	priv->cqm_rssi_hyst = rssi_hyst;
146173b01e57SJeff Chen 
146273b01e57SJeff Chen 	memset(&subsc_evt, 0x00, sizeof(struct nxpwifi_ds_misc_subsc_evt));
146373b01e57SJeff Chen 	subsc_evt.events = BITMASK_BCN_RSSI_LOW | BITMASK_BCN_RSSI_HIGH;
146473b01e57SJeff Chen 
146573b01e57SJeff Chen 	/* Subscribe/unsubscribe low and high rssi events */
146673b01e57SJeff Chen 	if (rssi_thold && rssi_hyst) {
146773b01e57SJeff Chen 		subsc_evt.action = HOST_ACT_BITWISE_SET;
146873b01e57SJeff Chen 		subsc_evt.bcn_l_rssi_cfg.abs_value = abs(rssi_thold);
146973b01e57SJeff Chen 		subsc_evt.bcn_h_rssi_cfg.abs_value = abs(rssi_thold);
147073b01e57SJeff Chen 		subsc_evt.bcn_l_rssi_cfg.evt_freq = 1;
147173b01e57SJeff Chen 		subsc_evt.bcn_h_rssi_cfg.evt_freq = 1;
147273b01e57SJeff Chen 		ret = nxpwifi_802_11_subscribe_event(priv, &subsc_evt);
147373b01e57SJeff Chen 	} else {
147473b01e57SJeff Chen 		subsc_evt.action = HOST_ACT_BITWISE_CLR;
147573b01e57SJeff Chen 		ret = nxpwifi_802_11_subscribe_event(priv, &subsc_evt);
147673b01e57SJeff Chen 	}
147773b01e57SJeff Chen 
147873b01e57SJeff Chen 	return ret;
147973b01e57SJeff Chen }
148073b01e57SJeff Chen 
148173b01e57SJeff Chen /*
148273b01e57SJeff Chen  * cfg80211 operation handler for change_beacon.
148373b01e57SJeff Chen  * Function retrieves and sets modified management IEs to FW.
148473b01e57SJeff Chen  */
nxpwifi_cfg80211_change_beacon(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_ap_update * params)148573b01e57SJeff Chen int nxpwifi_cfg80211_change_beacon(struct wiphy *wiphy,
148673b01e57SJeff Chen 				   struct net_device *dev,
148773b01e57SJeff Chen 				   struct cfg80211_ap_update *params)
148873b01e57SJeff Chen {
148973b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
149073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
149173b01e57SJeff Chen 	struct cfg80211_beacon_data *data = &params->beacon;
149273b01e57SJeff Chen 	int ret;
149373b01e57SJeff Chen 
149473b01e57SJeff Chen 	nxpwifi_cancel_scan(adapter);
149573b01e57SJeff Chen 
149673b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) != NXPWIFI_BSS_ROLE_UAP) {
149773b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
149873b01e57SJeff Chen 			    "%s: bss_type mismatched\n", __func__);
149973b01e57SJeff Chen 		return -EINVAL;
150073b01e57SJeff Chen 	}
150173b01e57SJeff Chen 
150273b01e57SJeff Chen 	ret = nxpwifi_set_mgmt_ies(priv, data);
150373b01e57SJeff Chen 	if (ret)
150473b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
150573b01e57SJeff Chen 			    "%s: setting mgmt ies failed\n", __func__);
150673b01e57SJeff Chen 
150773b01e57SJeff Chen 	return ret;
150873b01e57SJeff Chen }
150973b01e57SJeff Chen 
151073b01e57SJeff Chen /*
151173b01e57SJeff Chen  * cfg80211 operation handler for del_station.
151273b01e57SJeff Chen  * Function deauthenticates station which value is provided in mac parameter.
151373b01e57SJeff Chen  * If mac is NULL/broadcast, all stations in associated station list are
151473b01e57SJeff Chen  * deauthenticated. If bss is not started or there are no stations in
151573b01e57SJeff Chen  * associated stations list, no action is taken.
151673b01e57SJeff Chen  */
151773b01e57SJeff Chen static int
nxpwifi_cfg80211_del_station(struct wiphy * wiphy,struct wireless_dev * wdev,struct station_del_parameters * params)151873b01e57SJeff Chen nxpwifi_cfg80211_del_station(struct wiphy *wiphy, struct wireless_dev *wdev,
151973b01e57SJeff Chen 			     struct station_del_parameters *params)
152073b01e57SJeff Chen {
152173b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
152273b01e57SJeff Chen 	struct nxpwifi_sta_node *sta_node;
152373b01e57SJeff Chen 	u8 deauth_mac[ETH_ALEN];
152473b01e57SJeff Chen 	int ret = 0;
152573b01e57SJeff Chen 
152673b01e57SJeff Chen 	if (!priv->bss_started && priv->wdev.links[0].cac_started) {
152773b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO, "%s: abort CAC!\n", __func__);
152873b01e57SJeff Chen 		nxpwifi_abort_cac(priv);
152973b01e57SJeff Chen 	}
153073b01e57SJeff Chen 
153173b01e57SJeff Chen 	if (list_empty(&priv->sta_list) || !priv->bss_started)
153273b01e57SJeff Chen 		return 0;
153373b01e57SJeff Chen 
153473b01e57SJeff Chen 	if (!params->mac || is_broadcast_ether_addr(params->mac))
153573b01e57SJeff Chen 		return 0;
153673b01e57SJeff Chen 
153773b01e57SJeff Chen 	nxpwifi_dbg(priv->adapter, INFO, "%s: mac address %pM\n",
153873b01e57SJeff Chen 		    __func__, params->mac);
153973b01e57SJeff Chen 
154073b01e57SJeff Chen 	eth_zero_addr(deauth_mac);
154173b01e57SJeff Chen 
154273b01e57SJeff Chen 	sta_node = nxpwifi_get_sta_entry(priv, params->mac);
154373b01e57SJeff Chen 	if (sta_node)
154473b01e57SJeff Chen 		ether_addr_copy(deauth_mac, params->mac);
154573b01e57SJeff Chen 
154673b01e57SJeff Chen 	if (is_valid_ether_addr(deauth_mac)) {
154773b01e57SJeff Chen 		ret = nxpwifi_uap_sta_deauth(priv, deauth_mac);
154873b01e57SJeff Chen 		nxpwifi_del_sta_entry(priv, deauth_mac);
154973b01e57SJeff Chen 	}
155073b01e57SJeff Chen 	return ret;
155173b01e57SJeff Chen }
155273b01e57SJeff Chen 
155373b01e57SJeff Chen static int
nxpwifi_cfg80211_set_antenna(struct wiphy * wiphy,int radio_idx,u32 tx_ant,u32 rx_ant)155473b01e57SJeff Chen nxpwifi_cfg80211_set_antenna(struct wiphy *wiphy, int radio_idx, u32 tx_ant, u32 rx_ant)
155573b01e57SJeff Chen {
155673b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
155773b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_get_priv(adapter,
155873b01e57SJeff Chen 							NXPWIFI_BSS_ROLE_ANY);
155973b01e57SJeff Chen 	struct nxpwifi_ds_ant_cfg ant_cfg;
156073b01e57SJeff Chen 
156173b01e57SJeff Chen 	if (!tx_ant || !rx_ant)
156273b01e57SJeff Chen 		return -EOPNOTSUPP;
156373b01e57SJeff Chen 
156473b01e57SJeff Chen 	if (adapter->hw_dev_mcs_support != HT_STREAM_2X2) {
156573b01e57SJeff Chen 		/*
156673b01e57SJeff Chen 		 * Not a MIMO chip. User should provide specific antenna number
156773b01e57SJeff Chen 		 * for Tx/Rx path or enable all antennas for diversity
156873b01e57SJeff Chen 		 */
156973b01e57SJeff Chen 		if (tx_ant != rx_ant)
157073b01e57SJeff Chen 			return -EOPNOTSUPP;
157173b01e57SJeff Chen 
157273b01e57SJeff Chen 		if ((tx_ant & (tx_ant - 1)) &&
157373b01e57SJeff Chen 		    (tx_ant != BIT(adapter->number_of_antenna) - 1))
157473b01e57SJeff Chen 			return -EOPNOTSUPP;
157573b01e57SJeff Chen 
157673b01e57SJeff Chen 		if ((tx_ant == BIT(adapter->number_of_antenna) - 1) &&
157773b01e57SJeff Chen 		    priv->adapter->number_of_antenna > 1) {
157873b01e57SJeff Chen 			tx_ant = RF_ANTENNA_AUTO;
157973b01e57SJeff Chen 			rx_ant = RF_ANTENNA_AUTO;
158073b01e57SJeff Chen 		}
158173b01e57SJeff Chen 	} else {
158273b01e57SJeff Chen 		struct ieee80211_sta_ht_cap *ht_info;
158373b01e57SJeff Chen 		int rx_mcs_supp;
158473b01e57SJeff Chen 		enum nl80211_band band;
158573b01e57SJeff Chen 
158673b01e57SJeff Chen 		if ((tx_ant == 0x1 && rx_ant == 0x1)) {
158773b01e57SJeff Chen 			adapter->user_dev_mcs_support = HT_STREAM_1X1;
158873b01e57SJeff Chen 			if (adapter->is_hw_11ac_capable)
158973b01e57SJeff Chen 				adapter->usr_dot_11ac_mcs_support =
159073b01e57SJeff Chen 						NXPWIFI_11AC_MCS_MAP_1X1;
159173b01e57SJeff Chen 		} else {
159273b01e57SJeff Chen 			adapter->user_dev_mcs_support = HT_STREAM_2X2;
159373b01e57SJeff Chen 			if (adapter->is_hw_11ac_capable)
159473b01e57SJeff Chen 				adapter->usr_dot_11ac_mcs_support =
159573b01e57SJeff Chen 						NXPWIFI_11AC_MCS_MAP_2X2;
159673b01e57SJeff Chen 		}
159773b01e57SJeff Chen 
159873b01e57SJeff Chen 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
159973b01e57SJeff Chen 			if (!adapter->wiphy->bands[band])
160073b01e57SJeff Chen 				continue;
160173b01e57SJeff Chen 
160273b01e57SJeff Chen 			ht_info = &adapter->wiphy->bands[band]->ht_cap;
160373b01e57SJeff Chen 			rx_mcs_supp =
160473b01e57SJeff Chen 				GET_RXMCSSUPP(adapter->user_dev_mcs_support);
160573b01e57SJeff Chen 			memset(&ht_info->mcs, 0, adapter->number_of_antenna);
160673b01e57SJeff Chen 			memset(&ht_info->mcs, 0xff, rx_mcs_supp);
160773b01e57SJeff Chen 		}
160873b01e57SJeff Chen 	}
160973b01e57SJeff Chen 
161073b01e57SJeff Chen 	ant_cfg.tx_ant = tx_ant;
161173b01e57SJeff Chen 	ant_cfg.rx_ant = rx_ant;
161273b01e57SJeff Chen 
161373b01e57SJeff Chen 	return nxpwifi_set_rf_antenna(priv, &ant_cfg);
161473b01e57SJeff Chen }
161573b01e57SJeff Chen 
161673b01e57SJeff Chen static int
nxpwifi_cfg80211_get_antenna(struct wiphy * wiphy,int radio_idx,u32 * tx_ant,u32 * rx_ant)161773b01e57SJeff Chen nxpwifi_cfg80211_get_antenna(struct wiphy *wiphy, int radio_idx, u32 *tx_ant, u32 *rx_ant)
161873b01e57SJeff Chen {
161973b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
162073b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_get_priv(adapter,
162173b01e57SJeff Chen 							NXPWIFI_BSS_ROLE_ANY);
162273b01e57SJeff Chen 	int ret;
162373b01e57SJeff Chen 
162473b01e57SJeff Chen 	ret = nxpwifi_get_rf_antenna(priv, tx_ant, rx_ant);
162573b01e57SJeff Chen 
162673b01e57SJeff Chen 	return ret;
162773b01e57SJeff Chen }
162873b01e57SJeff Chen 
162973b01e57SJeff Chen /*
163073b01e57SJeff Chen  * cfg80211 op: stop AP.
163173b01e57SJeff Chen  * Stops the BSS running on the uAP interface.
163273b01e57SJeff Chen  */
nxpwifi_cfg80211_stop_ap(struct wiphy * wiphy,struct net_device * dev,unsigned int link_id)163373b01e57SJeff Chen static int nxpwifi_cfg80211_stop_ap(struct wiphy *wiphy, struct net_device *dev,
163473b01e57SJeff Chen 				    unsigned int link_id)
163573b01e57SJeff Chen {
163673b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
163773b01e57SJeff Chen 	int ret;
163873b01e57SJeff Chen 
163973b01e57SJeff Chen 	nxpwifi_abort_cac(priv);
164073b01e57SJeff Chen 
164173b01e57SJeff Chen 	if (nxpwifi_del_mgmt_ies(priv))
164273b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
164373b01e57SJeff Chen 			    "Failed to delete mgmt IEs!\n");
164473b01e57SJeff Chen 
164573b01e57SJeff Chen 	priv->ap_11n_enabled = 0;
164673b01e57SJeff Chen 	memset(&priv->bss_cfg, 0, sizeof(priv->bss_cfg));
164773b01e57SJeff Chen 
164873b01e57SJeff Chen 	ret = nxpwifi_ap_stop_bss(priv);
164973b01e57SJeff Chen 	if (ret) {
165073b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
165173b01e57SJeff Chen 			    "Failed to stop the BSS\n");
165273b01e57SJeff Chen 		goto done;
165373b01e57SJeff Chen 	}
165473b01e57SJeff Chen 
165573b01e57SJeff Chen 	ret = nxpwifi_ap_sys_reset(priv);
165673b01e57SJeff Chen 	if (ret) {
165773b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
165873b01e57SJeff Chen 			    "Failed to reset BSS\n");
165973b01e57SJeff Chen 		goto done;
166073b01e57SJeff Chen 	}
166173b01e57SJeff Chen 
166273b01e57SJeff Chen 	netif_carrier_off(priv->netdev);
166373b01e57SJeff Chen 	nxpwifi_stop_net_dev_queue(priv->netdev, priv->adapter);
166473b01e57SJeff Chen 
166573b01e57SJeff Chen 	if (atomic_dec_and_test(&priv->adapter->uap_count)) {
166673b01e57SJeff Chen 		priv->adapter->chandef_valid = false;
166773b01e57SJeff Chen 		memset(&priv->adapter->chandef, 0, sizeof(priv->adapter->chandef));
166873b01e57SJeff Chen 	}
166973b01e57SJeff Chen 
167073b01e57SJeff Chen done:
167173b01e57SJeff Chen 	return ret;
167273b01e57SJeff Chen }
167373b01e57SJeff Chen 
167473b01e57SJeff Chen /*
167573b01e57SJeff Chen  * cfg80211 op: start AP.
167673b01e57SJeff Chen  * Applies beacon/DTIM/SSID/security settings to the uAP configuration and
167773b01e57SJeff Chen  * starts the BSS.
167873b01e57SJeff Chen  */
nxpwifi_cfg80211_start_ap(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_ap_settings * params)167973b01e57SJeff Chen static int nxpwifi_cfg80211_start_ap(struct wiphy *wiphy,
168073b01e57SJeff Chen 				     struct net_device *dev,
168173b01e57SJeff Chen 				     struct cfg80211_ap_settings *params)
168273b01e57SJeff Chen {
168373b01e57SJeff Chen 	struct nxpwifi_uap_bss_param *bss_cfg;
168473b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
168573b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
168673b01e57SJeff Chen 	struct cfg80211_chan_def use_chandef;
168773b01e57SJeff Chen 	bool is_first_uap = false;
168873b01e57SJeff Chen 	int ret;
168973b01e57SJeff Chen 
169073b01e57SJeff Chen 	/*
169173b01e57SJeff Chen 	 * Adapter is the HW channel owner (single PHY).
169273b01e57SJeff Chen 	 * All UAP interfaces on the same adapter must share
169373b01e57SJeff Chen 	 * the same RF channel.
169473b01e57SJeff Chen 	 */
169573b01e57SJeff Chen 	use_chandef = params->chandef;
169673b01e57SJeff Chen 
169773b01e57SJeff Chen 	if (adapter->chandef_valid) {
169873b01e57SJeff Chen 		if (!cfg80211_chandef_identical(&adapter->chandef,
169973b01e57SJeff Chen 						&params->chandef)) {
170073b01e57SJeff Chen 			nxpwifi_dbg(adapter, INFO,
170173b01e57SJeff Chen 				    "UAP already running on channel %d, ignore requested channel %d\n",
170273b01e57SJeff Chen 				    adapter->chandef.chan->hw_value,
170373b01e57SJeff Chen 				    params->chandef.chan->hw_value);
170473b01e57SJeff Chen 		}
170573b01e57SJeff Chen 		use_chandef = adapter->chandef;
170673b01e57SJeff Chen 	} else	{
170773b01e57SJeff Chen 		is_first_uap = true;
170873b01e57SJeff Chen 	}
170973b01e57SJeff Chen 
171073b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) != NXPWIFI_BSS_ROLE_UAP)
171173b01e57SJeff Chen 		return -EINVAL;
171273b01e57SJeff Chen 
171373b01e57SJeff Chen 	if (!nxpwifi_is_channel_setting_allowable(priv, params->chandef.chan))
171473b01e57SJeff Chen 		return -EOPNOTSUPP;
171573b01e57SJeff Chen 
171673b01e57SJeff Chen 	bss_cfg = kzalloc_obj(*bss_cfg, GFP_KERNEL);
171773b01e57SJeff Chen 	if (!bss_cfg)
171873b01e57SJeff Chen 		return -ENOMEM;
171973b01e57SJeff Chen 
172073b01e57SJeff Chen 	nxpwifi_set_sys_config_invalid_data(bss_cfg);
172173b01e57SJeff Chen 
172273b01e57SJeff Chen 	memcpy(bss_cfg->mac_addr, priv->curr_addr, ETH_ALEN);
172373b01e57SJeff Chen 
172473b01e57SJeff Chen 	if (params->beacon_interval)
172573b01e57SJeff Chen 		bss_cfg->beacon_period = params->beacon_interval;
172673b01e57SJeff Chen 	if (params->dtim_period)
172773b01e57SJeff Chen 		bss_cfg->dtim_period = params->dtim_period;
172873b01e57SJeff Chen 
172973b01e57SJeff Chen 	if (params->ssid && params->ssid_len) {
173073b01e57SJeff Chen 		memcpy(bss_cfg->ssid.ssid, params->ssid, params->ssid_len);
173173b01e57SJeff Chen 		bss_cfg->ssid.ssid_len = params->ssid_len;
173273b01e57SJeff Chen 	}
173373b01e57SJeff Chen 	if (params->inactivity_timeout > 0) {
173473b01e57SJeff Chen 		/* sta_ao_timer/ps_sta_ao_timer is in unit of 100ms */
173573b01e57SJeff Chen 		bss_cfg->sta_ao_timer = 10 * params->inactivity_timeout;
173673b01e57SJeff Chen 		bss_cfg->ps_sta_ao_timer = 10 * params->inactivity_timeout;
173773b01e57SJeff Chen 	}
173873b01e57SJeff Chen 
173973b01e57SJeff Chen 	/* Default: SSID is visible */
174073b01e57SJeff Chen 	bss_cfg->bcast_ssid_ctl = NXPWIFI_BCAST_SSID_VISIBLE;
174173b01e57SJeff Chen 
174273b01e57SJeff Chen 	switch (params->hidden_ssid) {
174373b01e57SJeff Chen 	case NL80211_HIDDEN_SSID_NOT_IN_USE:
174473b01e57SJeff Chen 		bss_cfg->bcast_ssid_ctl = NXPWIFI_BCAST_SSID_VISIBLE;
174573b01e57SJeff Chen 		break;
174673b01e57SJeff Chen 	case NL80211_HIDDEN_SSID_ZERO_LEN:
174773b01e57SJeff Chen 		bss_cfg->bcast_ssid_ctl = NXPWIFI_BCAST_SSID_HIDE_LEN_ZERO;
174873b01e57SJeff Chen 		break;
174973b01e57SJeff Chen 	case NL80211_HIDDEN_SSID_ZERO_CONTENTS:
175073b01e57SJeff Chen 		bss_cfg->bcast_ssid_ctl = NXPWIFI_BCAST_SSID_HIDE_LEN_RETAIN;
175173b01e57SJeff Chen 		break;
175273b01e57SJeff Chen 	}
175373b01e57SJeff Chen 
175473b01e57SJeff Chen 	nxpwifi_uap_set_channel(priv, bss_cfg, use_chandef);
175573b01e57SJeff Chen 	nxpwifi_set_uap_rates(bss_cfg, params);
175673b01e57SJeff Chen 
175773b01e57SJeff Chen 	ret = nxpwifi_set_secure_params(priv, bss_cfg, params);
175873b01e57SJeff Chen 	if (ret) {
175973b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
176073b01e57SJeff Chen 			    "Failed to parse security parameters!\n");
176173b01e57SJeff Chen 		goto done;
176273b01e57SJeff Chen 	}
176373b01e57SJeff Chen 
176473b01e57SJeff Chen 	nxpwifi_set_ht_params(priv, bss_cfg, params);
176573b01e57SJeff Chen 
176673b01e57SJeff Chen 	if (adapter->is_hw_11ac_capable) {
176773b01e57SJeff Chen 		nxpwifi_set_vht_params(priv, bss_cfg, params);
176873b01e57SJeff Chen 		nxpwifi_set_vht_width(priv, use_chandef.width,
176973b01e57SJeff Chen 				      priv->ap_11ac_enabled);
177073b01e57SJeff Chen 	}
177173b01e57SJeff Chen 
177273b01e57SJeff Chen 	if (priv->ap_11ac_enabled)
177373b01e57SJeff Chen 		nxpwifi_set_11ac_ba_params(priv);
177473b01e57SJeff Chen 	else
177573b01e57SJeff Chen 		nxpwifi_set_ba_params(priv);
177673b01e57SJeff Chen 
177773b01e57SJeff Chen 	if (adapter->is_hw_11ax_capable) {
177873b01e57SJeff Chen 		priv->ap_11ax_enabled =
177973b01e57SJeff Chen 			nxpwifi_check_11ax_capability(priv, bss_cfg, params);
178073b01e57SJeff Chen 		if (priv->ap_11ax_enabled)
178173b01e57SJeff Chen 			nxpwifi_set_11ax_status(priv, bss_cfg, params);
178273b01e57SJeff Chen 	}
178373b01e57SJeff Chen 
178473b01e57SJeff Chen 	nxpwifi_set_wmm_params(priv, bss_cfg, params);
178573b01e57SJeff Chen 
178673b01e57SJeff Chen 	if (nxpwifi_is_11h_active(priv))
178773b01e57SJeff Chen 		nxpwifi_set_tpc_params(priv, bss_cfg, params);
178873b01e57SJeff Chen 
178973b01e57SJeff Chen 	if (nxpwifi_is_11h_active(priv) &&
179073b01e57SJeff Chen 	    !cfg80211_chandef_dfs_required(wiphy, &params->chandef,
179173b01e57SJeff Chen 					   priv->bss_mode)) {
179273b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
179373b01e57SJeff Chen 			    "Disable 11h extensions in FW\n");
179473b01e57SJeff Chen 		ret = nxpwifi_11h_activate(priv, false);
179573b01e57SJeff Chen 		if (ret) {
179673b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, ERROR,
179773b01e57SJeff Chen 				    "Failed to disable 11h extensions!!");
179873b01e57SJeff Chen 			goto done;
179973b01e57SJeff Chen 		}
180073b01e57SJeff Chen 		priv->state_11h.is_11h_active = false;
180173b01e57SJeff Chen 	}
180273b01e57SJeff Chen 
180373b01e57SJeff Chen 	nxpwifi_config_uap_11d(priv, &params->beacon);
180473b01e57SJeff Chen 
180573b01e57SJeff Chen 	ret = nxpwifi_set_mgmt_ies(priv, &params->beacon);
180673b01e57SJeff Chen 	if (ret)
180773b01e57SJeff Chen 		goto done;
180873b01e57SJeff Chen 
180973b01e57SJeff Chen 	ret = nxpwifi_config_start_uap(priv, bss_cfg);
181073b01e57SJeff Chen 	if (ret) {
181173b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
181273b01e57SJeff Chen 			    "Failed to start AP\n");
181373b01e57SJeff Chen 		goto done;
181473b01e57SJeff Chen 	}
181573b01e57SJeff Chen 
181673b01e57SJeff Chen 	/* First UAP records adapter-level HW channel */
181773b01e57SJeff Chen 	if (is_first_uap) {
181873b01e57SJeff Chen 		adapter->chandef = use_chandef;
181973b01e57SJeff Chen 		adapter->chandef_valid = true;
182073b01e57SJeff Chen 	}
182173b01e57SJeff Chen 	atomic_inc(&adapter->uap_count);
182273b01e57SJeff Chen 	netif_carrier_on(priv->netdev);
182373b01e57SJeff Chen 	nxpwifi_wake_up_net_dev_queue(priv->netdev, priv->adapter);
182473b01e57SJeff Chen 
182573b01e57SJeff Chen 	memcpy(&priv->bss_cfg, bss_cfg, sizeof(priv->bss_cfg));
182673b01e57SJeff Chen 
182773b01e57SJeff Chen done:
182873b01e57SJeff Chen 	kfree(bss_cfg);
182973b01e57SJeff Chen 	return ret;
183073b01e57SJeff Chen }
183173b01e57SJeff Chen 
183273b01e57SJeff Chen /*
183373b01e57SJeff Chen  * cfg80211 op: handle scan request.
183473b01e57SJeff Chen  * Issues a firmware scan using the requested parameters and reports the
183573b01e57SJeff Chen  * results.
183673b01e57SJeff Chen  */
183773b01e57SJeff Chen static int
nxpwifi_cfg80211_scan(struct wiphy * wiphy,struct cfg80211_scan_request * request)183873b01e57SJeff Chen nxpwifi_cfg80211_scan(struct wiphy *wiphy,
183973b01e57SJeff Chen 		      struct cfg80211_scan_request *request)
184073b01e57SJeff Chen {
184173b01e57SJeff Chen 	struct net_device *dev = request->wdev->netdev;
184273b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
184373b01e57SJeff Chen 	int i, offset, ret;
184473b01e57SJeff Chen 	struct ieee80211_channel *chan;
184573b01e57SJeff Chen 	struct element *ie;
184673b01e57SJeff Chen 	struct nxpwifi_user_scan_cfg *user_scan_cfg;
184773b01e57SJeff Chen 	u8 mac_addr[ETH_ALEN];
184873b01e57SJeff Chen 
184973b01e57SJeff Chen 	nxpwifi_dbg(priv->adapter, CMD,
185073b01e57SJeff Chen 		    "info: received scan request on %s\n", dev->name);
185173b01e57SJeff Chen 
185273b01e57SJeff Chen 	/*
185373b01e57SJeff Chen 	 * Block scan requests during active scanning or scan cleanup.
185473b01e57SJeff Chen 	 * Prevents new scans when the interface is disabled or teardown is in
185573b01e57SJeff Chen 	 * progress.
185673b01e57SJeff Chen 	 */
185773b01e57SJeff Chen 	if (priv->scan_request || priv->scan_aborting) {
185873b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, WARN,
185973b01e57SJeff Chen 			    "cmd: Scan already in process..\n");
186073b01e57SJeff Chen 		return -EBUSY;
186173b01e57SJeff Chen 	}
186273b01e57SJeff Chen 
186373b01e57SJeff Chen 	if (!priv->wdev.connected && priv->scan_block)
186473b01e57SJeff Chen 		priv->scan_block = false;
186573b01e57SJeff Chen 
186673b01e57SJeff Chen 	if (!nxpwifi_stop_bg_scan(priv))
186773b01e57SJeff Chen 		cfg80211_sched_scan_stopped_locked(priv->wdev.wiphy, 0);
186873b01e57SJeff Chen 
186973b01e57SJeff Chen 	user_scan_cfg = kzalloc_obj(*user_scan_cfg, GFP_KERNEL);
187073b01e57SJeff Chen 	if (!user_scan_cfg)
187173b01e57SJeff Chen 		return -ENOMEM;
187273b01e57SJeff Chen 
187373b01e57SJeff Chen 	priv->scan_request = request;
187473b01e57SJeff Chen 
187573b01e57SJeff Chen 	if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
187673b01e57SJeff Chen 		get_random_mask_addr(mac_addr, request->mac_addr,
187773b01e57SJeff Chen 				     request->mac_addr_mask);
187873b01e57SJeff Chen 		ether_addr_copy(request->mac_addr, mac_addr);
187973b01e57SJeff Chen 		ether_addr_copy(user_scan_cfg->random_mac, mac_addr);
188073b01e57SJeff Chen 	}
188173b01e57SJeff Chen 
188273b01e57SJeff Chen 	user_scan_cfg->num_ssids = request->n_ssids;
188373b01e57SJeff Chen 	user_scan_cfg->ssid_list = request->ssids;
188473b01e57SJeff Chen 
188573b01e57SJeff Chen 	if (request->ie && request->ie_len) {
188673b01e57SJeff Chen 		offset = 0;
188773b01e57SJeff Chen 		for (i = 0; i < NXPWIFI_MAX_VSIE_NUM; i++) {
188873b01e57SJeff Chen 			if (priv->vs_ie[i].mask != NXPWIFI_VSIE_MASK_CLEAR)
188973b01e57SJeff Chen 				continue;
189073b01e57SJeff Chen 			priv->vs_ie[i].mask = NXPWIFI_VSIE_MASK_SCAN;
189173b01e57SJeff Chen 			ie = (struct element *)(request->ie + offset);
189273b01e57SJeff Chen 			memcpy(&priv->vs_ie[i].ie, ie,
189373b01e57SJeff Chen 			       sizeof(*ie) + ie->datalen);
189473b01e57SJeff Chen 			offset += sizeof(*ie) + ie->datalen;
189573b01e57SJeff Chen 
189673b01e57SJeff Chen 			if (offset >= request->ie_len)
189773b01e57SJeff Chen 				break;
189873b01e57SJeff Chen 		}
189973b01e57SJeff Chen 	}
190073b01e57SJeff Chen 
190173b01e57SJeff Chen 	for (i = 0; i < min_t(u32, request->n_channels,
190273b01e57SJeff Chen 			      NXPWIFI_USER_SCAN_CHAN_MAX); i++) {
190373b01e57SJeff Chen 		chan = request->channels[i];
190473b01e57SJeff Chen 		user_scan_cfg->chan_list[i].chan_number = chan->hw_value;
190573b01e57SJeff Chen 		user_scan_cfg->chan_list[i].radio_type = chan->band;
190673b01e57SJeff Chen 
190773b01e57SJeff Chen 		if ((chan->flags & IEEE80211_CHAN_NO_IR) || !request->n_ssids)
190873b01e57SJeff Chen 			user_scan_cfg->chan_list[i].scan_type =
190973b01e57SJeff Chen 						NXPWIFI_SCAN_TYPE_PASSIVE;
191073b01e57SJeff Chen 		else
191173b01e57SJeff Chen 			user_scan_cfg->chan_list[i].scan_type =
191273b01e57SJeff Chen 						NXPWIFI_SCAN_TYPE_ACTIVE;
191373b01e57SJeff Chen 
191473b01e57SJeff Chen 		user_scan_cfg->chan_list[i].scan_time = 0;
191573b01e57SJeff Chen 	}
191673b01e57SJeff Chen 
191773b01e57SJeff Chen 	if (priv->adapter->scan_chan_gap_enabled &&
191873b01e57SJeff Chen 	    nxpwifi_is_any_intf_active(priv))
191973b01e57SJeff Chen 		user_scan_cfg->scan_chan_gap =
192073b01e57SJeff Chen 					      priv->adapter->scan_chan_gap_time;
192173b01e57SJeff Chen 
192273b01e57SJeff Chen 	ret = nxpwifi_scan_networks(priv, user_scan_cfg);
192373b01e57SJeff Chen 	kfree(user_scan_cfg);
192473b01e57SJeff Chen 	if (ret) {
192573b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
192673b01e57SJeff Chen 			    "scan failed: %d\n", ret);
192773b01e57SJeff Chen 		priv->scan_aborting = false;
192873b01e57SJeff Chen 		priv->scan_request = NULL;
192973b01e57SJeff Chen 		return ret;
193073b01e57SJeff Chen 	}
193173b01e57SJeff Chen 
193273b01e57SJeff Chen 	if (request->ie && request->ie_len) {
193373b01e57SJeff Chen 		for (i = 0; i < NXPWIFI_MAX_VSIE_NUM; i++) {
193473b01e57SJeff Chen 			if (priv->vs_ie[i].mask == NXPWIFI_VSIE_MASK_SCAN) {
193573b01e57SJeff Chen 				priv->vs_ie[i].mask = NXPWIFI_VSIE_MASK_CLEAR;
193673b01e57SJeff Chen 				memset(&priv->vs_ie[i].ie, 0,
193773b01e57SJeff Chen 				       NXPWIFI_MAX_VSIE_LEN);
193873b01e57SJeff Chen 			}
193973b01e57SJeff Chen 		}
194073b01e57SJeff Chen 	}
194173b01e57SJeff Chen 	return 0;
194273b01e57SJeff Chen }
194373b01e57SJeff Chen 
194473b01e57SJeff Chen /*
194573b01e57SJeff Chen  * cfg80211 sched_scan_start handler.
194673b01e57SJeff Chen  *
194773b01e57SJeff Chen  * Send a bgscan configuration request to the firmware based on the
194873b01e57SJeff Chen  * scheduled scan parameters. On success, the firmware later issues a
194973b01e57SJeff Chen  * BGSCAN_REPORT event, after which the driver should query the firmware
195073b01e57SJeff Chen  * for scan results.
195173b01e57SJeff Chen  */
195273b01e57SJeff Chen static int
nxpwifi_cfg80211_sched_scan_start(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_sched_scan_request * request)195373b01e57SJeff Chen nxpwifi_cfg80211_sched_scan_start(struct wiphy *wiphy,
195473b01e57SJeff Chen 				  struct net_device *dev,
195573b01e57SJeff Chen 				  struct cfg80211_sched_scan_request *request)
195673b01e57SJeff Chen {
195773b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
195873b01e57SJeff Chen 	int i, offset;
195973b01e57SJeff Chen 	struct ieee80211_channel *chan;
196073b01e57SJeff Chen 	struct nxpwifi_bg_scan_cfg *bgscan_cfg;
196173b01e57SJeff Chen 	struct element *ie;
196273b01e57SJeff Chen 	int ret;
196373b01e57SJeff Chen 
196473b01e57SJeff Chen 	if (!request || (!request->n_ssids && !request->n_match_sets)) {
196573b01e57SJeff Chen 		wiphy_err(wiphy, "%s : Invalid Sched_scan parameters",
196673b01e57SJeff Chen 			  __func__);
196773b01e57SJeff Chen 		return -EINVAL;
196873b01e57SJeff Chen 	}
196973b01e57SJeff Chen 
197073b01e57SJeff Chen 	wiphy_info(wiphy, "sched_scan start : n_ssids=%d n_match_sets=%d ",
197173b01e57SJeff Chen 		   request->n_ssids, request->n_match_sets);
197273b01e57SJeff Chen 	wiphy_info(wiphy, "n_channels=%d interval=%d ie_len=%d\n",
197373b01e57SJeff Chen 		   request->n_channels, request->scan_plans->interval,
197473b01e57SJeff Chen 		   (int)request->ie_len);
197573b01e57SJeff Chen 
197673b01e57SJeff Chen 	bgscan_cfg = kzalloc_obj(*bgscan_cfg, GFP_KERNEL);
197773b01e57SJeff Chen 	if (!bgscan_cfg)
197873b01e57SJeff Chen 		return -ENOMEM;
197973b01e57SJeff Chen 
198073b01e57SJeff Chen 	if (priv->scan_request || priv->scan_aborting)
198173b01e57SJeff Chen 		bgscan_cfg->start_later = true;
198273b01e57SJeff Chen 
198373b01e57SJeff Chen 	bgscan_cfg->num_ssids = request->n_match_sets;
198473b01e57SJeff Chen 	bgscan_cfg->ssid_list = request->match_sets;
198573b01e57SJeff Chen 
198673b01e57SJeff Chen 	if (request->ie && request->ie_len) {
198773b01e57SJeff Chen 		offset = 0;
198873b01e57SJeff Chen 		for (i = 0; i < NXPWIFI_MAX_VSIE_NUM; i++) {
198973b01e57SJeff Chen 			if (priv->vs_ie[i].mask != NXPWIFI_VSIE_MASK_CLEAR)
199073b01e57SJeff Chen 				continue;
199173b01e57SJeff Chen 			priv->vs_ie[i].mask = NXPWIFI_VSIE_MASK_BGSCAN;
199273b01e57SJeff Chen 			ie = (struct element *)(request->ie + offset);
199373b01e57SJeff Chen 			memcpy(&priv->vs_ie[i].ie, ie,
199473b01e57SJeff Chen 			       sizeof(*ie) + ie->datalen);
199573b01e57SJeff Chen 			offset += sizeof(*ie) + ie->datalen;
199673b01e57SJeff Chen 
199773b01e57SJeff Chen 			if (offset >= request->ie_len)
199873b01e57SJeff Chen 				break;
199973b01e57SJeff Chen 		}
200073b01e57SJeff Chen 	}
200173b01e57SJeff Chen 
200273b01e57SJeff Chen 	for (i = 0; i < min_t(u32, request->n_channels,
200373b01e57SJeff Chen 			      NXPWIFI_BG_SCAN_CHAN_MAX); i++) {
200473b01e57SJeff Chen 		chan = request->channels[i];
200573b01e57SJeff Chen 		bgscan_cfg->chan_list[i].chan_number = chan->hw_value;
200673b01e57SJeff Chen 		bgscan_cfg->chan_list[i].radio_type = chan->band;
200773b01e57SJeff Chen 
200873b01e57SJeff Chen 		if ((chan->flags & IEEE80211_CHAN_NO_IR) || !request->n_ssids)
200973b01e57SJeff Chen 			bgscan_cfg->chan_list[i].scan_type =
201073b01e57SJeff Chen 						NXPWIFI_SCAN_TYPE_PASSIVE;
201173b01e57SJeff Chen 		else
201273b01e57SJeff Chen 			bgscan_cfg->chan_list[i].scan_type =
201373b01e57SJeff Chen 						NXPWIFI_SCAN_TYPE_ACTIVE;
201473b01e57SJeff Chen 
201573b01e57SJeff Chen 		bgscan_cfg->chan_list[i].scan_time = 0;
201673b01e57SJeff Chen 	}
201773b01e57SJeff Chen 
201873b01e57SJeff Chen 	bgscan_cfg->chan_per_scan = min_t(u32, request->n_channels,
201973b01e57SJeff Chen 					  NXPWIFI_BG_SCAN_CHAN_MAX);
202073b01e57SJeff Chen 
202173b01e57SJeff Chen 	/* Minimum scan cycle duration: 15 seconds */
202273b01e57SJeff Chen 	bgscan_cfg->scan_interval = (request->scan_plans->interval >
202373b01e57SJeff Chen 				     NXPWIFI_BGSCAN_INTERVAL) ?
202473b01e57SJeff Chen 				request->scan_plans->interval :
202573b01e57SJeff Chen 				NXPWIFI_BGSCAN_INTERVAL;
202673b01e57SJeff Chen 
202773b01e57SJeff Chen 	bgscan_cfg->repeat_count = NXPWIFI_BGSCAN_REPEAT_COUNT;
202873b01e57SJeff Chen 	bgscan_cfg->report_condition = NXPWIFI_BGSCAN_SSID_MATCH |
202973b01e57SJeff Chen 				NXPWIFI_BGSCAN_WAIT_ALL_CHAN_DONE;
203073b01e57SJeff Chen 	bgscan_cfg->bss_type = NXPWIFI_BSS_MODE_INFRA;
203173b01e57SJeff Chen 	bgscan_cfg->action = NXPWIFI_BGSCAN_ACT_SET;
203273b01e57SJeff Chen 	bgscan_cfg->enable = true;
203373b01e57SJeff Chen 	if (request->min_rssi_thold != NL80211_SCAN_RSSI_THOLD_OFF) {
203473b01e57SJeff Chen 		bgscan_cfg->report_condition |= NXPWIFI_BGSCAN_SSID_RSSI_MATCH;
203573b01e57SJeff Chen 		bgscan_cfg->rssi_threshold = request->min_rssi_thold;
203673b01e57SJeff Chen 	}
203773b01e57SJeff Chen 
203873b01e57SJeff Chen 	ret = nxpwifi_bg_scan_config(priv, bgscan_cfg);
203973b01e57SJeff Chen 
204073b01e57SJeff Chen 	if (!ret)
204173b01e57SJeff Chen 		priv->sched_scanning = true;
204273b01e57SJeff Chen 
204373b01e57SJeff Chen 	kfree(bgscan_cfg);
204473b01e57SJeff Chen 	return ret;
204573b01e57SJeff Chen }
204673b01e57SJeff Chen 
204773b01e57SJeff Chen /*
204873b01e57SJeff Chen  * cfg80211 sched_scan_stop handler.
204973b01e57SJeff Chen  *
205073b01e57SJeff Chen  * Send a bgscan configuration command to disable the previous
205173b01e57SJeff Chen  * background scan settings in the firmware.
205273b01e57SJeff Chen  */
nxpwifi_cfg80211_sched_scan_stop(struct wiphy * wiphy,struct net_device * dev,u64 reqid)205373b01e57SJeff Chen static int nxpwifi_cfg80211_sched_scan_stop(struct wiphy *wiphy,
205473b01e57SJeff Chen 					    struct net_device *dev, u64 reqid)
205573b01e57SJeff Chen {
205673b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
205773b01e57SJeff Chen 
205873b01e57SJeff Chen 	wiphy_info(wiphy, "sched scan stop!");
205973b01e57SJeff Chen 	return nxpwifi_stop_bg_scan(priv);
206073b01e57SJeff Chen }
206173b01e57SJeff Chen 
206273b01e57SJeff Chen /*
206373b01e57SJeff Chen  * Set default cfg80211 HT capabilities.
206473b01e57SJeff Chen  */
206573b01e57SJeff Chen static void
nxpwifi_setup_ht_caps(struct nxpwifi_private * priv,struct ieee80211_sta_ht_cap * ht_info)206673b01e57SJeff Chen nxpwifi_setup_ht_caps(struct nxpwifi_private *priv,
206773b01e57SJeff Chen 		      struct ieee80211_sta_ht_cap *ht_info)
206873b01e57SJeff Chen {
206973b01e57SJeff Chen 	int rx_mcs_supp;
207073b01e57SJeff Chen 	struct ieee80211_mcs_info mcs_set;
207173b01e57SJeff Chen 	u8 *mcs = (u8 *)&mcs_set;
207273b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
207373b01e57SJeff Chen 
207473b01e57SJeff Chen 	ht_info->ht_supported = true;
207573b01e57SJeff Chen 	ht_info->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
207673b01e57SJeff Chen 	ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_NONE;
207773b01e57SJeff Chen 
207873b01e57SJeff Chen 	memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
207973b01e57SJeff Chen 
208073b01e57SJeff Chen 	/* Fill HT capability information */
208173b01e57SJeff Chen 	if (ISSUPP_CHANWIDTH40(adapter->hw_dot_11n_dev_cap))
208273b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
208373b01e57SJeff Chen 	else
208473b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
208573b01e57SJeff Chen 
208673b01e57SJeff Chen 	if (ISSUPP_SHORTGI20(adapter->hw_dot_11n_dev_cap))
208773b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_SGI_20;
208873b01e57SJeff Chen 	else
208973b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_SGI_20;
209073b01e57SJeff Chen 
209173b01e57SJeff Chen 	if (ISSUPP_SHORTGI40(adapter->hw_dot_11n_dev_cap))
209273b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_SGI_40;
209373b01e57SJeff Chen 	else
209473b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_SGI_40;
209573b01e57SJeff Chen 
209673b01e57SJeff Chen 	if (adapter->user_dev_mcs_support == HT_STREAM_2X2)
209773b01e57SJeff Chen 		ht_info->cap |= 2 << IEEE80211_HT_CAP_RX_STBC_SHIFT;
209873b01e57SJeff Chen 	else
209973b01e57SJeff Chen 		ht_info->cap |= 1 << IEEE80211_HT_CAP_RX_STBC_SHIFT;
210073b01e57SJeff Chen 
210173b01e57SJeff Chen 	if (ISSUPP_TXSTBC(adapter->hw_dot_11n_dev_cap))
210273b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_TX_STBC;
210373b01e57SJeff Chen 	else
210473b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_TX_STBC;
210573b01e57SJeff Chen 
210673b01e57SJeff Chen 	if (ISSUPP_GREENFIELD(adapter->hw_dot_11n_dev_cap))
210773b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_GRN_FLD;
210873b01e57SJeff Chen 	else
210973b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_GRN_FLD;
211073b01e57SJeff Chen 
211173b01e57SJeff Chen 	if (ISENABLED_40MHZ_INTOLERANT(adapter->hw_dot_11n_dev_cap))
211273b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_40MHZ_INTOLERANT;
211373b01e57SJeff Chen 	else
211473b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_40MHZ_INTOLERANT;
211573b01e57SJeff Chen 
211673b01e57SJeff Chen 	if (ISSUPP_RXLDPC(adapter->hw_dot_11n_dev_cap))
211773b01e57SJeff Chen 		ht_info->cap |= IEEE80211_HT_CAP_LDPC_CODING;
211873b01e57SJeff Chen 	else
211973b01e57SJeff Chen 		ht_info->cap &= ~IEEE80211_HT_CAP_LDPC_CODING;
212073b01e57SJeff Chen 
212173b01e57SJeff Chen 	ht_info->cap &= ~IEEE80211_HT_CAP_MAX_AMSDU;
212273b01e57SJeff Chen 	ht_info->cap |= IEEE80211_HT_CAP_SM_PS;
212373b01e57SJeff Chen 
212473b01e57SJeff Chen 	rx_mcs_supp = GET_RXMCSSUPP(adapter->user_dev_mcs_support);
212573b01e57SJeff Chen 	/* Set MCS for 1x1/2x2 */
212673b01e57SJeff Chen 	memset(mcs, 0xff, rx_mcs_supp);
212773b01e57SJeff Chen 	/* Clear all the other values */
212873b01e57SJeff Chen 	memset(&mcs[rx_mcs_supp], 0,
212973b01e57SJeff Chen 	       sizeof(struct ieee80211_mcs_info) - rx_mcs_supp);
213073b01e57SJeff Chen 	if (priv->bss_mode == NL80211_IFTYPE_STATION ||
213173b01e57SJeff Chen 	    ISSUPP_CHANWIDTH40(adapter->hw_dot_11n_dev_cap))
213273b01e57SJeff Chen 		/* Set MCS32 for infra mode or ad-hoc mode with 40MHz support */
213373b01e57SJeff Chen 		SETHT_MCS32(mcs_set.rx_mask);
213473b01e57SJeff Chen 
213573b01e57SJeff Chen 	memcpy((u8 *)&ht_info->mcs, mcs, sizeof(struct ieee80211_mcs_info));
213673b01e57SJeff Chen 
213773b01e57SJeff Chen 	ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
213873b01e57SJeff Chen }
213973b01e57SJeff Chen 
214073b01e57SJeff Chen static void
nxpwifi_setup_vht_caps(struct nxpwifi_private * priv,struct ieee80211_sta_vht_cap * vht_info)214173b01e57SJeff Chen nxpwifi_setup_vht_caps(struct nxpwifi_private *priv,
214273b01e57SJeff Chen 		       struct ieee80211_sta_vht_cap *vht_info)
214373b01e57SJeff Chen {
214473b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
214573b01e57SJeff Chen 
214673b01e57SJeff Chen 	vht_info->vht_supported = true;
214773b01e57SJeff Chen 
214873b01e57SJeff Chen 	vht_info->cap = adapter->hw_dot_11ac_dev_cap;
214973b01e57SJeff Chen 	/* Update MCS support for VHT */
215073b01e57SJeff Chen 	vht_info->vht_mcs.rx_mcs_map =
215173b01e57SJeff Chen 		cpu_to_le16(adapter->hw_dot_11ac_mcs_support & 0xFFFF);
215273b01e57SJeff Chen 	vht_info->vht_mcs.rx_highest = 0;
215373b01e57SJeff Chen 	vht_info->vht_mcs.tx_mcs_map =
215473b01e57SJeff Chen 		cpu_to_le16(adapter->hw_dot_11ac_mcs_support >> 16);
215573b01e57SJeff Chen 	vht_info->vht_mcs.tx_highest = 0;
215673b01e57SJeff Chen }
215773b01e57SJeff Chen 
215873b01e57SJeff Chen /*
215973b01e57SJeff Chen  * 5 GHz HE capability masks for UAP mode.
216073b01e57SJeff Chen  *
216173b01e57SJeff Chen  * MAC: TWT requester/respondor, broadcast TWT, OMI control.
216273b01e57SJeff Chen  *
216373b01e57SJeff Chen  * PHY: 40/80 MHz width, puncturing, LDPC, NDP 4xLTF, STBC,
216473b01e57SJeff Chen  *      Doppler, DCM, SU BF/BFe, STS, sounding dims, extended
216573b01e57SJeff Chen  *      range, PPE present, 4xLTF 0.8us GI, Rx 1024-QAM.
216673b01e57SJeff Chen  */
216773b01e57SJeff Chen #define UAP_HE_MAC_CAP0_MASK (IEEE80211_HE_MAC_CAP0_TWT_REQ | \
216873b01e57SJeff Chen 			      IEEE80211_HE_MAC_CAP0_TWT_RES)
216973b01e57SJeff Chen 
217073b01e57SJeff Chen #define UAP_HE_MAC_CAP1_MASK 0
217173b01e57SJeff Chen #define UAP_HE_MAC_CAP2_MASK IEEE80211_HE_MAC_CAP2_BCAST_TWT
217273b01e57SJeff Chen #define UAP_HE_MAC_CAP3_MASK IEEE80211_HE_MAC_CAP3_OMI_CONTROL
217373b01e57SJeff Chen #define UAP_HE_MAC_CAP4_MASK 0
217473b01e57SJeff Chen #define UAP_HE_MAC_CAP5_MASK 0
217573b01e57SJeff Chen 
217673b01e57SJeff Chen #define UAP_HE_PHY_CAP0_MASK IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_80MHZ_IN_5G
217773b01e57SJeff Chen #define UAP_HE_PHY_CAP1_MASK (IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD | \
217873b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_80MHZ_ONLY_SECOND_20MHZ | \
217973b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_80MHZ_ONLY_SECOND_40MHZ)
218073b01e57SJeff Chen #define UAP_HE_PHY_CAP2_MASK (IEEE80211_HE_PHY_CAP2_NDP_4x_LTF_AND_3_2US | \
218173b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP2_STBC_TX_UNDER_80MHZ | \
218273b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP2_STBC_RX_UNDER_80MHZ | \
218373b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP2_DOPPLER_TX | \
218473b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP2_DOPPLER_RX)
218573b01e57SJeff Chen #define UAP_HE_PHY_CAP3_MASK (IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_BPSK | \
218673b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP3_DCM_MAX_TX_NSS_1 | \
218773b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_BPSK | \
218873b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP3_DCM_MAX_RX_NSS_1 | \
218973b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP3_SU_BEAMFORMER)
219073b01e57SJeff Chen #define UAP_HE_PHY_CAP4_MASK (IEEE80211_HE_PHY_CAP4_SU_BEAMFORMEE | \
219173b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP4_BEAMFORMEE_MAX_STS_UNDER_80MHZ_8)
219273b01e57SJeff Chen #define UAP_HE_PHY_CAP5_MASK IEEE80211_HE_PHY_CAP5_BEAMFORMEE_NUM_SND_DIM_UNDER_80MHZ_2
219373b01e57SJeff Chen #define UAP_HE_PHY_CAP6_MASK (IEEE80211_HE_PHY_CAP6_PARTIAL_BW_EXT_RANGE | \
219473b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP6_PPE_THRESHOLD_PRESENT)
219573b01e57SJeff Chen #define UAP_HE_PHY_CAP7_MASK (IEEE80211_HE_PHY_CAP7_HE_SU_MU_PPDU_4XLTF_AND_08_US_GI | \
219673b01e57SJeff Chen 			      IEEE80211_HE_PHY_CAP7_MAX_NC_1)
219773b01e57SJeff Chen #define UAP_HE_PHY_CAP8_MASK 0
219873b01e57SJeff Chen #define UAP_HE_PHY_CAP9_MASK IEEE80211_HE_PHY_CAP9_RX_1024_QAM_LESS_THAN_242_TONE_RU
219973b01e57SJeff Chen #define UAP_HE_PHY_CAP10_MASK 0
220073b01e57SJeff Chen 
220173b01e57SJeff Chen /*
220273b01e57SJeff Chen  * 2.4 GHz HE capability masks for UAP mode.
220373b01e57SJeff Chen  *
220473b01e57SJeff Chen  * MAC: HTC HE, OMI control (no UL OFDMA).
220573b01e57SJeff Chen  * PHY: 40 MHz, LDPC, NDP 4xLTF, STBC, Doppler, DCM,
220673b01e57SJeff Chen  *      SU BF/BFe, STS/sounding dims, extended range,
220773b01e57SJeff Chen  *      PPE present, 4xLTF 0.8us GI, Rx 1024-QAM.
220873b01e57SJeff Chen  */
220973b01e57SJeff Chen #define UAP_HE_2G_MAC_CAP0_MASK 0x00
221073b01e57SJeff Chen #define UAP_HE_2G_MAC_CAP1_MASK 0x00
221173b01e57SJeff Chen #define UAP_HE_2G_MAC_CAP2_MASK 0x00
221273b01e57SJeff Chen #define UAP_HE_2G_MAC_CAP3_MASK IEEE80211_HE_MAC_CAP3_OMI_CONTROL
221373b01e57SJeff Chen #define UAP_HE_2G_MAC_CAP4_MASK 0x00
221473b01e57SJeff Chen #define UAP_HE_2G_MAC_CAP5_MASK 0x00
221573b01e57SJeff Chen 
221673b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP0_MASK IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_IN_2G
221773b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP1_MASK IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD
221873b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP2_MASK (IEEE80211_HE_PHY_CAP2_NDP_4x_LTF_AND_3_2US | \
221973b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP2_STBC_TX_UNDER_80MHZ | \
222073b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP2_STBC_RX_UNDER_80MHZ | \
222173b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP2_DOPPLER_TX | \
222273b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP2_DOPPLER_RX)
222373b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP3_MASK (IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_BPSK | \
222473b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP3_DCM_MAX_TX_NSS_1 | \
222573b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_BPSK | \
222673b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP3_DCM_MAX_RX_NSS_1 | \
222773b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP3_SU_BEAMFORMER)
222873b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP4_MASK (IEEE80211_HE_PHY_CAP4_SU_BEAMFORMEE | \
222973b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP4_BEAMFORMEE_MAX_STS_UNDER_80MHZ_8)
223073b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP5_MASK IEEE80211_HE_PHY_CAP5_BEAMFORMEE_NUM_SND_DIM_UNDER_80MHZ_2
223173b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP6_MASK (IEEE80211_HE_PHY_CAP6_PARTIAL_BW_EXT_RANGE | \
223273b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP6_PPE_THRESHOLD_PRESENT)
223373b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP7_MASK (IEEE80211_HE_PHY_CAP7_HE_SU_MU_PPDU_4XLTF_AND_08_US_GI | \
223473b01e57SJeff Chen 				 IEEE80211_HE_PHY_CAP7_MAX_NC_1)
223573b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP8_MASK 0x00
223673b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP9_MASK IEEE80211_HE_PHY_CAP9_RX_1024_QAM_LESS_THAN_242_TONE_RU
223773b01e57SJeff Chen #define UAP_HE_2G_PHY_CAP10_MASK 0x00
223873b01e57SJeff Chen #define HE_CAP_FIX_SIZE 22
223973b01e57SJeff Chen 
224073b01e57SJeff Chen static void
nxpwifi_update_11ax_ie(u8 band,struct nxpwifi_11ax_he_cap_cfg * he_cap_cfg)224173b01e57SJeff Chen nxpwifi_update_11ax_ie(u8 band,
224273b01e57SJeff Chen 		       struct nxpwifi_11ax_he_cap_cfg *he_cap_cfg)
224373b01e57SJeff Chen {
224473b01e57SJeff Chen 	if (band == BAND_A) {
224573b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[0] &= UAP_HE_MAC_CAP0_MASK;
224673b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[1] &= UAP_HE_MAC_CAP1_MASK;
224773b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[2] &= UAP_HE_MAC_CAP2_MASK;
224873b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[3] &= UAP_HE_MAC_CAP3_MASK;
224973b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[4] &= UAP_HE_MAC_CAP4_MASK;
225073b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[5] &= UAP_HE_MAC_CAP5_MASK;
225173b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[0] &= UAP_HE_PHY_CAP0_MASK;
225273b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[1] &= UAP_HE_PHY_CAP1_MASK;
225373b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[2] &= UAP_HE_PHY_CAP2_MASK;
225473b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[3] &= UAP_HE_PHY_CAP3_MASK;
225573b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[4] &= UAP_HE_PHY_CAP4_MASK;
225673b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[5] &= UAP_HE_PHY_CAP5_MASK;
225773b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[6] &= UAP_HE_PHY_CAP6_MASK;
225873b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[7] &= UAP_HE_PHY_CAP7_MASK;
225973b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[8] &= UAP_HE_PHY_CAP8_MASK;
226073b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[9] &= UAP_HE_PHY_CAP9_MASK;
226173b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[10] &= UAP_HE_PHY_CAP10_MASK;
226273b01e57SJeff Chen 	} else {
226373b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[0] &= UAP_HE_2G_MAC_CAP0_MASK;
226473b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[1] &= UAP_HE_2G_MAC_CAP1_MASK;
226573b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[2] &= UAP_HE_2G_MAC_CAP2_MASK;
226673b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[3] &= UAP_HE_2G_MAC_CAP3_MASK;
226773b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[4] &= UAP_HE_2G_MAC_CAP4_MASK;
226873b01e57SJeff Chen 		he_cap_cfg->cap_elem.mac_cap_info[5] &= UAP_HE_2G_MAC_CAP5_MASK;
226973b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[0] &= UAP_HE_2G_PHY_CAP0_MASK;
227073b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[1] &= UAP_HE_2G_PHY_CAP1_MASK;
227173b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[2] &= UAP_HE_2G_PHY_CAP2_MASK;
227273b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[3] &= UAP_HE_2G_PHY_CAP3_MASK;
227373b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[4] &= UAP_HE_2G_PHY_CAP4_MASK;
227473b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[5] &= UAP_HE_2G_PHY_CAP5_MASK;
227573b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[6] &= UAP_HE_2G_PHY_CAP6_MASK;
227673b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[7] &= UAP_HE_2G_PHY_CAP7_MASK;
227773b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[8] &= UAP_HE_2G_PHY_CAP8_MASK;
227873b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[9] &= UAP_HE_2G_PHY_CAP9_MASK;
227973b01e57SJeff Chen 		he_cap_cfg->cap_elem.phy_cap_info[10] &= UAP_HE_2G_PHY_CAP10_MASK;
228073b01e57SJeff Chen 	}
228173b01e57SJeff Chen }
228273b01e57SJeff Chen 
228373b01e57SJeff Chen static void
nxpwifi_setup_he_caps(struct nxpwifi_private * priv,struct ieee80211_supported_band * band)228473b01e57SJeff Chen nxpwifi_setup_he_caps(struct nxpwifi_private *priv,
228573b01e57SJeff Chen 		      struct ieee80211_supported_band *band)
228673b01e57SJeff Chen {
228773b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
228873b01e57SJeff Chen 	struct ieee80211_sband_iftype_data *iftype_data;
228973b01e57SJeff Chen 	struct nxpwifi_11ax_he_cap_cfg he_cap_cfg;
229073b01e57SJeff Chen 	u8 hw_he_cap_len;
229173b01e57SJeff Chen 	u8 extra_mcs_size;
229273b01e57SJeff Chen 	int ppe_threshold_len;
229373b01e57SJeff Chen 
229473b01e57SJeff Chen 	if (band->band == NL80211_BAND_5GHZ) {
229573b01e57SJeff Chen 		hw_he_cap_len = adapter->hw_he_cap_len;
229673b01e57SJeff Chen 		memcpy(&he_cap_cfg, adapter->hw_he_cap, hw_he_cap_len);
229773b01e57SJeff Chen 		nxpwifi_update_11ax_ie(BAND_A, &he_cap_cfg);
229873b01e57SJeff Chen 	} else {
229973b01e57SJeff Chen 		hw_he_cap_len = adapter->hw_2g_he_cap_len;
230073b01e57SJeff Chen 		memcpy(&he_cap_cfg, adapter->hw_2g_he_cap, hw_he_cap_len);
230173b01e57SJeff Chen 		nxpwifi_update_11ax_ie(BAND_G, &he_cap_cfg);
230273b01e57SJeff Chen 	}
230373b01e57SJeff Chen 
230473b01e57SJeff Chen 	if (!hw_he_cap_len)
230573b01e57SJeff Chen 		return;
230673b01e57SJeff Chen 
230773b01e57SJeff Chen 	iftype_data = kmalloc_obj(*iftype_data, GFP_KERNEL);
230873b01e57SJeff Chen 	if (!iftype_data)
230973b01e57SJeff Chen 		return;
231073b01e57SJeff Chen 	memset(iftype_data, 0, sizeof(*iftype_data));
231173b01e57SJeff Chen 
231273b01e57SJeff Chen 	iftype_data->types_mask =
231373b01e57SJeff Chen 		BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_AP);
231473b01e57SJeff Chen 	iftype_data->he_cap.has_he = true;
231573b01e57SJeff Chen 
231673b01e57SJeff Chen 	memcpy(iftype_data->he_cap.he_cap_elem.mac_cap_info,
231773b01e57SJeff Chen 	       he_cap_cfg.cap_elem.mac_cap_info,
231873b01e57SJeff Chen 	       sizeof(he_cap_cfg.cap_elem.mac_cap_info));
231973b01e57SJeff Chen 	memcpy(iftype_data->he_cap.he_cap_elem.phy_cap_info,
232073b01e57SJeff Chen 	       he_cap_cfg.cap_elem.phy_cap_info,
232173b01e57SJeff Chen 	       sizeof(he_cap_cfg.cap_elem.phy_cap_info));
232273b01e57SJeff Chen 	memset(&iftype_data->he_cap.he_mcs_nss_supp,
232373b01e57SJeff Chen 	       0xff,
232473b01e57SJeff Chen 	       sizeof(iftype_data->he_cap.he_mcs_nss_supp));
232573b01e57SJeff Chen 	memcpy(&iftype_data->he_cap.he_mcs_nss_supp,
232673b01e57SJeff Chen 	       he_cap_cfg.he_txrx_mcs_support,
232773b01e57SJeff Chen 	       sizeof(he_cap_cfg.he_txrx_mcs_support));
232873b01e57SJeff Chen 
232973b01e57SJeff Chen 	extra_mcs_size = 0;
233073b01e57SJeff Chen 	/* Add 160 MHz MCS/NSS if supported */
233173b01e57SJeff Chen 	if (he_cap_cfg.cap_elem.phy_cap_info[0] & BIT(3))
233273b01e57SJeff Chen 		extra_mcs_size += 4;
233373b01e57SJeff Chen 	/* Add 80+80 MHz MCS/NSS if supported */
233473b01e57SJeff Chen 	if (he_cap_cfg.cap_elem.phy_cap_info[0] & BIT(4))
233573b01e57SJeff Chen 		extra_mcs_size += 4;
233673b01e57SJeff Chen 	if (extra_mcs_size)
233773b01e57SJeff Chen 		memcpy((u8 *)&iftype_data->he_cap.he_mcs_nss_supp.rx_mcs_160,
233873b01e57SJeff Chen 		       he_cap_cfg.val, extra_mcs_size);
233973b01e57SJeff Chen 
234073b01e57SJeff Chen 	/* Parse PPE thresholds when present */
234173b01e57SJeff Chen 	ppe_threshold_len = he_cap_cfg.len - HE_CAP_FIX_SIZE - extra_mcs_size;
234273b01e57SJeff Chen 	if (he_cap_cfg.cap_elem.phy_cap_info[6] & BIT(7) && ppe_threshold_len) {
234373b01e57SJeff Chen 		memcpy(iftype_data->he_cap.ppe_thres,
234473b01e57SJeff Chen 		       &he_cap_cfg.val[extra_mcs_size],
234573b01e57SJeff Chen 		       ppe_threshold_len);
234673b01e57SJeff Chen 	} else {
234773b01e57SJeff Chen 		iftype_data->he_cap.he_cap_elem.phy_cap_info[6] &= BIT(7);
234873b01e57SJeff Chen 	}
234973b01e57SJeff Chen 
235073b01e57SJeff Chen 	_ieee80211_set_sband_iftype_data(band, iftype_data, 1);
235173b01e57SJeff Chen }
235273b01e57SJeff Chen 
235373b01e57SJeff Chen /* create a new virtual interface with the given name and name assign type */
nxpwifi_add_virtual_intf(struct wiphy * wiphy,const char * name,unsigned char name_assign_type,enum nl80211_iftype type,struct vif_params * params)235473b01e57SJeff Chen struct wireless_dev *nxpwifi_add_virtual_intf(struct wiphy *wiphy,
235573b01e57SJeff Chen 					      const char *name,
235673b01e57SJeff Chen 					      unsigned char name_assign_type,
235773b01e57SJeff Chen 					      enum nl80211_iftype type,
235873b01e57SJeff Chen 					      struct vif_params *params)
235973b01e57SJeff Chen {
236073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
236173b01e57SJeff Chen 	struct nxpwifi_private *priv;
236273b01e57SJeff Chen 	struct net_device *dev;
236373b01e57SJeff Chen 	void *mdev_priv;
236473b01e57SJeff Chen 	int ret;
236573b01e57SJeff Chen 
236673b01e57SJeff Chen 	if (!adapter)
236773b01e57SJeff Chen 		return ERR_PTR(-EFAULT);
236873b01e57SJeff Chen 
236973b01e57SJeff Chen 	switch (type) {
237073b01e57SJeff Chen 	case NL80211_IFTYPE_UNSPECIFIED:
237173b01e57SJeff Chen 	case NL80211_IFTYPE_STATION:
237273b01e57SJeff Chen 		if (adapter->curr_iface_comb.sta_intf ==
237373b01e57SJeff Chen 		    adapter->iface_limit.sta_intf) {
237473b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
237573b01e57SJeff Chen 				    "cannot create multiple sta ifaces\n");
237673b01e57SJeff Chen 			return ERR_PTR(-EINVAL);
237773b01e57SJeff Chen 		}
237873b01e57SJeff Chen 
237973b01e57SJeff Chen 		priv = nxpwifi_get_unused_priv_by_bss_type
238073b01e57SJeff Chen 		       (adapter, NXPWIFI_BSS_TYPE_STA);
238173b01e57SJeff Chen 		if (!priv) {
238273b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
238373b01e57SJeff Chen 				    "could not get free private struct\n");
238473b01e57SJeff Chen 			return ERR_PTR(-EFAULT);
238573b01e57SJeff Chen 		}
238673b01e57SJeff Chen 
238773b01e57SJeff Chen 		priv->wdev.wiphy = wiphy;
238873b01e57SJeff Chen 		priv->wdev.iftype = NL80211_IFTYPE_STATION;
238973b01e57SJeff Chen 
239073b01e57SJeff Chen 		if (type == NL80211_IFTYPE_UNSPECIFIED)
239173b01e57SJeff Chen 			priv->bss_mode = NL80211_IFTYPE_STATION;
239273b01e57SJeff Chen 		else
239373b01e57SJeff Chen 			priv->bss_mode = type;
239473b01e57SJeff Chen 
239573b01e57SJeff Chen 		priv->bss_type = NXPWIFI_BSS_TYPE_STA;
239673b01e57SJeff Chen 		priv->frame_type = NXPWIFI_DATA_FRAME_TYPE_ETH_II;
239773b01e57SJeff Chen 		priv->bss_priority = 0;
239873b01e57SJeff Chen 		priv->bss_role = NXPWIFI_BSS_ROLE_STA;
239973b01e57SJeff Chen 
240073b01e57SJeff Chen 		break;
240173b01e57SJeff Chen 	case NL80211_IFTYPE_AP:
240273b01e57SJeff Chen 		if (adapter->curr_iface_comb.uap_intf ==
240373b01e57SJeff Chen 		    adapter->iface_limit.uap_intf) {
240473b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
240573b01e57SJeff Chen 				    "cannot create multiple AP ifaces\n");
240673b01e57SJeff Chen 			return ERR_PTR(-EINVAL);
240773b01e57SJeff Chen 		}
240873b01e57SJeff Chen 
240973b01e57SJeff Chen 		priv = nxpwifi_get_unused_priv_by_bss_type
241073b01e57SJeff Chen 		       (adapter, NXPWIFI_BSS_TYPE_UAP);
241173b01e57SJeff Chen 		if (!priv) {
241273b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
241373b01e57SJeff Chen 				    "could not get free private struct\n");
241473b01e57SJeff Chen 			return ERR_PTR(-EFAULT);
241573b01e57SJeff Chen 		}
241673b01e57SJeff Chen 
241773b01e57SJeff Chen 		priv->wdev.wiphy = wiphy;
241873b01e57SJeff Chen 		priv->wdev.iftype = NL80211_IFTYPE_AP;
241973b01e57SJeff Chen 
242073b01e57SJeff Chen 		priv->bss_type = NXPWIFI_BSS_TYPE_UAP;
242173b01e57SJeff Chen 		priv->frame_type = NXPWIFI_DATA_FRAME_TYPE_ETH_II;
242273b01e57SJeff Chen 		priv->bss_priority = 0;
242373b01e57SJeff Chen 		priv->bss_role = NXPWIFI_BSS_ROLE_UAP;
242473b01e57SJeff Chen 		priv->bss_started = 0;
242573b01e57SJeff Chen 		priv->bss_mode = type;
242673b01e57SJeff Chen 
242773b01e57SJeff Chen 		break;
242873b01e57SJeff Chen 	case NL80211_IFTYPE_MONITOR:
242973b01e57SJeff Chen 		priv = nxpwifi_get_unused_priv_by_bss_type
243073b01e57SJeff Chen 			(adapter, NXPWIFI_BSS_TYPE_UAP);
243173b01e57SJeff Chen 		if (!priv) {
243273b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
243373b01e57SJeff Chen 				    "could not get free private struct\n");
243473b01e57SJeff Chen 			return ERR_PTR(-EFAULT);
243573b01e57SJeff Chen 		}
243673b01e57SJeff Chen 		priv->wdev.wiphy = wiphy;
243773b01e57SJeff Chen 		priv->wdev.iftype = NL80211_IFTYPE_MONITOR;
243873b01e57SJeff Chen 
243973b01e57SJeff Chen 		priv->bss_type = NXPWIFI_BSS_TYPE_UAP;
244073b01e57SJeff Chen 		priv->frame_type = NXPWIFI_DATA_FRAME_TYPE_ETH_II;
244173b01e57SJeff Chen 		priv->bss_priority = 0;
244273b01e57SJeff Chen 		priv->bss_started = 0;
244373b01e57SJeff Chen 		priv->bss_mode = type;
244473b01e57SJeff Chen 
244573b01e57SJeff Chen 		break;
244673b01e57SJeff Chen 	default:
244773b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "type not supported\n");
244873b01e57SJeff Chen 		return ERR_PTR(-EINVAL);
244973b01e57SJeff Chen 	}
245073b01e57SJeff Chen 
245173b01e57SJeff Chen 	dev = alloc_netdev_mqs(sizeof(struct nxpwifi_private *), name,
245273b01e57SJeff Chen 			       name_assign_type, ether_setup,
245373b01e57SJeff Chen 			       IEEE80211_NUM_ACS, 1);
245473b01e57SJeff Chen 	if (!dev) {
245573b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
245673b01e57SJeff Chen 			    "no memory available for netdevice\n");
245773b01e57SJeff Chen 		ret = -ENOMEM;
245873b01e57SJeff Chen 		goto err_alloc_netdev;
245973b01e57SJeff Chen 	}
246073b01e57SJeff Chen 
246173b01e57SJeff Chen 	nxpwifi_init_priv_params(priv, dev);
246273b01e57SJeff Chen 
246373b01e57SJeff Chen 	priv->netdev = dev;
246473b01e57SJeff Chen 
246573b01e57SJeff Chen 	nxpwifi_set_mac_address(priv, dev, false, NULL);
246673b01e57SJeff Chen 
246773b01e57SJeff Chen 	if (type != NL80211_IFTYPE_MONITOR) {
246873b01e57SJeff Chen 		ret = nxpwifi_set_bss_mode(priv);
246973b01e57SJeff Chen 
247073b01e57SJeff Chen 		if (ret) {
247173b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
247273b01e57SJeff Chen 				    "%s: err_set_bss_mode\n", __func__);
247373b01e57SJeff Chen 			goto err_set_bss_mode;
247473b01e57SJeff Chen 		}
247573b01e57SJeff Chen 	}
247673b01e57SJeff Chen 
247773b01e57SJeff Chen 	ret = nxpwifi_sta_init_cmd(priv, false, false);
247873b01e57SJeff Chen 	if (ret)
247973b01e57SJeff Chen 		goto err_sta_init;
248073b01e57SJeff Chen 
248173b01e57SJeff Chen 	dev_net_set(dev, wiphy_net(wiphy));
248273b01e57SJeff Chen 	dev->ieee80211_ptr = &priv->wdev;
248373b01e57SJeff Chen 	dev->ieee80211_ptr->iftype = priv->bss_mode;
248473b01e57SJeff Chen 	SET_NETDEV_DEV(dev, wiphy_dev(wiphy));
248573b01e57SJeff Chen 
248673b01e57SJeff Chen 	dev->flags |= IFF_BROADCAST | IFF_MULTICAST;
248773b01e57SJeff Chen 	dev->watchdog_timeo = NXPWIFI_DEFAULT_WATCHDOG_TIMEOUT;
248873b01e57SJeff Chen 	dev->needed_headroom = NXPWIFI_MIN_DATA_HEADER_LEN;
248973b01e57SJeff Chen 	dev->ethtool_ops = &nxpwifi_ethtool_ops;
249073b01e57SJeff Chen 
249173b01e57SJeff Chen 	mdev_priv = netdev_priv(dev);
249273b01e57SJeff Chen 	*((unsigned long *)mdev_priv) = (unsigned long)priv;
249373b01e57SJeff Chen 
249473b01e57SJeff Chen 	if (type == NL80211_IFTYPE_MONITOR)
249573b01e57SJeff Chen 		dev->type = ARPHRD_IEEE80211_RADIOTAP;
249673b01e57SJeff Chen 
249773b01e57SJeff Chen 	SET_NETDEV_DEV(dev, adapter->dev);
249873b01e57SJeff Chen 
249973b01e57SJeff Chen 	wiphy_work_init(&priv->reset_conn_state_work, nxpwifi_reset_conn_state_work);
250073b01e57SJeff Chen 
250173b01e57SJeff Chen 	wiphy_delayed_work_init(&priv->dfs_cac_work, nxpwifi_dfs_cac_work);
250273b01e57SJeff Chen 
250373b01e57SJeff Chen 	wiphy_delayed_work_init(&priv->dfs_chan_sw_work, nxpwifi_dfs_chan_sw_work);
250473b01e57SJeff Chen 
250573b01e57SJeff Chen 	/* Register network device */
250673b01e57SJeff Chen 	if (cfg80211_register_netdevice(dev)) {
250773b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "cannot register network device\n");
250873b01e57SJeff Chen 		ret = -EFAULT;
250973b01e57SJeff Chen 		goto err_reg_netdev;
251073b01e57SJeff Chen 	}
251173b01e57SJeff Chen 
251273b01e57SJeff Chen 	nxpwifi_dbg(adapter, INFO,
251373b01e57SJeff Chen 		    "info: %s: NXP 802.11 Adapter\n", dev->name);
251473b01e57SJeff Chen 
251573b01e57SJeff Chen #ifdef CONFIG_DEBUG_FS
251673b01e57SJeff Chen 	nxpwifi_dev_debugfs_init(priv);
251773b01e57SJeff Chen #endif
251873b01e57SJeff Chen 
251973b01e57SJeff Chen 	update_vif_type_counter(adapter, type, 1);
252073b01e57SJeff Chen 
252173b01e57SJeff Chen 	return &priv->wdev;
252273b01e57SJeff Chen 
252373b01e57SJeff Chen err_reg_netdev:
252473b01e57SJeff Chen 	free_netdev(dev);
252573b01e57SJeff Chen 	priv->netdev = NULL;
252673b01e57SJeff Chen err_sta_init:
252773b01e57SJeff Chen err_set_bss_mode:
252873b01e57SJeff Chen err_alloc_netdev:
252973b01e57SJeff Chen 	memset(&priv->wdev, 0, sizeof(priv->wdev));
253073b01e57SJeff Chen 	priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
253173b01e57SJeff Chen 	priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
253273b01e57SJeff Chen 	return ERR_PTR(ret);
253373b01e57SJeff Chen }
253473b01e57SJeff Chen EXPORT_SYMBOL_GPL(nxpwifi_add_virtual_intf);
253573b01e57SJeff Chen 
253673b01e57SJeff Chen /* del_virtual_intf: remove the virtual interface determined by dev */
nxpwifi_del_virtual_intf(struct wiphy * wiphy,struct wireless_dev * wdev)253773b01e57SJeff Chen int nxpwifi_del_virtual_intf(struct wiphy *wiphy, struct wireless_dev *wdev)
253873b01e57SJeff Chen {
253973b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
254073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
254173b01e57SJeff Chen 	struct sk_buff *skb, *tmp;
254273b01e57SJeff Chen 
254373b01e57SJeff Chen #ifdef CONFIG_DEBUG_FS
254473b01e57SJeff Chen 	nxpwifi_dev_debugfs_remove(priv);
254573b01e57SJeff Chen #endif
254673b01e57SJeff Chen 	if (priv->bss_mode == NL80211_IFTYPE_MONITOR) {
254773b01e57SJeff Chen 		struct nxpwifi_802_11_net_monitor netmon_cfg;
254873b01e57SJeff Chen 
254973b01e57SJeff Chen 		memset(&netmon_cfg, 0, sizeof(struct nxpwifi_802_11_net_monitor));
255073b01e57SJeff Chen 		nxpwifi_config_monitor_mode(priv, &netmon_cfg);
255173b01e57SJeff Chen 	}
255273b01e57SJeff Chen 
255373b01e57SJeff Chen 	if (priv->sched_scanning)
255473b01e57SJeff Chen 		priv->sched_scanning = false;
255573b01e57SJeff Chen 
255673b01e57SJeff Chen 	nxpwifi_stop_net_dev_queue(priv->netdev, adapter);
255773b01e57SJeff Chen 
255873b01e57SJeff Chen 	skb_queue_walk_safe(&priv->bypass_txq, skb, tmp) {
255973b01e57SJeff Chen 		skb_unlink(skb, &priv->bypass_txq);
256073b01e57SJeff Chen 		nxpwifi_write_data_complete(priv->adapter, skb, 0, -1);
256173b01e57SJeff Chen 	}
256273b01e57SJeff Chen 
256373b01e57SJeff Chen 	netif_carrier_off(priv->netdev);
256473b01e57SJeff Chen 
256573b01e57SJeff Chen 	if (wdev->netdev->reg_state == NETREG_REGISTERED)
256673b01e57SJeff Chen 		cfg80211_unregister_netdevice(wdev->netdev);
256773b01e57SJeff Chen 
256873b01e57SJeff Chen 	/* Clear the priv in adapter */
256973b01e57SJeff Chen 	priv->netdev = NULL;
257073b01e57SJeff Chen 
257173b01e57SJeff Chen 	update_vif_type_counter(adapter, priv->bss_mode, -1);
257273b01e57SJeff Chen 
257373b01e57SJeff Chen 	priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
257473b01e57SJeff Chen 
257573b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_STA ||
257673b01e57SJeff Chen 	    GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP)
257773b01e57SJeff Chen 		kfree(priv->hist_data);
257873b01e57SJeff Chen 
257973b01e57SJeff Chen 	return 0;
258073b01e57SJeff Chen }
258173b01e57SJeff Chen EXPORT_SYMBOL_GPL(nxpwifi_del_virtual_intf);
258273b01e57SJeff Chen 
258373b01e57SJeff Chen static bool
nxpwifi_is_pattern_supported(struct cfg80211_pkt_pattern * pat,s8 * byte_seq,u8 max_byte_seq)258473b01e57SJeff Chen nxpwifi_is_pattern_supported(struct cfg80211_pkt_pattern *pat, s8 *byte_seq,
258573b01e57SJeff Chen 			     u8 max_byte_seq)
258673b01e57SJeff Chen {
258773b01e57SJeff Chen 	int j, k, valid_byte_cnt = 0;
258873b01e57SJeff Chen 	bool dont_care_byte = false;
258973b01e57SJeff Chen 
259073b01e57SJeff Chen 	for (j = 0; j < DIV_ROUND_UP(pat->pattern_len, 8); j++) {
259173b01e57SJeff Chen 		for (k = 0; k < 8; k++) {
259273b01e57SJeff Chen 			if (pat->mask[j] & 1 << k) {
259373b01e57SJeff Chen 				memcpy(byte_seq + valid_byte_cnt,
259473b01e57SJeff Chen 				       &pat->pattern[j * 8 + k], 1);
259573b01e57SJeff Chen 				valid_byte_cnt++;
259673b01e57SJeff Chen 				if (dont_care_byte)
259773b01e57SJeff Chen 					return false;
259873b01e57SJeff Chen 			} else {
259973b01e57SJeff Chen 				if (valid_byte_cnt)
260073b01e57SJeff Chen 					dont_care_byte = true;
260173b01e57SJeff Chen 			}
260273b01e57SJeff Chen 
260373b01e57SJeff Chen 			/* wildcard bytes record as the offset before the valid byte */
260473b01e57SJeff Chen 			if (!valid_byte_cnt && !dont_care_byte)
260573b01e57SJeff Chen 				pat->pkt_offset++;
260673b01e57SJeff Chen 
260773b01e57SJeff Chen 			if (valid_byte_cnt > max_byte_seq)
260873b01e57SJeff Chen 				return false;
260973b01e57SJeff Chen 		}
261073b01e57SJeff Chen 	}
261173b01e57SJeff Chen 
261273b01e57SJeff Chen 	byte_seq[max_byte_seq] = valid_byte_cnt;
261373b01e57SJeff Chen 
261473b01e57SJeff Chen 	return true;
261573b01e57SJeff Chen }
261673b01e57SJeff Chen 
261773b01e57SJeff Chen #ifdef CONFIG_PM
nxpwifi_set_auto_arp_mef_entry(struct nxpwifi_private * priv,struct nxpwifi_mef_entry * mef_entry)261873b01e57SJeff Chen static void nxpwifi_set_auto_arp_mef_entry(struct nxpwifi_private *priv,
261973b01e57SJeff Chen 					   struct nxpwifi_mef_entry *mef_entry)
262073b01e57SJeff Chen {
262173b01e57SJeff Chen 	int i, filt_num = 0, num_ipv4 = 0;
262273b01e57SJeff Chen 	struct in_device *in_dev;
262373b01e57SJeff Chen 	struct in_ifaddr *ifa;
262473b01e57SJeff Chen 	__be32 ips[NXPWIFI_MAX_SUPPORTED_IPADDR];
262573b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
262673b01e57SJeff Chen 
262773b01e57SJeff Chen 	mef_entry->mode = MEF_MODE_HOST_SLEEP;
262873b01e57SJeff Chen 	mef_entry->action = MEF_ACTION_AUTO_ARP;
262973b01e57SJeff Chen 
263073b01e57SJeff Chen 	/* Enable ARP offload feature */
263173b01e57SJeff Chen 	memset(ips, 0, sizeof(ips));
263273b01e57SJeff Chen 	for (i = 0; i < adapter->priv_num; i++) {
263373b01e57SJeff Chen 		if (adapter->priv[i]->netdev) {
263473b01e57SJeff Chen 			in_dev = __in_dev_get_rtnl(adapter->priv[i]->netdev);
263573b01e57SJeff Chen 			if (!in_dev)
263673b01e57SJeff Chen 				continue;
263773b01e57SJeff Chen 			ifa = rtnl_dereference(in_dev->ifa_list);
263873b01e57SJeff Chen 			if (!ifa || !ifa->ifa_local)
263973b01e57SJeff Chen 				continue;
264073b01e57SJeff Chen 			ips[i] = ifa->ifa_local;
264173b01e57SJeff Chen 			num_ipv4++;
264273b01e57SJeff Chen 		}
264373b01e57SJeff Chen 	}
264473b01e57SJeff Chen 
264573b01e57SJeff Chen 	for (i = 0; i < num_ipv4; i++) {
264673b01e57SJeff Chen 		if (!ips[i])
264773b01e57SJeff Chen 			continue;
264873b01e57SJeff Chen 		mef_entry->filter[filt_num].repeat = 1;
264973b01e57SJeff Chen 		memcpy(mef_entry->filter[filt_num].byte_seq,
265073b01e57SJeff Chen 		       (u8 *)&ips[i], sizeof(ips[i]));
265173b01e57SJeff Chen 		mef_entry->filter[filt_num].byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] =
265273b01e57SJeff Chen 			sizeof(ips[i]);
265373b01e57SJeff Chen 		mef_entry->filter[filt_num].offset = 46;
265473b01e57SJeff Chen 		mef_entry->filter[filt_num].filt_type = TYPE_EQ;
265573b01e57SJeff Chen 		if (filt_num) {
265673b01e57SJeff Chen 			mef_entry->filter[filt_num].filt_action =
265773b01e57SJeff Chen 				TYPE_OR;
265873b01e57SJeff Chen 		}
265973b01e57SJeff Chen 		filt_num++;
266073b01e57SJeff Chen 	}
266173b01e57SJeff Chen 
266273b01e57SJeff Chen 	mef_entry->filter[filt_num].repeat = 1;
266373b01e57SJeff Chen 	mef_entry->filter[filt_num].byte_seq[0] = 0x08;
266473b01e57SJeff Chen 	mef_entry->filter[filt_num].byte_seq[1] = 0x06;
266573b01e57SJeff Chen 	mef_entry->filter[filt_num].byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] = 2;
266673b01e57SJeff Chen 	mef_entry->filter[filt_num].offset = 20;
266773b01e57SJeff Chen 	mef_entry->filter[filt_num].filt_type = TYPE_EQ;
266873b01e57SJeff Chen 	mef_entry->filter[filt_num].filt_action = TYPE_AND;
266973b01e57SJeff Chen }
267073b01e57SJeff Chen 
nxpwifi_set_wowlan_mef_entry(struct nxpwifi_private * priv,struct nxpwifi_ds_mef_cfg * mef_cfg,struct nxpwifi_mef_entry * mef_entry,struct cfg80211_wowlan * wowlan)267173b01e57SJeff Chen static int nxpwifi_set_wowlan_mef_entry(struct nxpwifi_private *priv,
267273b01e57SJeff Chen 					struct nxpwifi_ds_mef_cfg *mef_cfg,
267373b01e57SJeff Chen 					struct nxpwifi_mef_entry *mef_entry,
267473b01e57SJeff Chen 					struct cfg80211_wowlan *wowlan)
267573b01e57SJeff Chen {
267673b01e57SJeff Chen 	int i, filt_num = 0, ret = 0;
267773b01e57SJeff Chen 	bool first_pat = true;
267873b01e57SJeff Chen 	u8 byte_seq[NXPWIFI_MEF_MAX_BYTESEQ + 1];
267973b01e57SJeff Chen 
268073b01e57SJeff Chen 	mef_entry->mode = MEF_MODE_HOST_SLEEP;
268173b01e57SJeff Chen 	mef_entry->action = MEF_ACTION_ALLOW_AND_WAKEUP_HOST;
268273b01e57SJeff Chen 
268373b01e57SJeff Chen 	for (i = 0; i < wowlan->n_patterns; i++) {
268473b01e57SJeff Chen 		memset(byte_seq, 0, sizeof(byte_seq));
268573b01e57SJeff Chen 		if (!nxpwifi_is_pattern_supported
268673b01e57SJeff Chen 		     (&wowlan->patterns[i], byte_seq,
268773b01e57SJeff Chen 		      NXPWIFI_MEF_MAX_BYTESEQ)) {
268873b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, ERROR,
268973b01e57SJeff Chen 				    "Pattern not supported\n");
269073b01e57SJeff Chen 			return -EOPNOTSUPP;
269173b01e57SJeff Chen 		}
269273b01e57SJeff Chen 
269373b01e57SJeff Chen 		if (!wowlan->patterns[i].pkt_offset) {
269473b01e57SJeff Chen 			if (is_unicast_ether_addr(byte_seq) &&
269573b01e57SJeff Chen 			    byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] == 1) {
269673b01e57SJeff Chen 				mef_cfg->criteria |= NXPWIFI_CRITERIA_UNICAST;
269773b01e57SJeff Chen 				continue;
269873b01e57SJeff Chen 			} else if (is_broadcast_ether_addr(byte_seq)) {
269973b01e57SJeff Chen 				mef_cfg->criteria |= NXPWIFI_CRITERIA_BROADCAST;
270073b01e57SJeff Chen 				continue;
270173b01e57SJeff Chen 			} else if ((!memcmp(byte_seq, "\x33\x33", 2) &&
270273b01e57SJeff Chen 				    (byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] == 2)) ||
270373b01e57SJeff Chen 				   (!memcmp(byte_seq, "\x01\x00\x5e", 3) &&
270473b01e57SJeff Chen 				    (byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] == 3))) {
270573b01e57SJeff Chen 				mef_cfg->criteria |= NXPWIFI_CRITERIA_MULTICAST;
270673b01e57SJeff Chen 				continue;
270773b01e57SJeff Chen 			}
270873b01e57SJeff Chen 		}
270973b01e57SJeff Chen 		mef_entry->filter[filt_num].repeat = 1;
271073b01e57SJeff Chen 		mef_entry->filter[filt_num].offset =
271173b01e57SJeff Chen 			wowlan->patterns[i].pkt_offset;
271273b01e57SJeff Chen 		memcpy(mef_entry->filter[filt_num].byte_seq, byte_seq,
271373b01e57SJeff Chen 		       sizeof(byte_seq));
271473b01e57SJeff Chen 		mef_entry->filter[filt_num].filt_type = TYPE_EQ;
271573b01e57SJeff Chen 
271673b01e57SJeff Chen 		if (first_pat) {
271773b01e57SJeff Chen 			first_pat = false;
271873b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, INFO, "Wake on patterns\n");
271973b01e57SJeff Chen 		} else {
272073b01e57SJeff Chen 			mef_entry->filter[filt_num].filt_action = TYPE_AND;
272173b01e57SJeff Chen 		}
272273b01e57SJeff Chen 
272373b01e57SJeff Chen 		filt_num++;
272473b01e57SJeff Chen 	}
272573b01e57SJeff Chen 
272673b01e57SJeff Chen 	if (wowlan->magic_pkt) {
272773b01e57SJeff Chen 		mef_cfg->criteria |= NXPWIFI_CRITERIA_UNICAST;
272873b01e57SJeff Chen 		mef_entry->filter[filt_num].repeat = 16;
272973b01e57SJeff Chen 		memcpy(mef_entry->filter[filt_num].byte_seq, priv->curr_addr,
273073b01e57SJeff Chen 		       ETH_ALEN);
273173b01e57SJeff Chen 		mef_entry->filter[filt_num].byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] =
273273b01e57SJeff Chen 			ETH_ALEN;
273373b01e57SJeff Chen 		mef_entry->filter[filt_num].offset = 28;
273473b01e57SJeff Chen 		mef_entry->filter[filt_num].filt_type = TYPE_EQ;
273573b01e57SJeff Chen 		if (filt_num)
273673b01e57SJeff Chen 			mef_entry->filter[filt_num].filt_action = TYPE_OR;
273773b01e57SJeff Chen 
273873b01e57SJeff Chen 		filt_num++;
273973b01e57SJeff Chen 		mef_entry->filter[filt_num].repeat = 16;
274073b01e57SJeff Chen 		memcpy(mef_entry->filter[filt_num].byte_seq, priv->curr_addr,
274173b01e57SJeff Chen 		       ETH_ALEN);
274273b01e57SJeff Chen 		mef_entry->filter[filt_num].byte_seq[NXPWIFI_MEF_MAX_BYTESEQ] =
274373b01e57SJeff Chen 			ETH_ALEN;
274473b01e57SJeff Chen 		mef_entry->filter[filt_num].offset = 56;
274573b01e57SJeff Chen 		mef_entry->filter[filt_num].filt_type = TYPE_EQ;
274673b01e57SJeff Chen 		mef_entry->filter[filt_num].filt_action = TYPE_OR;
274773b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO, "Wake on magic packet\n");
274873b01e57SJeff Chen 	}
274973b01e57SJeff Chen 	return ret;
275073b01e57SJeff Chen }
275173b01e57SJeff Chen 
nxpwifi_set_mef_filter(struct nxpwifi_private * priv,struct cfg80211_wowlan * wowlan)275273b01e57SJeff Chen static int nxpwifi_set_mef_filter(struct nxpwifi_private *priv,
275373b01e57SJeff Chen 				  struct cfg80211_wowlan *wowlan)
275473b01e57SJeff Chen {
275573b01e57SJeff Chen 	int ret = 0, num_entries = 1;
275673b01e57SJeff Chen 	struct nxpwifi_ds_mef_cfg mef_cfg;
275773b01e57SJeff Chen 	struct nxpwifi_mef_entry *mef_entry;
275873b01e57SJeff Chen 
275973b01e57SJeff Chen 	if (wowlan->n_patterns || wowlan->magic_pkt)
276073b01e57SJeff Chen 		num_entries++;
276173b01e57SJeff Chen 
276273b01e57SJeff Chen 	mef_entry = kzalloc_objs(*mef_entry, num_entries, GFP_KERNEL);
276373b01e57SJeff Chen 	if (!mef_entry)
276473b01e57SJeff Chen 		return -ENOMEM;
276573b01e57SJeff Chen 
276673b01e57SJeff Chen 	memset(&mef_cfg, 0, sizeof(mef_cfg));
276773b01e57SJeff Chen 	mef_cfg.criteria |= NXPWIFI_CRITERIA_BROADCAST |
276873b01e57SJeff Chen 		NXPWIFI_CRITERIA_UNICAST;
276973b01e57SJeff Chen 	mef_cfg.num_entries = num_entries;
277073b01e57SJeff Chen 	mef_cfg.mef_entry = mef_entry;
277173b01e57SJeff Chen 
277273b01e57SJeff Chen 	nxpwifi_set_auto_arp_mef_entry(priv, &mef_entry[0]);
277373b01e57SJeff Chen 
277473b01e57SJeff Chen 	if (wowlan->n_patterns || wowlan->magic_pkt) {
277573b01e57SJeff Chen 		ret = nxpwifi_set_wowlan_mef_entry(priv, &mef_cfg,
277673b01e57SJeff Chen 						   &mef_entry[1], wowlan);
277773b01e57SJeff Chen 		if (ret)
277873b01e57SJeff Chen 			goto done;
277973b01e57SJeff Chen 	}
278073b01e57SJeff Chen 
278173b01e57SJeff Chen 	if (!mef_cfg.criteria)
278273b01e57SJeff Chen 		mef_cfg.criteria = NXPWIFI_CRITERIA_BROADCAST |
278373b01e57SJeff Chen 			NXPWIFI_CRITERIA_UNICAST |
278473b01e57SJeff Chen 			NXPWIFI_CRITERIA_MULTICAST;
278573b01e57SJeff Chen 
278673b01e57SJeff Chen 	ret = nxpwifi_mef_cfg(priv, &mef_cfg);
278773b01e57SJeff Chen 
278873b01e57SJeff Chen done:
278973b01e57SJeff Chen 	kfree(mef_entry);
279073b01e57SJeff Chen 	return ret;
279173b01e57SJeff Chen }
279273b01e57SJeff Chen 
nxpwifi_cfg80211_suspend(struct wiphy * wiphy,struct cfg80211_wowlan * wowlan)279373b01e57SJeff Chen static int nxpwifi_cfg80211_suspend(struct wiphy *wiphy,
279473b01e57SJeff Chen 				    struct cfg80211_wowlan *wowlan)
279573b01e57SJeff Chen {
279673b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
279773b01e57SJeff Chen 	struct nxpwifi_ds_hs_cfg hs_cfg;
279873b01e57SJeff Chen 	int i, ret = 0, retry_num = 10;
279973b01e57SJeff Chen 	struct nxpwifi_private *priv;
280073b01e57SJeff Chen 	struct nxpwifi_private *sta_priv =
280173b01e57SJeff Chen 			nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_STA);
280273b01e57SJeff Chen 
280373b01e57SJeff Chen 	adapter->wowlan_enabled = false;
280473b01e57SJeff Chen 
280573b01e57SJeff Chen 	sta_priv->scan_aborting = true;
280673b01e57SJeff Chen 	for (i = 0; i < adapter->priv_num; i++) {
280773b01e57SJeff Chen 		priv = adapter->priv[i];
280873b01e57SJeff Chen 		nxpwifi_abort_cac(priv);
280973b01e57SJeff Chen 	}
281073b01e57SJeff Chen 
281173b01e57SJeff Chen 	nxpwifi_cancel_all_pending_cmd(adapter);
281273b01e57SJeff Chen 
281373b01e57SJeff Chen 	for (i = 0; i < adapter->priv_num; i++) {
281473b01e57SJeff Chen 		priv = adapter->priv[i];
281573b01e57SJeff Chen 		if (priv->netdev)
281673b01e57SJeff Chen 			netif_device_detach(priv->netdev);
281773b01e57SJeff Chen 	}
281873b01e57SJeff Chen 
281973b01e57SJeff Chen 	for (i = 0; i < retry_num; i++) {
282073b01e57SJeff Chen 		if (!nxpwifi_wmm_lists_empty(adapter) ||
282173b01e57SJeff Chen 		    !nxpwifi_bypass_txlist_empty(adapter) ||
282273b01e57SJeff Chen 		    !skb_queue_empty(&adapter->tx_data_q))
282373b01e57SJeff Chen 			usleep_range(10000, 15000);
282473b01e57SJeff Chen 		else
282573b01e57SJeff Chen 			break;
282673b01e57SJeff Chen 	}
282773b01e57SJeff Chen 
282873b01e57SJeff Chen 	if (!wowlan) {
282973b01e57SJeff Chen 		nxpwifi_dbg(adapter, INFO,
283073b01e57SJeff Chen 			    "None of the WOWLAN triggers enabled\n");
283173b01e57SJeff Chen 		ret = 0;
283273b01e57SJeff Chen 		goto done;
283373b01e57SJeff Chen 	}
283473b01e57SJeff Chen 
283573b01e57SJeff Chen 	if (!sta_priv->media_connected && !wowlan->nd_config) {
283673b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
283773b01e57SJeff Chen 			    "Can not configure WOWLAN in disconnected state\n");
283873b01e57SJeff Chen 		ret = 0;
283973b01e57SJeff Chen 		goto done;
284073b01e57SJeff Chen 	}
284173b01e57SJeff Chen 
284273b01e57SJeff Chen 	ret = nxpwifi_set_mef_filter(sta_priv, wowlan);
284373b01e57SJeff Chen 	if (ret) {
284473b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "Failed to set MEF filter\n");
284573b01e57SJeff Chen 		goto done;
284673b01e57SJeff Chen 	}
284773b01e57SJeff Chen 
284873b01e57SJeff Chen 	memset(&hs_cfg, 0, sizeof(hs_cfg));
284973b01e57SJeff Chen 	hs_cfg.conditions = le32_to_cpu(adapter->hs_cfg.conditions);
285073b01e57SJeff Chen 
285173b01e57SJeff Chen 	if (wowlan->nd_config) {
285273b01e57SJeff Chen 		nxpwifi_dbg(adapter, INFO, "Wake on net detect\n");
285373b01e57SJeff Chen 		hs_cfg.conditions |= HS_CFG_COND_MAC_EVENT;
285473b01e57SJeff Chen 		nxpwifi_cfg80211_sched_scan_start(wiphy, sta_priv->netdev,
285573b01e57SJeff Chen 						  wowlan->nd_config);
285673b01e57SJeff Chen 	}
285773b01e57SJeff Chen 
285873b01e57SJeff Chen 	if (wowlan->disconnect) {
285973b01e57SJeff Chen 		hs_cfg.conditions |= HS_CFG_COND_MAC_EVENT;
286073b01e57SJeff Chen 		nxpwifi_dbg(sta_priv->adapter, INFO, "Wake on device disconnect\n");
286173b01e57SJeff Chen 	}
286273b01e57SJeff Chen 
286373b01e57SJeff Chen 	hs_cfg.is_invoke_hostcmd = false;
286473b01e57SJeff Chen 	hs_cfg.gpio = adapter->hs_cfg.gpio;
286573b01e57SJeff Chen 	hs_cfg.gap = adapter->hs_cfg.gap;
286673b01e57SJeff Chen 	ret = nxpwifi_set_hs_params(sta_priv, HOST_ACT_GEN_SET,
286773b01e57SJeff Chen 				    NXPWIFI_SYNC_CMD, &hs_cfg);
286873b01e57SJeff Chen 	if (ret)
286973b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "Failed to set HS params\n");
287073b01e57SJeff Chen 
287173b01e57SJeff Chen 	adapter->wowlan_enabled = true;
287273b01e57SJeff Chen 
287373b01e57SJeff Chen done:
287473b01e57SJeff Chen 	sta_priv->scan_aborting = false;
287573b01e57SJeff Chen 	return ret;
287673b01e57SJeff Chen }
287773b01e57SJeff Chen 
nxpwifi_cfg80211_resume(struct wiphy * wiphy)287873b01e57SJeff Chen static int nxpwifi_cfg80211_resume(struct wiphy *wiphy)
287973b01e57SJeff Chen {
288073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
288173b01e57SJeff Chen 	struct nxpwifi_private *priv;
288273b01e57SJeff Chen 	struct nxpwifi_ds_wakeup_reason wakeup_reason;
288373b01e57SJeff Chen 	struct cfg80211_wowlan_wakeup wakeup_report;
288473b01e57SJeff Chen 	int i;
288573b01e57SJeff Chen 	bool report_wakeup_reason = true;
288673b01e57SJeff Chen 
288773b01e57SJeff Chen 	for (i = 0; i < adapter->priv_num; i++) {
288873b01e57SJeff Chen 		priv = adapter->priv[i];
288973b01e57SJeff Chen 		if (priv->netdev)
289073b01e57SJeff Chen 			netif_device_attach(priv->netdev);
289173b01e57SJeff Chen 	}
289273b01e57SJeff Chen 
289373b01e57SJeff Chen 	if (!wiphy->wowlan_config)
289473b01e57SJeff Chen 		goto done;
289573b01e57SJeff Chen 
289673b01e57SJeff Chen 	priv = nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_STA);
289773b01e57SJeff Chen 	nxpwifi_get_wakeup_reason(priv, HOST_ACT_GEN_GET, NXPWIFI_SYNC_CMD,
289873b01e57SJeff Chen 				  &wakeup_reason);
289973b01e57SJeff Chen 	memset(&wakeup_report, 0, sizeof(struct cfg80211_wowlan_wakeup));
290073b01e57SJeff Chen 
290173b01e57SJeff Chen 	wakeup_report.pattern_idx = -1;
290273b01e57SJeff Chen 
290373b01e57SJeff Chen 	switch (wakeup_reason.hs_wakeup_reason) {
290473b01e57SJeff Chen 	case NO_HSWAKEUP_REASON:
290573b01e57SJeff Chen 		break;
290673b01e57SJeff Chen 	case BCAST_DATA_MATCHED:
290773b01e57SJeff Chen 		break;
290873b01e57SJeff Chen 	case MCAST_DATA_MATCHED:
290973b01e57SJeff Chen 		break;
291073b01e57SJeff Chen 	case UCAST_DATA_MATCHED:
291173b01e57SJeff Chen 		break;
291273b01e57SJeff Chen 	case MASKTABLE_EVENT_MATCHED:
291373b01e57SJeff Chen 		break;
291473b01e57SJeff Chen 	case NON_MASKABLE_EVENT_MATCHED:
291573b01e57SJeff Chen 		if (wiphy->wowlan_config->disconnect)
291673b01e57SJeff Chen 			wakeup_report.disconnect = true;
291773b01e57SJeff Chen 		if (wiphy->wowlan_config->nd_config)
291873b01e57SJeff Chen 			wakeup_report.net_detect = adapter->nd_info;
291973b01e57SJeff Chen 		break;
292073b01e57SJeff Chen 	case NON_MASKABLE_CONDITION_MATCHED:
292173b01e57SJeff Chen 		break;
292273b01e57SJeff Chen 	case MAGIC_PATTERN_MATCHED:
292373b01e57SJeff Chen 		if (wiphy->wowlan_config->magic_pkt)
292473b01e57SJeff Chen 			wakeup_report.magic_pkt = true;
292573b01e57SJeff Chen 		if (wiphy->wowlan_config->n_patterns)
292673b01e57SJeff Chen 			wakeup_report.pattern_idx = 1;
292773b01e57SJeff Chen 		break;
292873b01e57SJeff Chen 	case GTK_REKEY_FAILURE:
292973b01e57SJeff Chen 		if (wiphy->wowlan_config->gtk_rekey_failure)
293073b01e57SJeff Chen 			wakeup_report.gtk_rekey_failure = true;
293173b01e57SJeff Chen 		break;
293273b01e57SJeff Chen 	default:
293373b01e57SJeff Chen 		report_wakeup_reason = false;
293473b01e57SJeff Chen 		break;
293573b01e57SJeff Chen 	}
293673b01e57SJeff Chen 
293773b01e57SJeff Chen 	if (report_wakeup_reason)
293873b01e57SJeff Chen 		cfg80211_report_wowlan_wakeup(&priv->wdev, &wakeup_report,
293973b01e57SJeff Chen 					      GFP_KERNEL);
294073b01e57SJeff Chen 
294173b01e57SJeff Chen done:
294273b01e57SJeff Chen 	if (adapter->nd_info) {
294373b01e57SJeff Chen 		for (i = 0 ; i < adapter->nd_info->n_matches ; i++)
294473b01e57SJeff Chen 			kfree(adapter->nd_info->matches[i]);
294573b01e57SJeff Chen 		kfree(adapter->nd_info);
294673b01e57SJeff Chen 		adapter->nd_info = NULL;
294773b01e57SJeff Chen 	}
294873b01e57SJeff Chen 
294973b01e57SJeff Chen 	return 0;
295073b01e57SJeff Chen }
295173b01e57SJeff Chen 
nxpwifi_cfg80211_set_wakeup(struct wiphy * wiphy,bool enabled)295273b01e57SJeff Chen static void nxpwifi_cfg80211_set_wakeup(struct wiphy *wiphy,
295373b01e57SJeff Chen 					bool enabled)
295473b01e57SJeff Chen {
295573b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
295673b01e57SJeff Chen 
295773b01e57SJeff Chen 	device_set_wakeup_enable(adapter->dev, enabled);
295873b01e57SJeff Chen }
295973b01e57SJeff Chen #endif
296073b01e57SJeff Chen 
nxpwifi_get_coalesce_pkt_type(u8 * byte_seq)296173b01e57SJeff Chen static int nxpwifi_get_coalesce_pkt_type(u8 *byte_seq)
296273b01e57SJeff Chen {
296373b01e57SJeff Chen 	if ((byte_seq[0] & 0x01) &&
296473b01e57SJeff Chen 	    byte_seq[NXPWIFI_COALESCE_MAX_BYTESEQ] == 1)
296573b01e57SJeff Chen 		return PACKET_TYPE_UNICAST;
296673b01e57SJeff Chen 	else if (is_broadcast_ether_addr(byte_seq))
296773b01e57SJeff Chen 		return PACKET_TYPE_BROADCAST;
296873b01e57SJeff Chen 	else if ((!memcmp(byte_seq, "\x33\x33", 2) &&
296973b01e57SJeff Chen 		  byte_seq[NXPWIFI_COALESCE_MAX_BYTESEQ] == 2) ||
297073b01e57SJeff Chen 		 (!memcmp(byte_seq, "\x01\x00\x5e", 3) &&
297173b01e57SJeff Chen 		  byte_seq[NXPWIFI_COALESCE_MAX_BYTESEQ] == 3))
297273b01e57SJeff Chen 		return PACKET_TYPE_MULTICAST;
297373b01e57SJeff Chen 
297473b01e57SJeff Chen 	return 0;
297573b01e57SJeff Chen }
297673b01e57SJeff Chen 
297773b01e57SJeff Chen static int
nxpwifi_fill_coalesce_rule_info(struct nxpwifi_private * priv,struct cfg80211_coalesce_rules * crule,struct nxpwifi_coalesce_rule * mrule)297873b01e57SJeff Chen nxpwifi_fill_coalesce_rule_info(struct nxpwifi_private *priv,
297973b01e57SJeff Chen 				struct cfg80211_coalesce_rules *crule,
298073b01e57SJeff Chen 				struct nxpwifi_coalesce_rule *mrule)
298173b01e57SJeff Chen {
298273b01e57SJeff Chen 	u8 byte_seq[NXPWIFI_COALESCE_MAX_BYTESEQ + 1];
298373b01e57SJeff Chen 	struct filt_field_param *param;
298473b01e57SJeff Chen 	int i;
298573b01e57SJeff Chen 
298673b01e57SJeff Chen 	mrule->max_coalescing_delay = crule->delay;
298773b01e57SJeff Chen 
298873b01e57SJeff Chen 	param = mrule->params;
298973b01e57SJeff Chen 
299073b01e57SJeff Chen 	for (i = 0; i < crule->n_patterns; i++) {
299173b01e57SJeff Chen 		memset(byte_seq, 0, sizeof(byte_seq));
299273b01e57SJeff Chen 		if (!nxpwifi_is_pattern_supported(&crule->patterns[i],
299373b01e57SJeff Chen 						  byte_seq,
299473b01e57SJeff Chen 						NXPWIFI_COALESCE_MAX_BYTESEQ)) {
299573b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, ERROR,
299673b01e57SJeff Chen 				    "Pattern not supported\n");
299773b01e57SJeff Chen 			return -EOPNOTSUPP;
299873b01e57SJeff Chen 		}
299973b01e57SJeff Chen 
300073b01e57SJeff Chen 		if (!crule->patterns[i].pkt_offset) {
300173b01e57SJeff Chen 			u8 pkt_type;
300273b01e57SJeff Chen 
300373b01e57SJeff Chen 			pkt_type = nxpwifi_get_coalesce_pkt_type(byte_seq);
300473b01e57SJeff Chen 			if (pkt_type && mrule->pkt_type) {
300573b01e57SJeff Chen 				nxpwifi_dbg(priv->adapter, ERROR,
300673b01e57SJeff Chen 					    "Multiple packet types not allowed\n");
300773b01e57SJeff Chen 				return -EOPNOTSUPP;
300873b01e57SJeff Chen 			} else if (pkt_type) {
300973b01e57SJeff Chen 				mrule->pkt_type = pkt_type;
301073b01e57SJeff Chen 				continue;
301173b01e57SJeff Chen 			}
301273b01e57SJeff Chen 		}
301373b01e57SJeff Chen 
301473b01e57SJeff Chen 		if (crule->condition == NL80211_COALESCE_CONDITION_MATCH)
301573b01e57SJeff Chen 			param->operation = RECV_FILTER_MATCH_TYPE_EQ;
301673b01e57SJeff Chen 		else
301773b01e57SJeff Chen 			param->operation = RECV_FILTER_MATCH_TYPE_NE;
301873b01e57SJeff Chen 
301973b01e57SJeff Chen 		param->operand_len = byte_seq[NXPWIFI_COALESCE_MAX_BYTESEQ];
302073b01e57SJeff Chen 		memcpy(param->operand_byte_stream, byte_seq,
302173b01e57SJeff Chen 		       param->operand_len);
302273b01e57SJeff Chen 		param->offset = crule->patterns[i].pkt_offset;
302373b01e57SJeff Chen 		param++;
302473b01e57SJeff Chen 
302573b01e57SJeff Chen 		mrule->num_of_fields++;
302673b01e57SJeff Chen 	}
302773b01e57SJeff Chen 
302873b01e57SJeff Chen 	if (!mrule->pkt_type) {
302973b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
303073b01e57SJeff Chen 			    "Packet type can not be determined\n");
303173b01e57SJeff Chen 		return -EOPNOTSUPP;
303273b01e57SJeff Chen 	}
303373b01e57SJeff Chen 
303473b01e57SJeff Chen 	return 0;
303573b01e57SJeff Chen }
303673b01e57SJeff Chen 
nxpwifi_cfg80211_set_coalesce(struct wiphy * wiphy,struct cfg80211_coalesce * coalesce)303773b01e57SJeff Chen static int nxpwifi_cfg80211_set_coalesce(struct wiphy *wiphy,
303873b01e57SJeff Chen 					 struct cfg80211_coalesce *coalesce)
303973b01e57SJeff Chen {
304073b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = nxpwifi_cfg80211_get_adapter(wiphy);
304173b01e57SJeff Chen 	int i, ret;
304273b01e57SJeff Chen 	struct nxpwifi_ds_coalesce_cfg coalesce_cfg;
304373b01e57SJeff Chen 	struct nxpwifi_private *priv =
304473b01e57SJeff Chen 			nxpwifi_get_priv(adapter, NXPWIFI_BSS_ROLE_STA);
304573b01e57SJeff Chen 
304673b01e57SJeff Chen 	memset(&coalesce_cfg, 0, sizeof(coalesce_cfg));
304773b01e57SJeff Chen 
304873b01e57SJeff Chen 	if (!coalesce)
304973b01e57SJeff Chen 		return nxpwifi_coalesce_cfg(priv, &coalesce_cfg);
305073b01e57SJeff Chen 
305173b01e57SJeff Chen 	coalesce_cfg.num_of_rules = coalesce->n_rules;
305273b01e57SJeff Chen 	for (i = 0; i < coalesce->n_rules; i++) {
305373b01e57SJeff Chen 		ret = nxpwifi_fill_coalesce_rule_info(priv, &coalesce->rules[i],
305473b01e57SJeff Chen 						      &coalesce_cfg.rule[i]);
305573b01e57SJeff Chen 		if (ret) {
305673b01e57SJeff Chen 			nxpwifi_dbg(adapter, ERROR,
305773b01e57SJeff Chen 				    "Recheck the patterns provided for rule %d\n",
305873b01e57SJeff Chen 				    i + 1);
305973b01e57SJeff Chen 			return ret;
306073b01e57SJeff Chen 		}
306173b01e57SJeff Chen 	}
306273b01e57SJeff Chen 
306373b01e57SJeff Chen 	return nxpwifi_coalesce_cfg(priv, &coalesce_cfg);
306473b01e57SJeff Chen }
306573b01e57SJeff Chen 
306673b01e57SJeff Chen static int
nxpwifi_cfg80211_uap_add_station(struct nxpwifi_private * priv,const u8 * mac,struct station_parameters * params)306773b01e57SJeff Chen nxpwifi_cfg80211_uap_add_station(struct nxpwifi_private *priv, const u8 *mac,
306873b01e57SJeff Chen 				 struct station_parameters *params)
306973b01e57SJeff Chen {
307073b01e57SJeff Chen 	struct nxpwifi_sta_info add_sta;
307173b01e57SJeff Chen 	int ret;
307273b01e57SJeff Chen 
307373b01e57SJeff Chen 	memcpy(add_sta.peer_mac, mac, ETH_ALEN);
307473b01e57SJeff Chen 	add_sta.params = params;
307573b01e57SJeff Chen 
307673b01e57SJeff Chen 	ret = nxpwifi_add_new_station(priv, &add_sta);
307773b01e57SJeff Chen 
307873b01e57SJeff Chen 	return ret;
307973b01e57SJeff Chen }
308073b01e57SJeff Chen 
308173b01e57SJeff Chen static int
nxpwifi_cfg80211_add_station(struct wiphy * wiphy,struct wireless_dev * wdev,const u8 * mac,struct station_parameters * params)308273b01e57SJeff Chen nxpwifi_cfg80211_add_station(struct wiphy *wiphy, struct wireless_dev *wdev,
308373b01e57SJeff Chen 			     const u8 *mac, struct station_parameters *params)
308473b01e57SJeff Chen {
308573b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
308673b01e57SJeff Chen 	int ret = -EOPNOTSUPP;
308773b01e57SJeff Chen 
308873b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP)
308973b01e57SJeff Chen 		ret = nxpwifi_cfg80211_uap_add_station(priv, mac, params);
309073b01e57SJeff Chen 
309173b01e57SJeff Chen 	return ret;
309273b01e57SJeff Chen }
309373b01e57SJeff Chen 
309473b01e57SJeff Chen static int
nxpwifi_cfg80211_channel_switch(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_csa_settings * params)309573b01e57SJeff Chen nxpwifi_cfg80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
309673b01e57SJeff Chen 				struct cfg80211_csa_settings *params)
309773b01e57SJeff Chen {
309873b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
309973b01e57SJeff Chen 	int chsw_msec;
310073b01e57SJeff Chen 	int ret;
310173b01e57SJeff Chen 
310273b01e57SJeff Chen 	if (priv->adapter->scan_processing) {
310373b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
310473b01e57SJeff Chen 			    "radar detection: scan in process...\n");
310573b01e57SJeff Chen 		return -EBUSY;
310673b01e57SJeff Chen 	}
310773b01e57SJeff Chen 
310873b01e57SJeff Chen 	if (priv->wdev.links[0].cac_started)
310973b01e57SJeff Chen 		return -EBUSY;
311073b01e57SJeff Chen 
311173b01e57SJeff Chen 	if (cfg80211_chandef_identical(&params->chandef,
311273b01e57SJeff Chen 				       &priv->dfs_chandef))
311373b01e57SJeff Chen 		return -EINVAL;
311473b01e57SJeff Chen 
311573b01e57SJeff Chen 	if (params->block_tx) {
311673b01e57SJeff Chen 		netif_carrier_off(priv->netdev);
311773b01e57SJeff Chen 		nxpwifi_stop_net_dev_queue(priv->netdev, priv->adapter);
311873b01e57SJeff Chen 		priv->uap_stop_tx = true;
311973b01e57SJeff Chen 	}
312073b01e57SJeff Chen 
312173b01e57SJeff Chen 	ret = nxpwifi_del_mgmt_ies(priv);
312273b01e57SJeff Chen 	if (ret)
312373b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
312473b01e57SJeff Chen 			    "Failed to delete mgmt IEs!\n");
312573b01e57SJeff Chen 
312673b01e57SJeff Chen 	ret = nxpwifi_set_mgmt_ies(priv, &params->beacon_csa);
312773b01e57SJeff Chen 	if (ret) {
312873b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
312973b01e57SJeff Chen 			    "%s: setting mgmt ies failed\n", __func__);
313073b01e57SJeff Chen 		goto done;
313173b01e57SJeff Chen 	}
313273b01e57SJeff Chen 
313373b01e57SJeff Chen 	memcpy(&priv->dfs_chandef, &params->chandef, sizeof(priv->dfs_chandef));
313473b01e57SJeff Chen 	memcpy(&priv->ap_update_info.beacon, &params->beacon_after,
313573b01e57SJeff Chen 	       sizeof(priv->ap_update_info.beacon));
313673b01e57SJeff Chen 
313773b01e57SJeff Chen 	chsw_msec = max(params->count * priv->bss_cfg.beacon_period, 100);
313873b01e57SJeff Chen 
313973b01e57SJeff Chen 	nxpwifi_queue_delayed_wiphy_work(priv->adapter,
314073b01e57SJeff Chen 					 &priv->dfs_chan_sw_work,
314173b01e57SJeff Chen 					 msecs_to_jiffies(chsw_msec));
314273b01e57SJeff Chen 
314373b01e57SJeff Chen done:
314473b01e57SJeff Chen 	return ret;
314573b01e57SJeff Chen }
314673b01e57SJeff Chen 
nxpwifi_cfg80211_get_channel(struct wiphy * wiphy,struct wireless_dev * wdev,unsigned int link_id,struct cfg80211_chan_def * chandef)314773b01e57SJeff Chen static int nxpwifi_cfg80211_get_channel(struct wiphy *wiphy,
314873b01e57SJeff Chen 					struct wireless_dev *wdev,
314973b01e57SJeff Chen 					unsigned int link_id,
315073b01e57SJeff Chen 					struct cfg80211_chan_def *chandef)
315173b01e57SJeff Chen {
315273b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
315373b01e57SJeff Chen 	struct nxpwifi_bssdescriptor *curr_bss;
315473b01e57SJeff Chen 	struct ieee80211_channel *chan;
315573b01e57SJeff Chen 	enum nl80211_channel_type chan_type;
315673b01e57SJeff Chen 	enum nl80211_band band;
315773b01e57SJeff Chen 	int freq;
315873b01e57SJeff Chen 	int ret = -ENODATA;
315973b01e57SJeff Chen 
316073b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP &&
316173b01e57SJeff Chen 	    cfg80211_chandef_valid(&priv->bss_chandef)) {
316273b01e57SJeff Chen 		*chandef = priv->bss_chandef;
316373b01e57SJeff Chen 		ret = 0;
316473b01e57SJeff Chen 	} else if (priv->media_connected) {
316573b01e57SJeff Chen 		curr_bss = &priv->curr_bss_params.bss_descriptor;
316673b01e57SJeff Chen 		band = nxpwifi_band_to_radio_type(priv->curr_bss_params.band);
316773b01e57SJeff Chen 		freq = ieee80211_channel_to_frequency(curr_bss->channel, band);
316873b01e57SJeff Chen 		chan = ieee80211_get_channel(wiphy, freq);
316973b01e57SJeff Chen 
317073b01e57SJeff Chen 		if (priv->ht_param_present) {
317173b01e57SJeff Chen 			chan_type = nxpwifi_get_chan_type(priv);
317273b01e57SJeff Chen 			cfg80211_chandef_create(chandef, chan, chan_type);
317373b01e57SJeff Chen 		} else {
317473b01e57SJeff Chen 			cfg80211_chandef_create(chandef, chan,
317573b01e57SJeff Chen 						NL80211_CHAN_NO_HT);
317673b01e57SJeff Chen 		}
317773b01e57SJeff Chen 		ret = 0;
317873b01e57SJeff Chen 	}
317973b01e57SJeff Chen 
318073b01e57SJeff Chen 	return ret;
318173b01e57SJeff Chen }
318273b01e57SJeff Chen 
318373b01e57SJeff Chen #ifdef CONFIG_NL80211_TESTMODE
318473b01e57SJeff Chen 
318573b01e57SJeff Chen enum nxpwifi_tm_attr {
318673b01e57SJeff Chen 	__NXPWIFI_TM_ATTR_INVALID	= 0,
318773b01e57SJeff Chen 	NXPWIFI_TM_ATTR_CMD		= 1,
318873b01e57SJeff Chen 	NXPWIFI_TM_ATTR_DATA		= 2,
318973b01e57SJeff Chen 
319073b01e57SJeff Chen 	/* keep last */
319173b01e57SJeff Chen 	__NXPWIFI_TM_ATTR_AFTER_LAST,
319273b01e57SJeff Chen 	NXPWIFI_TM_ATTR_MAX		= __NXPWIFI_TM_ATTR_AFTER_LAST - 1,
319373b01e57SJeff Chen };
319473b01e57SJeff Chen 
319573b01e57SJeff Chen static const struct nla_policy nxpwifi_tm_policy[NXPWIFI_TM_ATTR_MAX + 1] = {
319673b01e57SJeff Chen 	[NXPWIFI_TM_ATTR_CMD]		= { .type = NLA_U32 },
319773b01e57SJeff Chen 	[NXPWIFI_TM_ATTR_DATA]		= { .type = NLA_BINARY,
319873b01e57SJeff Chen 					    .len = NXPWIFI_SIZE_OF_CMD_BUFFER },
319973b01e57SJeff Chen };
320073b01e57SJeff Chen 
320173b01e57SJeff Chen enum nxpwifi_tm_command {
320273b01e57SJeff Chen 	NXPWIFI_TM_CMD_HOSTCMD	= 0,
320373b01e57SJeff Chen };
320473b01e57SJeff Chen 
nxpwifi_tm_cmd(struct wiphy * wiphy,struct wireless_dev * wdev,void * data,int len)320573b01e57SJeff Chen static int nxpwifi_tm_cmd(struct wiphy *wiphy, struct wireless_dev *wdev,
320673b01e57SJeff Chen 			  void *data, int len)
320773b01e57SJeff Chen {
320873b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(wdev->netdev);
320973b01e57SJeff Chen 	struct nxpwifi_ds_misc_cmd *hostcmd;
321073b01e57SJeff Chen 	struct nlattr *tb[NXPWIFI_TM_ATTR_MAX + 1];
321173b01e57SJeff Chen 	struct sk_buff *skb;
321273b01e57SJeff Chen 	int err;
321373b01e57SJeff Chen 
321473b01e57SJeff Chen 	if (!priv)
321573b01e57SJeff Chen 		return -EINVAL;
321673b01e57SJeff Chen 
321773b01e57SJeff Chen 	err = nla_parse_deprecated(tb, NXPWIFI_TM_ATTR_MAX, data, len,
321873b01e57SJeff Chen 				   nxpwifi_tm_policy, NULL);
321973b01e57SJeff Chen 	if (err)
322073b01e57SJeff Chen 		return err;
322173b01e57SJeff Chen 
322273b01e57SJeff Chen 	if (!tb[NXPWIFI_TM_ATTR_CMD])
322373b01e57SJeff Chen 		return -EINVAL;
322473b01e57SJeff Chen 
322573b01e57SJeff Chen 	switch (nla_get_u32(tb[NXPWIFI_TM_ATTR_CMD])) {
322673b01e57SJeff Chen 	case NXPWIFI_TM_CMD_HOSTCMD:
322773b01e57SJeff Chen 		if (!tb[NXPWIFI_TM_ATTR_DATA])
322873b01e57SJeff Chen 			return -EINVAL;
322973b01e57SJeff Chen 
323073b01e57SJeff Chen 		hostcmd = kzalloc_obj(*hostcmd, GFP_KERNEL);
323173b01e57SJeff Chen 		if (!hostcmd)
323273b01e57SJeff Chen 			return -ENOMEM;
323373b01e57SJeff Chen 
323473b01e57SJeff Chen 		hostcmd->len = nla_len(tb[NXPWIFI_TM_ATTR_DATA]);
323573b01e57SJeff Chen 		memcpy(hostcmd->cmd, nla_data(tb[NXPWIFI_TM_ATTR_DATA]),
323673b01e57SJeff Chen 		       hostcmd->len);
323773b01e57SJeff Chen 
323873b01e57SJeff Chen 		if (nxpwifi_hostcmd(priv, hostcmd)) {
323973b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, ERROR, "Failed to process hostcmd\n");
324073b01e57SJeff Chen 			kfree(hostcmd);
324173b01e57SJeff Chen 			return -EFAULT;
324273b01e57SJeff Chen 		}
324373b01e57SJeff Chen 
324473b01e57SJeff Chen 		/* process hostcmd response*/
324573b01e57SJeff Chen 		skb = cfg80211_testmode_alloc_reply_skb(wiphy, hostcmd->len);
324673b01e57SJeff Chen 		if (!skb) {
324773b01e57SJeff Chen 			kfree(hostcmd);
324873b01e57SJeff Chen 			return -ENOMEM;
324973b01e57SJeff Chen 		}
325073b01e57SJeff Chen 		err = nla_put(skb, NXPWIFI_TM_ATTR_DATA,
325173b01e57SJeff Chen 			      hostcmd->len, hostcmd->cmd);
325273b01e57SJeff Chen 		if (err) {
325373b01e57SJeff Chen 			kfree(hostcmd);
325473b01e57SJeff Chen 			kfree_skb(skb);
325573b01e57SJeff Chen 			return -EMSGSIZE;
325673b01e57SJeff Chen 		}
325773b01e57SJeff Chen 
325873b01e57SJeff Chen 		err = cfg80211_testmode_reply(skb);
325973b01e57SJeff Chen 		kfree(hostcmd);
326073b01e57SJeff Chen 		return err;
326173b01e57SJeff Chen 	default:
326273b01e57SJeff Chen 		return -EOPNOTSUPP;
326373b01e57SJeff Chen 	}
326473b01e57SJeff Chen }
326573b01e57SJeff Chen #endif
326673b01e57SJeff Chen 
326773b01e57SJeff Chen static int
nxpwifi_cfg80211_start_radar_detection(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_chan_def * chandef,u32 cac_time_ms,int link_id)326873b01e57SJeff Chen nxpwifi_cfg80211_start_radar_detection(struct wiphy *wiphy,
326973b01e57SJeff Chen 				       struct net_device *dev,
327073b01e57SJeff Chen 				       struct cfg80211_chan_def *chandef,
327173b01e57SJeff Chen 				       u32 cac_time_ms, int link_id)
327273b01e57SJeff Chen {
327373b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
327473b01e57SJeff Chen 	struct nxpwifi_radar_params radar_params;
327573b01e57SJeff Chen 	int ret;
327673b01e57SJeff Chen 
327773b01e57SJeff Chen 	if (priv->adapter->scan_processing) {
327873b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, ERROR,
327973b01e57SJeff Chen 			    "radar detection: scan already in process...\n");
328073b01e57SJeff Chen 		return -EBUSY;
328173b01e57SJeff Chen 	}
328273b01e57SJeff Chen 
328373b01e57SJeff Chen 	if (!nxpwifi_is_11h_active(priv)) {
328473b01e57SJeff Chen 		nxpwifi_dbg(priv->adapter, INFO,
328573b01e57SJeff Chen 			    "Enable 11h extensions in FW\n");
328673b01e57SJeff Chen 		if (nxpwifi_11h_activate(priv, true)) {
328773b01e57SJeff Chen 			nxpwifi_dbg(priv->adapter, ERROR,
328873b01e57SJeff Chen 				    "Failed to activate 11h extensions!!");
328973b01e57SJeff Chen 			return -EPERM;
329073b01e57SJeff Chen 		}
329173b01e57SJeff Chen 		priv->state_11h.is_11h_active = true;
329273b01e57SJeff Chen 	}
329373b01e57SJeff Chen 
329473b01e57SJeff Chen 	memset(&radar_params, 0, sizeof(struct nxpwifi_radar_params));
329573b01e57SJeff Chen 	radar_params.chandef = chandef;
329673b01e57SJeff Chen 	radar_params.cac_time_ms = cac_time_ms;
329773b01e57SJeff Chen 
329873b01e57SJeff Chen 	memcpy(&priv->dfs_chandef, chandef, sizeof(priv->dfs_chandef));
329973b01e57SJeff Chen 
330073b01e57SJeff Chen 	ret = nxpwifi_chan_report_request(priv, &radar_params);
330173b01e57SJeff Chen 	if (!ret)
330273b01e57SJeff Chen 		nxpwifi_queue_delayed_wiphy_work(priv->adapter,
330373b01e57SJeff Chen 						 &priv->dfs_cac_work,
330473b01e57SJeff Chen 						 msecs_to_jiffies(cac_time_ms));
330573b01e57SJeff Chen 
330673b01e57SJeff Chen 	return ret;
330773b01e57SJeff Chen }
330873b01e57SJeff Chen 
330973b01e57SJeff Chen static int
nxpwifi_cfg80211_change_station(struct wiphy * wiphy,struct wireless_dev * wdev,const u8 * mac,struct station_parameters * params)331073b01e57SJeff Chen nxpwifi_cfg80211_change_station(struct wiphy *wiphy, struct wireless_dev *wdev,
331173b01e57SJeff Chen 				const u8 *mac,
331273b01e57SJeff Chen 				struct station_parameters *params)
331373b01e57SJeff Chen {
331473b01e57SJeff Chen 	return 0;
331573b01e57SJeff Chen }
331673b01e57SJeff Chen 
331773b01e57SJeff Chen static int
nxpwifi_cfg80211_authenticate(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_auth_request * req)331873b01e57SJeff Chen nxpwifi_cfg80211_authenticate(struct wiphy *wiphy,
331973b01e57SJeff Chen 			      struct net_device *dev,
332073b01e57SJeff Chen 			      struct cfg80211_auth_request *req)
332173b01e57SJeff Chen {
332273b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
332373b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
332473b01e57SJeff Chen 	struct sk_buff *skb;
332573b01e57SJeff Chen 	u16 pkt_len, auth_alg;
332673b01e57SJeff Chen 	int ret;
332773b01e57SJeff Chen 	struct ieee80211_mgmt *mgmt;
332873b01e57SJeff Chen 	struct nxpwifi_txinfo *tx_info;
332973b01e57SJeff Chen 	u8 trans = 1, status_code = 0;
333073b01e57SJeff Chen 	u8 *varptr = NULL;
333173b01e57SJeff Chen 
333273b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_UAP) {
333373b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "Interface role is AP\n");
333473b01e57SJeff Chen 		return -EINVAL;
333573b01e57SJeff Chen 	}
333673b01e57SJeff Chen 
333773b01e57SJeff Chen 	if (priv->wdev.iftype != NL80211_IFTYPE_STATION) {
333873b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
333973b01e57SJeff Chen 			    "Interface type is not correct (type %d)\n",
334073b01e57SJeff Chen 			    priv->wdev.iftype);
334173b01e57SJeff Chen 		return -EINVAL;
334273b01e57SJeff Chen 	}
334373b01e57SJeff Chen 
334473b01e57SJeff Chen 	if (!nxpwifi_is_channel_setting_allowable(priv, req->bss->channel))
334573b01e57SJeff Chen 		return -EOPNOTSUPP;
334673b01e57SJeff Chen 
334773b01e57SJeff Chen 	if (priv->auth_alg != WLAN_AUTH_SAE &&
334873b01e57SJeff Chen 	    (priv->auth_flag & HOST_MLME_AUTH_PENDING)) {
334973b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "Pending auth on going\n");
335073b01e57SJeff Chen 		return -EBUSY;
335173b01e57SJeff Chen 	}
335273b01e57SJeff Chen 
335373b01e57SJeff Chen 	if (!priv->host_mlme_reg) {
335473b01e57SJeff Chen 		priv->host_mlme_reg = true;
335573b01e57SJeff Chen 		priv->mgmt_frame_mask |= HOST_MLME_MGMT_MASK;
335673b01e57SJeff Chen 		nxpwifi_mgmt_frame_reg(priv, priv->mgmt_frame_mask);
335773b01e57SJeff Chen 	}
335873b01e57SJeff Chen 
335973b01e57SJeff Chen 	switch (req->auth_type) {
336073b01e57SJeff Chen 	case NL80211_AUTHTYPE_OPEN_SYSTEM:
336173b01e57SJeff Chen 		auth_alg = WLAN_AUTH_OPEN;
336273b01e57SJeff Chen 		break;
336373b01e57SJeff Chen 	case NL80211_AUTHTYPE_SHARED_KEY:
336473b01e57SJeff Chen 		auth_alg = WLAN_AUTH_SHARED_KEY;
336573b01e57SJeff Chen 		break;
336673b01e57SJeff Chen 	case NL80211_AUTHTYPE_FT:
336773b01e57SJeff Chen 		auth_alg = WLAN_AUTH_FT;
336873b01e57SJeff Chen 		break;
336973b01e57SJeff Chen 	case NL80211_AUTHTYPE_NETWORK_EAP:
337073b01e57SJeff Chen 		auth_alg = WLAN_AUTH_LEAP;
337173b01e57SJeff Chen 		break;
337273b01e57SJeff Chen 	case NL80211_AUTHTYPE_SAE:
337373b01e57SJeff Chen 		auth_alg = WLAN_AUTH_SAE;
337473b01e57SJeff Chen 		break;
337573b01e57SJeff Chen 	default:
337673b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
337773b01e57SJeff Chen 			    "unsupported auth type=%d\n", req->auth_type);
337873b01e57SJeff Chen 		return -EOPNOTSUPP;
337973b01e57SJeff Chen 	}
338073b01e57SJeff Chen 
338173b01e57SJeff Chen 	if (!(priv->auth_flag & HOST_MLME_AUTH_PENDING)) {
338273b01e57SJeff Chen 		ret = nxpwifi_remain_on_chan_cfg(priv, HOST_ACT_GEN_SET,
338373b01e57SJeff Chen 						 req->bss->channel,
338473b01e57SJeff Chen 						 AUTH_TX_DEFAULT_WAIT_TIME);
338573b01e57SJeff Chen 
338673b01e57SJeff Chen 		if (!ret) {
338773b01e57SJeff Chen 			priv->roc_cfg.cookie =
338873b01e57SJeff Chen 				nxpwifi_roc_cookie(adapter);
338973b01e57SJeff Chen 			priv->roc_cfg.chan = *req->bss->channel;
339073b01e57SJeff Chen 		} else {
339173b01e57SJeff Chen 			return -EPERM;
339273b01e57SJeff Chen 		}
339373b01e57SJeff Chen 	}
339473b01e57SJeff Chen 
339573b01e57SJeff Chen 	priv->sec_info.authentication_mode = auth_alg;
339673b01e57SJeff Chen 
339773b01e57SJeff Chen 	nxpwifi_cancel_scan(adapter);
339873b01e57SJeff Chen 
339973b01e57SJeff Chen 	pkt_len = (u16)req->ie_len + req->auth_data_len +
340073b01e57SJeff Chen 		NXPWIFI_MGMT_HEADER_LEN + NXPWIFI_AUTH_BODY_LEN;
340173b01e57SJeff Chen 
340273b01e57SJeff Chen 	if (req->auth_data_len >= 4)
340373b01e57SJeff Chen 		pkt_len -= 4;
340473b01e57SJeff Chen 
340573b01e57SJeff Chen 	mgmt = kzalloc(pkt_len, GFP_KERNEL);
340673b01e57SJeff Chen 
340773b01e57SJeff Chen 	skb = dev_alloc_skb(NXPWIFI_MIN_DATA_HEADER_LEN +
340873b01e57SJeff Chen 			    NXPWIFI_MGMT_FRAME_HEADER_SIZE +
340973b01e57SJeff Chen 			    pkt_len + sizeof(pkt_len));
341073b01e57SJeff Chen 	if (!skb) {
341173b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
341273b01e57SJeff Chen 			    "allocate skb failed for management frame\n");
341373b01e57SJeff Chen 		return -ENOMEM;
341473b01e57SJeff Chen 	}
341573b01e57SJeff Chen 
341673b01e57SJeff Chen 	tx_info = NXPWIFI_SKB_TXCB(skb);
341773b01e57SJeff Chen 	memset(tx_info, 0, sizeof(*tx_info));
341873b01e57SJeff Chen 	tx_info->bss_num = priv->bss_num;
341973b01e57SJeff Chen 	tx_info->bss_type = priv->bss_type;
342073b01e57SJeff Chen 	tx_info->pkt_len = pkt_len;
342173b01e57SJeff Chen 
342273b01e57SJeff Chen 	memcpy(mgmt->da, req->bss->bssid, ETH_ALEN);
342373b01e57SJeff Chen 	memcpy(mgmt->sa, priv->curr_addr, ETH_ALEN);
342473b01e57SJeff Chen 	memcpy(mgmt->bssid, req->bss->bssid, ETH_ALEN);
342573b01e57SJeff Chen 	mgmt->frame_control =
342673b01e57SJeff Chen 		cpu_to_le16(IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_AUTH);
342773b01e57SJeff Chen 
342873b01e57SJeff Chen 	if (req->auth_data_len >= 4) {
342973b01e57SJeff Chen 		if (req->auth_type == NL80211_AUTHTYPE_SAE) {
343073b01e57SJeff Chen 			__le16 *pos = (__le16 *)req->auth_data;
343173b01e57SJeff Chen 
343273b01e57SJeff Chen 			trans = le16_to_cpu(pos[0]);
343373b01e57SJeff Chen 			status_code = le16_to_cpu(pos[1]);
343473b01e57SJeff Chen 		}
343573b01e57SJeff Chen 		memcpy((u8 *)(&mgmt->u.auth.variable), req->auth_data + 4,
343673b01e57SJeff Chen 		       req->auth_data_len - 4);
343773b01e57SJeff Chen 		varptr = (u8 *)&mgmt->u.auth.variable +
343873b01e57SJeff Chen 			 (req->auth_data_len - 4);
343973b01e57SJeff Chen 	}
344073b01e57SJeff Chen 
344173b01e57SJeff Chen 	mgmt->u.auth.auth_alg = cpu_to_le16(auth_alg);
344273b01e57SJeff Chen 	mgmt->u.auth.auth_transaction = cpu_to_le16(trans);
344373b01e57SJeff Chen 	mgmt->u.auth.status_code = cpu_to_le16(status_code);
344473b01e57SJeff Chen 
344573b01e57SJeff Chen 	if (req->ie && req->ie_len) {
344673b01e57SJeff Chen 		if (!varptr)
344773b01e57SJeff Chen 			varptr = (u8 *)&mgmt->u.auth.variable;
344873b01e57SJeff Chen 		memcpy((u8 *)varptr, req->ie, req->ie_len);
344973b01e57SJeff Chen 	}
345073b01e57SJeff Chen 
345173b01e57SJeff Chen 	nxpwifi_form_mgmt_frame(skb, (const u8 *)mgmt, pkt_len);
345273b01e57SJeff Chen 	kfree(mgmt);
345373b01e57SJeff Chen 	priv->auth_flag = HOST_MLME_AUTH_PENDING;
345473b01e57SJeff Chen 	priv->auth_alg = auth_alg;
345573b01e57SJeff Chen 	skb->priority = WMM_HIGHEST_PRIORITY;
345673b01e57SJeff Chen 	__net_timestamp(skb);
345773b01e57SJeff Chen 
345873b01e57SJeff Chen 	nxpwifi_dbg(adapter, MSG,
345973b01e57SJeff Chen 		    "auth: send authentication to %pM\n", req->bss->bssid);
346073b01e57SJeff Chen 
346173b01e57SJeff Chen 	nxpwifi_queue_tx_pkt(priv, skb);
346273b01e57SJeff Chen 
346373b01e57SJeff Chen 	return 0;
346473b01e57SJeff Chen }
346573b01e57SJeff Chen 
346673b01e57SJeff Chen static int
nxpwifi_cfg80211_associate(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_assoc_request * req)346773b01e57SJeff Chen nxpwifi_cfg80211_associate(struct wiphy *wiphy, struct net_device *dev,
346873b01e57SJeff Chen 			   struct cfg80211_assoc_request *req)
346973b01e57SJeff Chen {
347073b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
347173b01e57SJeff Chen 	struct nxpwifi_adapter *adapter = priv->adapter;
347273b01e57SJeff Chen 	int ret;
347373b01e57SJeff Chen 	struct cfg80211_ssid req_ssid;
347473b01e57SJeff Chen 	const u8 *ssid_ie;
347573b01e57SJeff Chen 
347673b01e57SJeff Chen 	if (GET_BSS_ROLE(priv) != NXPWIFI_BSS_ROLE_STA) {
347773b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
347873b01e57SJeff Chen 			    "%s: reject infra assoc request in non-STA role\n",
347973b01e57SJeff Chen 			    dev->name);
348073b01e57SJeff Chen 		return -EINVAL;
348173b01e57SJeff Chen 	}
348273b01e57SJeff Chen 
348373b01e57SJeff Chen 	if (test_bit(NXPWIFI_SURPRISE_REMOVED, &adapter->work_flags) ||
348473b01e57SJeff Chen 	    test_bit(NXPWIFI_IS_CMD_TIMEDOUT, &adapter->work_flags)) {
348573b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
348673b01e57SJeff Chen 			    "%s: Ignore association.\t"
348773b01e57SJeff Chen 			    "Card removed or FW in bad state\n",
348873b01e57SJeff Chen 			    dev->name);
348973b01e57SJeff Chen 		return -EPERM;
349073b01e57SJeff Chen 	}
349173b01e57SJeff Chen 
349273b01e57SJeff Chen 	if (priv->auth_alg == WLAN_AUTH_SAE)
349373b01e57SJeff Chen 		priv->auth_flag = HOST_MLME_AUTH_DONE;
349473b01e57SJeff Chen 
349573b01e57SJeff Chen 	if (priv->auth_flag && !(priv->auth_flag & HOST_MLME_AUTH_DONE))
349673b01e57SJeff Chen 		return -EBUSY;
349773b01e57SJeff Chen 
349873b01e57SJeff Chen 	if (priv->roc_cfg.cookie) {
349973b01e57SJeff Chen 		ret = nxpwifi_remain_on_chan_cfg(priv, HOST_ACT_GEN_REMOVE,
350073b01e57SJeff Chen 						 &priv->roc_cfg.chan, 0);
350173b01e57SJeff Chen 		if (!ret)
350273b01e57SJeff Chen 			memset(&priv->roc_cfg, 0,
350373b01e57SJeff Chen 			       sizeof(struct nxpwifi_roc_cfg));
350473b01e57SJeff Chen 		else
350573b01e57SJeff Chen 			return ret;
350673b01e57SJeff Chen 	}
350773b01e57SJeff Chen 
350873b01e57SJeff Chen 	if (!nxpwifi_stop_bg_scan(priv))
350973b01e57SJeff Chen 		cfg80211_sched_scan_stopped_locked(priv->wdev.wiphy, 0);
351073b01e57SJeff Chen 
351173b01e57SJeff Chen 	memset(&req_ssid, 0, sizeof(struct cfg80211_ssid));
351273b01e57SJeff Chen 	rcu_read_lock();
351373b01e57SJeff Chen 	ssid_ie = ieee80211_bss_get_ie(req->bss, WLAN_EID_SSID);
351473b01e57SJeff Chen 
351573b01e57SJeff Chen 	if (!ssid_ie)
351673b01e57SJeff Chen 		goto ssid_err;
351773b01e57SJeff Chen 
351873b01e57SJeff Chen 	req_ssid.ssid_len = ssid_ie[1];
351973b01e57SJeff Chen 	if (req_ssid.ssid_len > IEEE80211_MAX_SSID_LEN) {
352073b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "invalid SSID - aborting\n");
352173b01e57SJeff Chen 		goto ssid_err;
352273b01e57SJeff Chen 	}
352373b01e57SJeff Chen 
352473b01e57SJeff Chen 	memcpy(req_ssid.ssid, ssid_ie + 2, req_ssid.ssid_len);
352573b01e57SJeff Chen 	if (!req_ssid.ssid_len || req_ssid.ssid[0] < 0x20) {
352673b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR, "invalid SSID - aborting\n");
352773b01e57SJeff Chen 		goto ssid_err;
352873b01e57SJeff Chen 	}
352973b01e57SJeff Chen 	rcu_read_unlock();
353073b01e57SJeff Chen 
353173b01e57SJeff Chen 	/*
353273b01e57SJeff Chen 	 * As this is new association, clear locally stored
353373b01e57SJeff Chen 	 * keys and security related flags
353473b01e57SJeff Chen 	 */
353573b01e57SJeff Chen 	priv->sec_info.wpa_enabled = false;
353673b01e57SJeff Chen 	priv->sec_info.wpa2_enabled = false;
353773b01e57SJeff Chen 	priv->wep_key_curr_index = 0;
353873b01e57SJeff Chen 	priv->sec_info.encryption_mode = 0;
353973b01e57SJeff Chen 	priv->sec_info.is_authtype_auto = 0;
354073b01e57SJeff Chen 	ret = nxpwifi_set_encode(priv, NULL, NULL, 0, 0, NULL, 1);
354173b01e57SJeff Chen 
354273b01e57SJeff Chen 	if (req->crypto.n_ciphers_pairwise)
354373b01e57SJeff Chen 		priv->sec_info.encryption_mode =
354473b01e57SJeff Chen 			req->crypto.ciphers_pairwise[0];
354573b01e57SJeff Chen 
354673b01e57SJeff Chen 	if (req->crypto.cipher_group)
354773b01e57SJeff Chen 		priv->sec_info.encryption_mode = req->crypto.cipher_group;
354873b01e57SJeff Chen 
354973b01e57SJeff Chen 	if (req->ie)
355073b01e57SJeff Chen 		ret = nxpwifi_set_gen_ie(priv, req->ie, req->ie_len);
355173b01e57SJeff Chen 
355273b01e57SJeff Chen 	memcpy(priv->cfg_bssid, req->bss->bssid, ETH_ALEN);
355373b01e57SJeff Chen 
355473b01e57SJeff Chen 	nxpwifi_dbg(adapter, MSG,
355573b01e57SJeff Chen 		    "assoc: send association to %pM\n", req->bss->bssid);
355673b01e57SJeff Chen 
355773b01e57SJeff Chen 	cfg80211_ref_bss(adapter->wiphy, req->bss);
355873b01e57SJeff Chen 
355973b01e57SJeff Chen 	ret = nxpwifi_bss_start(priv, req->bss, &req_ssid);
356073b01e57SJeff Chen 
356173b01e57SJeff Chen 	if (ret) {
356273b01e57SJeff Chen 		priv->auth_flag = 0;
356373b01e57SJeff Chen 		priv->auth_alg = WLAN_AUTH_NONE;
356473b01e57SJeff Chen 		eth_zero_addr(priv->cfg_bssid);
356573b01e57SJeff Chen 	}
356673b01e57SJeff Chen 
356773b01e57SJeff Chen 	if (ret >= 0) {
356873b01e57SJeff Chen 		if (priv->assoc_rsp_size) {
356973b01e57SJeff Chen 			priv->req_bss = req->bss;
357073b01e57SJeff Chen 			adapter->assoc_resp_received = true;
357173b01e57SJeff Chen 			nxpwifi_queue_wiphy_work(adapter,
357273b01e57SJeff Chen 						 &adapter->host_mlme_work);
357373b01e57SJeff Chen 		}
357473b01e57SJeff Chen 		ret = 0;
357573b01e57SJeff Chen 	}
357673b01e57SJeff Chen 
357773b01e57SJeff Chen 	cfg80211_put_bss(priv->adapter->wiphy, req->bss);
357873b01e57SJeff Chen 
357973b01e57SJeff Chen 	return ret;
358073b01e57SJeff Chen 
358173b01e57SJeff Chen ssid_err:
358273b01e57SJeff Chen 
358373b01e57SJeff Chen 	rcu_read_unlock();
358473b01e57SJeff Chen 	return -EINVAL;
358573b01e57SJeff Chen }
358673b01e57SJeff Chen 
358773b01e57SJeff Chen static int
nxpwifi_cfg80211_disconnect(struct wiphy * wiphy,struct net_device * dev,u16 reason_code)358873b01e57SJeff Chen nxpwifi_cfg80211_disconnect(struct wiphy *wiphy, struct net_device *dev,
358973b01e57SJeff Chen 			    u16 reason_code)
359073b01e57SJeff Chen {
359173b01e57SJeff Chen 	struct nxpwifi_private *priv = nxpwifi_netdev_get_priv(dev);
359273b01e57SJeff Chen 	int ret;
359373b01e57SJeff Chen 
359473b01e57SJeff Chen 	if (!nxpwifi_stop_bg_scan(priv))
359573b01e57SJeff Chen 		cfg80211_sched_scan_stopped_locked(priv->wdev.wiphy, 0);
359673b01e57SJeff Chen 
359773b01e57SJeff Chen 	ret = nxpwifi_deauthenticate(priv, NULL);
359873b01e57SJeff Chen 	if (!ret) {
359973b01e57SJeff Chen 		eth_zero_addr(priv->cfg_bssid);
360073b01e57SJeff Chen 		priv->hs2_enabled = false;
360173b01e57SJeff Chen 	}
360273b01e57SJeff Chen 
360373b01e57SJeff Chen 	return ret;
360473b01e57SJeff Chen }
360573b01e57SJeff Chen 
360673b01e57SJeff Chen static int
nxpwifi_cfg80211_deauthenticate(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_deauth_request * req)360773b01e57SJeff Chen nxpwifi_cfg80211_deauthenticate(struct wiphy *wiphy,
360873b01e57SJeff Chen 				struct net_device *dev,
360973b01e57SJeff Chen 				struct cfg80211_deauth_request *req)
361073b01e57SJeff Chen {
361173b01e57SJeff Chen 	return nxpwifi_cfg80211_disconnect(wiphy, dev, req->reason_code);
361273b01e57SJeff Chen }
361373b01e57SJeff Chen 
361473b01e57SJeff Chen static int
nxpwifi_cfg80211_disassociate(struct wiphy * wiphy,struct net_device * dev,struct cfg80211_disassoc_request * req)361573b01e57SJeff Chen nxpwifi_cfg80211_disassociate(struct wiphy *wiphy,
361673b01e57SJeff Chen 			      struct net_device *dev,
361773b01e57SJeff Chen 			      struct cfg80211_disassoc_request *req)
361873b01e57SJeff Chen {
361973b01e57SJeff Chen 	return nxpwifi_cfg80211_disconnect(wiphy, dev, req->reason_code);
362073b01e57SJeff Chen }
362173b01e57SJeff Chen 
362273b01e57SJeff Chen static int
nxpwifi_cfg80211_probe_peer(struct wiphy * wiphy,struct net_device * dev,const u8 * peer,u64 cookie)362373b01e57SJeff Chen nxpwifi_cfg80211_probe_peer(struct wiphy *wiphy,
362473b01e57SJeff Chen 			      struct net_device *dev, const u8 *peer,
3625914781c7SArend van Spriel 			      u64 cookie)
362673b01e57SJeff Chen {
362773b01e57SJeff Chen 	/*
362873b01e57SJeff Chen 	 * hostapd looks for NL80211_CMD_PROBE_CLIENT support; otherwise,
362973b01e57SJeff Chen 	 * it requires monitor-mode support (which mwifiex doesn't support).
363073b01e57SJeff Chen 	 * Provide fake probe_peer support to work around this.
363173b01e57SJeff Chen 	 */
363273b01e57SJeff Chen 	return -EOPNOTSUPP;
363373b01e57SJeff Chen }
363473b01e57SJeff Chen 
363573b01e57SJeff Chen /* station cfg80211 operations */
363673b01e57SJeff Chen static const struct cfg80211_ops nxpwifi_cfg80211_ops = {
363773b01e57SJeff Chen 	.add_virtual_intf = nxpwifi_add_virtual_intf,
363873b01e57SJeff Chen 	.del_virtual_intf = nxpwifi_del_virtual_intf,
363973b01e57SJeff Chen 	.change_virtual_intf = nxpwifi_cfg80211_change_virtual_intf,
364073b01e57SJeff Chen 	.scan = nxpwifi_cfg80211_scan,
364173b01e57SJeff Chen 	.auth = nxpwifi_cfg80211_authenticate,
364273b01e57SJeff Chen 	.assoc = nxpwifi_cfg80211_associate,
364373b01e57SJeff Chen 	.deauth = nxpwifi_cfg80211_deauthenticate,
364473b01e57SJeff Chen 	.disassoc = nxpwifi_cfg80211_disassociate,
364573b01e57SJeff Chen 	.probe_peer = nxpwifi_cfg80211_probe_peer,
364673b01e57SJeff Chen 	.get_station = nxpwifi_cfg80211_get_station,
364773b01e57SJeff Chen 	.dump_station = nxpwifi_cfg80211_dump_station,
364873b01e57SJeff Chen 	.dump_survey = nxpwifi_cfg80211_dump_survey,
364973b01e57SJeff Chen 	.set_wiphy_params = nxpwifi_cfg80211_set_wiphy_params,
365073b01e57SJeff Chen 	.add_key = nxpwifi_cfg80211_add_key,
365173b01e57SJeff Chen 	.del_key = nxpwifi_cfg80211_del_key,
365273b01e57SJeff Chen 	.set_default_mgmt_key = nxpwifi_cfg80211_set_default_mgmt_key,
365373b01e57SJeff Chen 	.mgmt_tx = nxpwifi_cfg80211_mgmt_tx,
365473b01e57SJeff Chen 	.update_mgmt_frame_registrations =
365573b01e57SJeff Chen 		nxpwifi_cfg80211_update_mgmt_frame_registrations,
365673b01e57SJeff Chen 	.remain_on_channel = nxpwifi_cfg80211_remain_on_channel,
365773b01e57SJeff Chen 	.cancel_remain_on_channel = nxpwifi_cfg80211_cancel_remain_on_channel,
365873b01e57SJeff Chen 	.set_default_key = nxpwifi_cfg80211_set_default_key,
365973b01e57SJeff Chen 	.set_power_mgmt = nxpwifi_cfg80211_set_power_mgmt,
366073b01e57SJeff Chen 	.set_tx_power = nxpwifi_cfg80211_set_tx_power,
366173b01e57SJeff Chen 	.get_tx_power = nxpwifi_cfg80211_get_tx_power,
366273b01e57SJeff Chen 	.set_bitrate_mask = nxpwifi_cfg80211_set_bitrate_mask,
366373b01e57SJeff Chen 	.start_ap = nxpwifi_cfg80211_start_ap,
366473b01e57SJeff Chen 	.stop_ap = nxpwifi_cfg80211_stop_ap,
366573b01e57SJeff Chen 	.change_beacon = nxpwifi_cfg80211_change_beacon,
366673b01e57SJeff Chen 	.set_cqm_rssi_config = nxpwifi_cfg80211_set_cqm_rssi_config,
366773b01e57SJeff Chen 	.set_antenna = nxpwifi_cfg80211_set_antenna,
366873b01e57SJeff Chen 	.get_antenna = nxpwifi_cfg80211_get_antenna,
366973b01e57SJeff Chen 	.del_station = nxpwifi_cfg80211_del_station,
367073b01e57SJeff Chen 	.sched_scan_start = nxpwifi_cfg80211_sched_scan_start,
367173b01e57SJeff Chen 	.sched_scan_stop = nxpwifi_cfg80211_sched_scan_stop,
367273b01e57SJeff Chen 	.change_station = nxpwifi_cfg80211_change_station,
367373b01e57SJeff Chen #ifdef CONFIG_PM
367473b01e57SJeff Chen 	.suspend = nxpwifi_cfg80211_suspend,
367573b01e57SJeff Chen 	.resume = nxpwifi_cfg80211_resume,
367673b01e57SJeff Chen 	.set_wakeup = nxpwifi_cfg80211_set_wakeup,
367773b01e57SJeff Chen #endif
367873b01e57SJeff Chen 	.set_coalesce = nxpwifi_cfg80211_set_coalesce,
367973b01e57SJeff Chen 	.add_station = nxpwifi_cfg80211_add_station,
368073b01e57SJeff Chen 	CFG80211_TESTMODE_CMD(nxpwifi_tm_cmd)
368173b01e57SJeff Chen 	.get_channel = nxpwifi_cfg80211_get_channel,
368273b01e57SJeff Chen 	.start_radar_detection = nxpwifi_cfg80211_start_radar_detection,
368373b01e57SJeff Chen 	.channel_switch = nxpwifi_cfg80211_channel_switch,
368473b01e57SJeff Chen };
368573b01e57SJeff Chen 
368673b01e57SJeff Chen #ifdef CONFIG_PM
368773b01e57SJeff Chen static const struct wiphy_wowlan_support nxpwifi_wowlan_support = {
368873b01e57SJeff Chen 	.flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_DISCONNECT |
368973b01e57SJeff Chen 		WIPHY_WOWLAN_NET_DETECT | WIPHY_WOWLAN_SUPPORTS_GTK_REKEY |
369073b01e57SJeff Chen 		WIPHY_WOWLAN_GTK_REKEY_FAILURE,
369173b01e57SJeff Chen 	.n_patterns = NXPWIFI_MEF_MAX_FILTERS,
369273b01e57SJeff Chen 	.pattern_min_len = 1,
369373b01e57SJeff Chen 	.pattern_max_len = NXPWIFI_MAX_PATTERN_LEN,
369473b01e57SJeff Chen 	.max_pkt_offset = NXPWIFI_MAX_OFFSET_LEN,
369573b01e57SJeff Chen 	.max_nd_match_sets = NXPWIFI_MAX_ND_MATCH_SETS,
369673b01e57SJeff Chen };
369773b01e57SJeff Chen 
369873b01e57SJeff Chen static const struct wiphy_wowlan_support nxpwifi_wowlan_support_no_gtk = {
369973b01e57SJeff Chen 	.flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_DISCONNECT |
370073b01e57SJeff Chen 		 WIPHY_WOWLAN_NET_DETECT,
370173b01e57SJeff Chen 	.n_patterns = NXPWIFI_MEF_MAX_FILTERS,
370273b01e57SJeff Chen 	.pattern_min_len = 1,
370373b01e57SJeff Chen 	.pattern_max_len = NXPWIFI_MAX_PATTERN_LEN,
370473b01e57SJeff Chen 	.max_pkt_offset = NXPWIFI_MAX_OFFSET_LEN,
370573b01e57SJeff Chen 	.max_nd_match_sets = NXPWIFI_MAX_ND_MATCH_SETS,
370673b01e57SJeff Chen };
370773b01e57SJeff Chen #endif
370873b01e57SJeff Chen 
370973b01e57SJeff Chen static const struct wiphy_coalesce_support nxpwifi_coalesce_support = {
371073b01e57SJeff Chen 	.n_rules = NXPWIFI_COALESCE_MAX_RULES,
371173b01e57SJeff Chen 	.max_delay = NXPWIFI_MAX_COALESCING_DELAY,
371273b01e57SJeff Chen 	.n_patterns = NXPWIFI_COALESCE_MAX_FILTERS,
371373b01e57SJeff Chen 	.pattern_min_len = 1,
371473b01e57SJeff Chen 	.pattern_max_len = NXPWIFI_MAX_PATTERN_LEN,
371573b01e57SJeff Chen 	.max_pkt_offset = NXPWIFI_MAX_OFFSET_LEN,
371673b01e57SJeff Chen };
371773b01e57SJeff Chen 
nxpwifi_init_channel_scan_gap(struct nxpwifi_adapter * adapter)371873b01e57SJeff Chen int nxpwifi_init_channel_scan_gap(struct nxpwifi_adapter *adapter)
371973b01e57SJeff Chen {
372073b01e57SJeff Chen 	u32 n_channels_bg, n_channels_a = 0;
372173b01e57SJeff Chen 
372273b01e57SJeff Chen 	n_channels_bg = nxpwifi_band_2ghz.n_channels;
372373b01e57SJeff Chen 
372473b01e57SJeff Chen 	if (adapter->fw_bands & BAND_A)
372573b01e57SJeff Chen 		n_channels_a = nxpwifi_band_5ghz.n_channels;
372673b01e57SJeff Chen 
372773b01e57SJeff Chen 	/*
372873b01e57SJeff Chen 	 * allocate twice the number total channels, since the driver issues an
372973b01e57SJeff Chen 	 * additional active scan request for hidden SSIDs on passive channels.
373073b01e57SJeff Chen 	 */
373173b01e57SJeff Chen 	adapter->num_in_chan_stats = 2 * (n_channels_bg + n_channels_a);
373273b01e57SJeff Chen 	adapter->chan_stats = vmalloc(array_size(sizeof(*adapter->chan_stats),
373373b01e57SJeff Chen 						 adapter->num_in_chan_stats));
373473b01e57SJeff Chen 
373573b01e57SJeff Chen 	if (!adapter->chan_stats)
373673b01e57SJeff Chen 		return -ENOMEM;
373773b01e57SJeff Chen 
373873b01e57SJeff Chen 	return 0;
373973b01e57SJeff Chen }
374073b01e57SJeff Chen 
374173b01e57SJeff Chen /*
374273b01e57SJeff Chen  * Register the device with cfg80211.
374373b01e57SJeff Chen  *
374473b01e57SJeff Chen  * Create and initialize the wiphy, fill in defaults and handlers,
374573b01e57SJeff Chen  * then register it with the cfg80211 subsystem.
374673b01e57SJeff Chen  */
nxpwifi_register_cfg80211(struct nxpwifi_adapter * adapter)374773b01e57SJeff Chen int nxpwifi_register_cfg80211(struct nxpwifi_adapter *adapter)
374873b01e57SJeff Chen {
374973b01e57SJeff Chen 	int ret;
375073b01e57SJeff Chen 	void *wdev_priv;
375173b01e57SJeff Chen 	struct wiphy *wiphy;
375273b01e57SJeff Chen 	struct nxpwifi_private *priv = adapter->priv[NXPWIFI_BSS_TYPE_STA];
375373b01e57SJeff Chen 	struct ieee80211_sta_ht_cap *ht_cap;
375473b01e57SJeff Chen 	struct ieee80211_sta_vht_cap *vht_cap;
375573b01e57SJeff Chen 	u8 *country_code;
375673b01e57SJeff Chen 	u32 thr, retry;
375773b01e57SJeff Chen 
375873b01e57SJeff Chen 	/* create a new wiphy for use with cfg80211 */
375973b01e57SJeff Chen 	wiphy = wiphy_new(&nxpwifi_cfg80211_ops,
376073b01e57SJeff Chen 			  sizeof(struct nxpwifi_adapter *));
376173b01e57SJeff Chen 	if (!wiphy) {
376273b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
376373b01e57SJeff Chen 			    "%s: creating new wiphy\n", __func__);
376473b01e57SJeff Chen 		return -ENOMEM;
376573b01e57SJeff Chen 	}
376673b01e57SJeff Chen 
376773b01e57SJeff Chen 	wiphy->max_scan_ssids = NXPWIFI_MAX_SSID_LIST_LENGTH;
376873b01e57SJeff Chen 	wiphy->max_scan_ie_len = NXPWIFI_MAX_VSIE_LEN;
376973b01e57SJeff Chen 
377073b01e57SJeff Chen 	wiphy->mgmt_stypes = nxpwifi_mgmt_stypes;
377173b01e57SJeff Chen 	wiphy->max_remain_on_channel_duration = 5000;
377273b01e57SJeff Chen 	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
377373b01e57SJeff Chen 				 BIT(NL80211_IFTYPE_AP) |
377473b01e57SJeff Chen 				 BIT(NL80211_IFTYPE_MONITOR);
377573b01e57SJeff Chen 
377673b01e57SJeff Chen 	wiphy->max_num_akm_suites = CFG80211_MAX_NUM_AKM_SUITES;
377773b01e57SJeff Chen 
377873b01e57SJeff Chen 	wiphy->bands[NL80211_BAND_2GHZ] =
377973b01e57SJeff Chen 		devm_kmemdup(adapter->dev, &nxpwifi_band_2ghz,
378073b01e57SJeff Chen 			     sizeof(nxpwifi_band_2ghz), GFP_KERNEL);
378173b01e57SJeff Chen 	if (!wiphy->bands[NL80211_BAND_2GHZ]) {
378273b01e57SJeff Chen 		ret = -ENOMEM;
378373b01e57SJeff Chen 		goto err;
378473b01e57SJeff Chen 	}
378573b01e57SJeff Chen 
378673b01e57SJeff Chen 	if (adapter->fw_bands & BAND_A) {
378773b01e57SJeff Chen 		wiphy->bands[NL80211_BAND_5GHZ] =
378873b01e57SJeff Chen 			devm_kmemdup(adapter->dev, &nxpwifi_band_5ghz,
378973b01e57SJeff Chen 				     sizeof(nxpwifi_band_5ghz), GFP_KERNEL);
379073b01e57SJeff Chen 		if (!wiphy->bands[NL80211_BAND_5GHZ]) {
379173b01e57SJeff Chen 			ret = -ENOMEM;
379273b01e57SJeff Chen 			goto err;
379373b01e57SJeff Chen 		}
379473b01e57SJeff Chen 	} else {
379573b01e57SJeff Chen 		wiphy->bands[NL80211_BAND_5GHZ] = NULL;
379673b01e57SJeff Chen 	}
379773b01e57SJeff Chen 
379873b01e57SJeff Chen 	ht_cap = &wiphy->bands[NL80211_BAND_2GHZ]->ht_cap;
379973b01e57SJeff Chen 	nxpwifi_setup_ht_caps(priv, ht_cap);
380073b01e57SJeff Chen 
380173b01e57SJeff Chen 	if (adapter->is_hw_11ac_capable) {
380273b01e57SJeff Chen 		vht_cap = &wiphy->bands[NL80211_BAND_2GHZ]->vht_cap;
380373b01e57SJeff Chen 		nxpwifi_setup_vht_caps(priv, vht_cap);
380473b01e57SJeff Chen 	}
380573b01e57SJeff Chen 
380673b01e57SJeff Chen 	if (adapter->is_hw_11ax_capable)
380773b01e57SJeff Chen 		nxpwifi_setup_he_caps(priv, wiphy->bands[NL80211_BAND_2GHZ]);
380873b01e57SJeff Chen 
380973b01e57SJeff Chen 	if (adapter->fw_bands & BAND_A) {
381073b01e57SJeff Chen 		ht_cap = &wiphy->bands[NL80211_BAND_5GHZ]->ht_cap;
381173b01e57SJeff Chen 		nxpwifi_setup_ht_caps(priv, ht_cap);
381273b01e57SJeff Chen 
381373b01e57SJeff Chen 		if (adapter->is_hw_11ac_capable) {
381473b01e57SJeff Chen 			vht_cap = &wiphy->bands[NL80211_BAND_5GHZ]->vht_cap;
381573b01e57SJeff Chen 			nxpwifi_setup_vht_caps(priv, vht_cap);
381673b01e57SJeff Chen 		}
381773b01e57SJeff Chen 
381873b01e57SJeff Chen 		if (adapter->is_hw_11ax_capable)
381973b01e57SJeff Chen 			nxpwifi_setup_he_caps(priv, wiphy->bands[NL80211_BAND_5GHZ]);
382073b01e57SJeff Chen 	}
382173b01e57SJeff Chen 
382273b01e57SJeff Chen 	if (adapter->is_hw_11ac_capable)
382373b01e57SJeff Chen 		wiphy->iface_combinations = &nxpwifi_iface_comb_ap_sta_vht;
382473b01e57SJeff Chen 	else
382573b01e57SJeff Chen 		wiphy->iface_combinations = &nxpwifi_iface_comb_ap_sta;
382673b01e57SJeff Chen 	wiphy->n_iface_combinations = 1;
382773b01e57SJeff Chen 
382873b01e57SJeff Chen 	wiphy->max_ap_assoc_sta = adapter->max_sta_conn;
382973b01e57SJeff Chen 
383073b01e57SJeff Chen 	/* Initialize cipher suits */
383173b01e57SJeff Chen 	wiphy->cipher_suites = nxpwifi_cipher_suites;
383273b01e57SJeff Chen 	wiphy->n_cipher_suites = ARRAY_SIZE(nxpwifi_cipher_suites);
383373b01e57SJeff Chen 
383473b01e57SJeff Chen 	if (adapter->regd) {
383573b01e57SJeff Chen 		wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG |
383673b01e57SJeff Chen 					   REGULATORY_DISABLE_BEACON_HINTS |
383773b01e57SJeff Chen 					   REGULATORY_COUNTRY_IE_IGNORE;
383873b01e57SJeff Chen 		wiphy_apply_custom_regulatory(wiphy, adapter->regd);
383973b01e57SJeff Chen 	}
384073b01e57SJeff Chen 
384173b01e57SJeff Chen 	ether_addr_copy(wiphy->perm_addr, adapter->perm_addr);
384273b01e57SJeff Chen 	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
384373b01e57SJeff Chen 	wiphy->flags |= WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD |
384473b01e57SJeff Chen 			WIPHY_FLAG_AP_UAPSD |
384573b01e57SJeff Chen 			WIPHY_FLAG_REPORTS_OBSS |
384673b01e57SJeff Chen 			WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL |
384773b01e57SJeff Chen 			WIPHY_FLAG_HAS_CHANNEL_SWITCH |
384873b01e57SJeff Chen 			WIPHY_FLAG_NETNS_OK |
384973b01e57SJeff Chen 			WIPHY_FLAG_PS_ON_BY_DEFAULT;
385073b01e57SJeff Chen 	wiphy->max_num_csa_counters = NXPWIFI_MAX_CSA_COUNTERS;
385173b01e57SJeff Chen 
385273b01e57SJeff Chen #ifdef CONFIG_PM
385373b01e57SJeff Chen 	if (ISSUPP_FIRMWARE_SUPPLICANT(priv->adapter->fw_cap_info))
385473b01e57SJeff Chen 		wiphy->wowlan = &nxpwifi_wowlan_support;
385573b01e57SJeff Chen 	else
385673b01e57SJeff Chen 		wiphy->wowlan = &nxpwifi_wowlan_support_no_gtk;
385773b01e57SJeff Chen #endif
385873b01e57SJeff Chen 
385973b01e57SJeff Chen 	wiphy->coalesce = &nxpwifi_coalesce_support;
386073b01e57SJeff Chen 
386173b01e57SJeff Chen 	wiphy->probe_resp_offload = NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS |
386273b01e57SJeff Chen 				    NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2;
386373b01e57SJeff Chen 
386473b01e57SJeff Chen 	wiphy->max_sched_scan_reqs = 1;
386573b01e57SJeff Chen 	wiphy->max_sched_scan_ssids = NXPWIFI_MAX_SSID_LIST_LENGTH;
386673b01e57SJeff Chen 	wiphy->max_sched_scan_ie_len = NXPWIFI_MAX_VSIE_LEN;
386773b01e57SJeff Chen 	wiphy->max_match_sets = NXPWIFI_MAX_SSID_LIST_LENGTH;
386873b01e57SJeff Chen 
386973b01e57SJeff Chen 	wiphy->available_antennas_tx = BIT(adapter->number_of_antenna) - 1;
387073b01e57SJeff Chen 	wiphy->available_antennas_rx = BIT(adapter->number_of_antenna) - 1;
387173b01e57SJeff Chen 
387273b01e57SJeff Chen 	wiphy->features |= NL80211_FEATURE_SAE |
387373b01e57SJeff Chen 			   NL80211_FEATURE_INACTIVITY_TIMER |
387473b01e57SJeff Chen 			   NL80211_FEATURE_LOW_PRIORITY_SCAN |
387573b01e57SJeff Chen 			   NL80211_FEATURE_NEED_OBSS_SCAN;
387673b01e57SJeff Chen 
387773b01e57SJeff Chen 	if (ISSUPP_RANDOM_MAC(adapter->fw_cap_info))
387873b01e57SJeff Chen 		wiphy->features |= NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR |
387973b01e57SJeff Chen 				   NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR |
388073b01e57SJeff Chen 				   NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
388173b01e57SJeff Chen 
388273b01e57SJeff Chen 	if (adapter->fw_api_ver == NXPWIFI_FW_V15)
388373b01e57SJeff Chen 		wiphy->features |= NL80211_FEATURE_SK_TX_STATUS;
388473b01e57SJeff Chen 
388573b01e57SJeff Chen 	/* Reserve space for nxpwifi specific private data for BSS */
388673b01e57SJeff Chen 	wiphy->bss_priv_size = sizeof(struct nxpwifi_bss_priv);
388773b01e57SJeff Chen 
388873b01e57SJeff Chen 	wiphy->reg_notifier = nxpwifi_reg_notifier;
388973b01e57SJeff Chen 
389073b01e57SJeff Chen 	/* Set struct nxpwifi_adapter pointer in wiphy_priv */
389173b01e57SJeff Chen 	wdev_priv = wiphy_priv(wiphy);
389273b01e57SJeff Chen 	*(unsigned long *)wdev_priv = (unsigned long)adapter;
389373b01e57SJeff Chen 
389473b01e57SJeff Chen 	set_wiphy_dev(wiphy, priv->adapter->dev);
389573b01e57SJeff Chen 
389673b01e57SJeff Chen 	ret = wiphy_register(wiphy);
389773b01e57SJeff Chen 	if (ret < 0) {
389873b01e57SJeff Chen 		nxpwifi_dbg(adapter, ERROR,
389973b01e57SJeff Chen 			    "%s: wiphy_register failed: %d\n", __func__, ret);
390073b01e57SJeff Chen 		goto err;
390173b01e57SJeff Chen 	}
390273b01e57SJeff Chen 
390373b01e57SJeff Chen 	if (!adapter->regd) {
390473b01e57SJeff Chen 		if (adapter->region_code == 0x00) {
390573b01e57SJeff Chen 			nxpwifi_dbg(adapter, WARN,
390673b01e57SJeff Chen 				    "Ignore world regulatory domain\n");
390773b01e57SJeff Chen 		} else {
390873b01e57SJeff Chen 			wiphy->regulatory_flags |=
390973b01e57SJeff Chen 				REGULATORY_DISABLE_BEACON_HINTS |
391073b01e57SJeff Chen 				REGULATORY_COUNTRY_IE_IGNORE;
391173b01e57SJeff Chen 			country_code =
391273b01e57SJeff Chen 				nxpwifi_11d_code_2_region(adapter->region_code);
391373b01e57SJeff Chen 			if (country_code &&
391473b01e57SJeff Chen 			    regulatory_hint(wiphy, country_code))
391573b01e57SJeff Chen 				nxpwifi_dbg(priv->adapter, ERROR,
391673b01e57SJeff Chen 					    "regulatory_hint() failed\n");
391773b01e57SJeff Chen 		}
391873b01e57SJeff Chen 	}
391973b01e57SJeff Chen 
392073b01e57SJeff Chen 	nxpwifi_get_802_11_snmp_mib(priv, FRAG_THRESH_I, &thr);
392173b01e57SJeff Chen 	wiphy->frag_threshold = thr;
392273b01e57SJeff Chen 	nxpwifi_get_802_11_snmp_mib(priv, RTS_THRESH_I, &thr);
392373b01e57SJeff Chen 	wiphy->rts_threshold = thr;
392473b01e57SJeff Chen 	nxpwifi_get_802_11_snmp_mib(priv, SHORT_RETRY_LIM_I, &retry);
392573b01e57SJeff Chen 	wiphy->retry_short = (u8)retry;
392673b01e57SJeff Chen 	nxpwifi_get_802_11_snmp_mib(priv, LONG_RETRY_LIM_I, &retry);
392773b01e57SJeff Chen 	wiphy->retry_long = (u8)retry;
392873b01e57SJeff Chen 
392973b01e57SJeff Chen 	adapter->wiphy = wiphy;
393073b01e57SJeff Chen 	return ret;
393173b01e57SJeff Chen 
393273b01e57SJeff Chen err:
393373b01e57SJeff Chen 	wiphy_free(wiphy);
393473b01e57SJeff Chen 	return ret;
393573b01e57SJeff Chen }
3936