1/*
2 * Marvell Wireless LAN device driver: 802.11ac
3 *
4 * Copyright (C) 2013-2014, Marvell International Ltd.
5 *
6 * This software file (the "File") is distributed by Marvell International
7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
8 * (the "License").  You may use, redistribute and/or modify this File in
9 * accordance with the terms and conditions of the License, a copy of which
10 * is available by writing to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
13 *
14 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
17 * this warranty disclaimer.
18 */
19
20#include "decl.h"
21#include "ioctl.h"
22#include "fw.h"
23#include "main.h"
24#include "11ac.h"
25
26/* Tables of the MCS map to the highest data rate (in Mbps) supported
27 * for long GI.
28 */
29static const u16 max_rate_lgi_80MHZ[8][3] = {
30	{0x124, 0x15F, 0x186},	/* NSS = 1 */
31	{0x249, 0x2BE, 0x30C},  /* NSS = 2 */
32	{0x36D, 0x41D, 0x492},  /* NSS = 3 */
33	{0x492, 0x57C, 0x618},  /* NSS = 4 */
34	{0x5B6, 0x6DB, 0x79E},  /* NSS = 5 */
35	{0x6DB, 0x83A, 0x0},    /* NSS = 6 */
36	{0x7FF, 0x999, 0xAAA},  /* NSS = 7 */
37	{0x924, 0xAF8, 0xC30}   /* NSS = 8 */
38};
39
40static const u16 max_rate_lgi_160MHZ[8][3] = {
41	{0x249, 0x2BE, 0x30C},   /* NSS = 1 */
42	{0x492, 0x57C, 0x618},   /* NSS = 2 */
43	{0x6DB, 0x83A, 0x0},     /* NSS = 3 */
44	{0x924, 0xAF8, 0xC30},   /* NSS = 4 */
45	{0xB6D, 0xDB6, 0xF3C},   /* NSS = 5 */
46	{0xDB6, 0x1074, 0x1248}, /* NSS = 6 */
47	{0xFFF, 0x1332, 0x1554}, /* NSS = 7 */
48	{0x1248, 0x15F0, 0x1860} /* NSS = 8 */
49};
50
51/* This function converts the 2-bit MCS map to the highest long GI
52 * VHT data rate.
53 */
54static u16
55mwifiex_convert_mcsmap_to_maxrate(struct mwifiex_private *priv,
56				  u8 bands, u16 mcs_map)
57{
58	u8 i, nss, mcs;
59	u16 max_rate = 0;
60	u32 usr_vht_cap_info = 0;
61	struct mwifiex_adapter *adapter = priv->adapter;
62
63	if (bands & BAND_AAC)
64		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_a;
65	else
66		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_bg;
67
68	/* find the max NSS supported */
69	nss = 1;
70	for (i = 1; i <= 8; i++) {
71		mcs = GET_VHTNSSMCS(mcs_map, i);
72		if (mcs < IEEE80211_VHT_MCS_NOT_SUPPORTED)
73			nss = i;
74	}
75	mcs = GET_VHTNSSMCS(mcs_map, nss);
76
77	/* if mcs is 3, nss must be 1 (NSS = 1). Default mcs to MCS 0~9 */
78	if (mcs == IEEE80211_VHT_MCS_NOT_SUPPORTED)
79		mcs = IEEE80211_VHT_MCS_SUPPORT_0_9;
80
81	if (GET_VHTCAP_CHWDSET(usr_vht_cap_info)) {
82		/* support 160 MHz */
83		max_rate = max_rate_lgi_160MHZ[nss - 1][mcs];
84		if (!max_rate)
85			/* MCS9 is not supported in NSS6 */
86			max_rate = max_rate_lgi_160MHZ[nss - 1][mcs - 1];
87	} else {
88		max_rate = max_rate_lgi_80MHZ[nss - 1][mcs];
89		if (!max_rate)
90			/* MCS9 is not supported in NSS3 */
91			max_rate = max_rate_lgi_80MHZ[nss - 1][mcs - 1];
92	}
93
94	return max_rate;
95}
96
97static void
98mwifiex_fill_vht_cap_info(struct mwifiex_private *priv,
99			  struct ieee80211_vht_cap *vht_cap, u8 bands)
100{
101	struct mwifiex_adapter *adapter = priv->adapter;
102
103	if (bands & BAND_A)
104		vht_cap->vht_cap_info =
105				cpu_to_le32(adapter->usr_dot_11ac_dev_cap_a);
106	else
107		vht_cap->vht_cap_info =
108				cpu_to_le32(adapter->usr_dot_11ac_dev_cap_bg);
109}
110
111void mwifiex_fill_vht_cap_tlv(struct mwifiex_private *priv,
112			      struct ieee80211_vht_cap *vht_cap, u8 bands)
113{
114	struct mwifiex_adapter *adapter = priv->adapter;
115	u16 mcs_map_user, mcs_map_resp, mcs_map_result;
116	u16 mcs_user, mcs_resp, nss, tmp;
117
118	/* Fill VHT cap info */
119	mwifiex_fill_vht_cap_info(priv, vht_cap, bands);
120
121	/* rx MCS Set: find the minimum of the user rx mcs and ap rx mcs */
122	mcs_map_user = GET_DEVRXMCSMAP(adapter->usr_dot_11ac_mcs_support);
123	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.rx_mcs_map);
124	mcs_map_result = 0;
125
126	for (nss = 1; nss <= 8; nss++) {
127		mcs_user = GET_VHTNSSMCS(mcs_map_user, nss);
128		mcs_resp = GET_VHTNSSMCS(mcs_map_resp, nss);
129
130		if ((mcs_user == IEEE80211_VHT_MCS_NOT_SUPPORTED) ||
131		    (mcs_resp == IEEE80211_VHT_MCS_NOT_SUPPORTED))
132			SET_VHTNSSMCS(mcs_map_result, nss,
133				      IEEE80211_VHT_MCS_NOT_SUPPORTED);
134		else
135			SET_VHTNSSMCS(mcs_map_result, nss,
136				      min(mcs_user, mcs_resp));
137	}
138
139	vht_cap->supp_mcs.rx_mcs_map = cpu_to_le16(mcs_map_result);
140
141	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
142	vht_cap->supp_mcs.rx_highest = cpu_to_le16(tmp);
143
144	/* tx MCS Set: find the minimum of the user tx mcs and ap tx mcs */
145	mcs_map_user = GET_DEVTXMCSMAP(adapter->usr_dot_11ac_mcs_support);
146	mcs_map_resp = le16_to_cpu(vht_cap->supp_mcs.tx_mcs_map);
147	mcs_map_result = 0;
148
149	for (nss = 1; nss <= 8; nss++) {
150		mcs_user = GET_VHTNSSMCS(mcs_map_user, nss);
151		mcs_resp = GET_VHTNSSMCS(mcs_map_resp, nss);
152		if ((mcs_user == IEEE80211_VHT_MCS_NOT_SUPPORTED) ||
153		    (mcs_resp == IEEE80211_VHT_MCS_NOT_SUPPORTED))
154			SET_VHTNSSMCS(mcs_map_result, nss,
155				      IEEE80211_VHT_MCS_NOT_SUPPORTED);
156		else
157			SET_VHTNSSMCS(mcs_map_result, nss,
158				      min(mcs_user, mcs_resp));
159	}
160
161	vht_cap->supp_mcs.tx_mcs_map = cpu_to_le16(mcs_map_result);
162
163	tmp = mwifiex_convert_mcsmap_to_maxrate(priv, bands, mcs_map_result);
164	vht_cap->supp_mcs.tx_highest = cpu_to_le16(tmp);
165
166	return;
167}
168
169int mwifiex_cmd_append_11ac_tlv(struct mwifiex_private *priv,
170			     struct mwifiex_bssdescriptor *bss_desc,
171			     u8 **buffer)
172{
173	struct mwifiex_ie_types_vhtcap *vht_cap;
174	struct mwifiex_ie_types_oper_mode_ntf *oper_ntf;
175	struct ieee_types_oper_mode_ntf *ieee_oper_ntf;
176	struct mwifiex_ie_types_vht_oper *vht_op;
177	struct mwifiex_adapter *adapter = priv->adapter;
178	u8 supp_chwd_set;
179	u32 usr_vht_cap_info;
180	int ret_len = 0;
181
182	if (bss_desc->bss_band & BAND_A)
183		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_a;
184	else
185		usr_vht_cap_info = adapter->usr_dot_11ac_dev_cap_bg;
186
187	/* VHT Capabilities IE */
188	if (bss_desc->bcn_vht_cap) {
189		vht_cap = (struct mwifiex_ie_types_vhtcap *)*buffer;
190		memset(vht_cap, 0, sizeof(*vht_cap));
191		vht_cap->header.type = cpu_to_le16(WLAN_EID_VHT_CAPABILITY);
192		vht_cap->header.len  =
193				cpu_to_le16(sizeof(struct ieee80211_vht_cap));
194		memcpy((u8 *)vht_cap + sizeof(struct mwifiex_ie_types_header),
195		       (u8 *)bss_desc->bcn_vht_cap,
196		       le16_to_cpu(vht_cap->header.len));
197
198		mwifiex_fill_vht_cap_tlv(priv, &vht_cap->vht_cap,
199					 bss_desc->bss_band);
200		*buffer += sizeof(*vht_cap);
201		ret_len += sizeof(*vht_cap);
202	}
203
204	/* VHT Operation IE */
205	if (bss_desc->bcn_vht_oper) {
206		if (priv->bss_mode == NL80211_IFTYPE_STATION) {
207			vht_op = (struct mwifiex_ie_types_vht_oper *)*buffer;
208			memset(vht_op, 0, sizeof(*vht_op));
209			vht_op->header.type =
210					cpu_to_le16(WLAN_EID_VHT_OPERATION);
211			vht_op->header.len  = cpu_to_le16(sizeof(*vht_op) -
212				      sizeof(struct mwifiex_ie_types_header));
213			memcpy((u8 *)vht_op +
214				sizeof(struct mwifiex_ie_types_header),
215			       (u8 *)bss_desc->bcn_vht_oper,
216			       le16_to_cpu(vht_op->header.len));
217
218			/* negotiate the channel width and central freq
219			 * and keep the central freq as the peer suggests
220			 */
221			supp_chwd_set = GET_VHTCAP_CHWDSET(usr_vht_cap_info);
222
223			switch (supp_chwd_set) {
224			case 0:
225				vht_op->chan_width =
226				     min_t(u8, IEEE80211_VHT_CHANWIDTH_80MHZ,
227					   bss_desc->bcn_vht_oper->chan_width);
228				break;
229			case 1:
230				vht_op->chan_width =
231				     min_t(u8, IEEE80211_VHT_CHANWIDTH_160MHZ,
232					   bss_desc->bcn_vht_oper->chan_width);
233				break;
234			case 2:
235				vht_op->chan_width =
236				     min_t(u8, IEEE80211_VHT_CHANWIDTH_80P80MHZ,
237					   bss_desc->bcn_vht_oper->chan_width);
238				break;
239			default:
240				vht_op->chan_width =
241				     IEEE80211_VHT_CHANWIDTH_USE_HT;
242				break;
243			}
244
245			*buffer += sizeof(*vht_op);
246			ret_len += sizeof(*vht_op);
247		}
248	}
249
250	/* Operating Mode Notification IE */
251	if (bss_desc->oper_mode) {
252		ieee_oper_ntf = bss_desc->oper_mode;
253		oper_ntf = (void *)*buffer;
254		memset(oper_ntf, 0, sizeof(*oper_ntf));
255		oper_ntf->header.type = cpu_to_le16(WLAN_EID_OPMODE_NOTIF);
256		oper_ntf->header.len = cpu_to_le16(sizeof(u8));
257		oper_ntf->oper_mode = ieee_oper_ntf->oper_mode;
258		*buffer += sizeof(*oper_ntf);
259		ret_len += sizeof(*oper_ntf);
260	}
261
262	return ret_len;
263}
264
265int mwifiex_cmd_11ac_cfg(struct mwifiex_private *priv,
266			 struct host_cmd_ds_command *cmd, u16 cmd_action,
267			 struct mwifiex_11ac_vht_cfg *cfg)
268{
269	struct host_cmd_11ac_vht_cfg *vhtcfg = &cmd->params.vht_cfg;
270
271	cmd->command = cpu_to_le16(HostCmd_CMD_11AC_CFG);
272	cmd->size = cpu_to_le16(sizeof(struct host_cmd_11ac_vht_cfg) +
273				S_DS_GEN);
274	vhtcfg->action = cpu_to_le16(cmd_action);
275	vhtcfg->band_config = cfg->band_config;
276	vhtcfg->misc_config = cfg->misc_config;
277	vhtcfg->cap_info = cpu_to_le32(cfg->cap_info);
278	vhtcfg->mcs_tx_set = cpu_to_le32(cfg->mcs_tx_set);
279	vhtcfg->mcs_rx_set = cpu_to_le32(cfg->mcs_rx_set);
280
281	return 0;
282}
283
284/* This function initializes the BlockACK setup information for given
285 * mwifiex_private structure for 11ac enabled networks.
286 */
287void mwifiex_set_11ac_ba_params(struct mwifiex_private *priv)
288{
289	priv->add_ba_param.timeout = MWIFIEX_DEFAULT_BLOCK_ACK_TIMEOUT;
290
291	if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) {
292		priv->add_ba_param.tx_win_size =
293					   MWIFIEX_11AC_UAP_AMPDU_DEF_TXWINSIZE;
294		priv->add_ba_param.rx_win_size =
295					   MWIFIEX_11AC_UAP_AMPDU_DEF_RXWINSIZE;
296	} else {
297		priv->add_ba_param.tx_win_size =
298					   MWIFIEX_11AC_STA_AMPDU_DEF_TXWINSIZE;
299		priv->add_ba_param.rx_win_size =
300					   MWIFIEX_11AC_STA_AMPDU_DEF_RXWINSIZE;
301	}
302
303	return;
304}
305
306bool mwifiex_is_bss_in_11ac_mode(struct mwifiex_private *priv)
307{
308	struct mwifiex_bssdescriptor *bss_desc;
309	struct ieee80211_vht_operation *vht_oper;
310
311	bss_desc = &priv->curr_bss_params.bss_descriptor;
312	vht_oper = bss_desc->bcn_vht_oper;
313
314	if (!bss_desc->bcn_vht_cap || !vht_oper)
315		return false;
316
317	if (vht_oper->chan_width == IEEE80211_VHT_CHANWIDTH_USE_HT)
318		return false;
319
320	return true;
321}
322
323u8 mwifiex_get_center_freq_index(struct mwifiex_private *priv, u8 band,
324				 u32 pri_chan, u8 chan_bw)
325{
326	u8 center_freq_idx = 0;
327
328	if (band & BAND_AAC) {
329		switch (pri_chan) {
330		case 36:
331		case 40:
332		case 44:
333		case 48:
334			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
335				center_freq_idx = 42;
336			break;
337		case 52:
338		case 56:
339		case 60:
340		case 64:
341			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
342				center_freq_idx = 58;
343			else if (chan_bw == IEEE80211_VHT_CHANWIDTH_160MHZ)
344				center_freq_idx = 50;
345			break;
346		case 100:
347		case 104:
348		case 108:
349		case 112:
350			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
351				center_freq_idx = 106;
352			break;
353		case 116:
354		case 120:
355		case 124:
356		case 128:
357			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
358				center_freq_idx = 122;
359			else if (chan_bw == IEEE80211_VHT_CHANWIDTH_160MHZ)
360				center_freq_idx = 114;
361			break;
362		case 132:
363		case 136:
364		case 140:
365		case 144:
366			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
367				center_freq_idx = 138;
368			break;
369		case 149:
370		case 153:
371		case 157:
372		case 161:
373			if (chan_bw == IEEE80211_VHT_CHANWIDTH_80MHZ)
374				center_freq_idx = 155;
375			break;
376		default:
377			center_freq_idx = 42;
378		}
379	}
380
381	return center_freq_idx;
382}
383