[deliverable/linux.git] / net / mac80211 / vht.c

/*
 * VHT handling
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/ieee80211.h>
#include <linux/export.h>
#include <net/mac80211.h>
#include "ieee80211_i.h"
#include "rate.h"


void
ieee80211_vht_cap_ie_to_sta_vht_cap(struct ieee80211_sub_if_data *sdata,
				    struct ieee80211_supported_band *sband,
				    const struct ieee80211_vht_cap *vht_cap_ie,
				    struct sta_info *sta)
{
	struct ieee80211_sta_vht_cap *vht_cap = &sta->sta.vht_cap;

	memset(vht_cap, 0, sizeof(*vht_cap));

	if (!sta->sta.ht_cap.ht_supported)
		return;

	if (!vht_cap_ie || !sband->vht_cap.vht_supported)
		return;

	/* A VHT STA must support 40 MHz */
	if (!(sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40))
		return;

	vht_cap->vht_supported = true;

	vht_cap->cap = le32_to_cpu(vht_cap_ie->vht_cap_info);

	/* Copy peer MCS info, the driver might need them. */
	memcpy(&vht_cap->vht_mcs, &vht_cap_ie->supp_mcs,
	       sizeof(struct ieee80211_vht_mcs_info));

	switch (vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) {
	case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ:
	case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ:
		sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160;
		break;
	default:
		sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80;
	}

	sta->sta.bandwidth = ieee80211_sta_cur_vht_bw(sta);
}

enum ieee80211_sta_rx_bandwidth ieee80211_sta_cur_vht_bw(struct sta_info *sta)
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	u32 cap = sta->sta.vht_cap.cap;
	enum ieee80211_sta_rx_bandwidth bw;

	if (!sta->sta.vht_cap.vht_supported) {
		bw = sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
				IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
		goto check_max;
	}

	switch (sdata->vif.bss_conf.chandef.width) {
	default:
		WARN_ON_ONCE(1);
		/* fall through */
	case NL80211_CHAN_WIDTH_20_NOHT:
	case NL80211_CHAN_WIDTH_20:
	case NL80211_CHAN_WIDTH_40:
		bw = sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
				IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
		break;
	case NL80211_CHAN_WIDTH_160:
		if ((cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) ==
				IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ) {
			bw = IEEE80211_STA_RX_BW_160;
			break;
		}
		/* fall through */
	case NL80211_CHAN_WIDTH_80P80:
		if ((cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) ==
				IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) {
			bw = IEEE80211_STA_RX_BW_160;
			break;
		}
		/* fall through */
	case NL80211_CHAN_WIDTH_80:
		bw = IEEE80211_STA_RX_BW_80;
	}

 check_max:
	if (bw > sta->cur_max_bandwidth)
		bw = sta->cur_max_bandwidth;
	return bw;
}

void ieee80211_sta_set_rx_nss(struct sta_info *sta)
{
	u8 ht_rx_nss = 0, vht_rx_nss = 0;

	/* if we received a notification already don't overwrite it */
	if (sta->sta.rx_nss)
		return;

	if (sta->sta.ht_cap.ht_supported) {
		if (sta->sta.ht_cap.mcs.rx_mask[0])
			ht_rx_nss++;
		if (sta->sta.ht_cap.mcs.rx_mask[1])
			ht_rx_nss++;
		if (sta->sta.ht_cap.mcs.rx_mask[2])
			ht_rx_nss++;
		if (sta->sta.ht_cap.mcs.rx_mask[3])
			ht_rx_nss++;
		/* FIXME: consider rx_highest? */
	}

	if (sta->sta.vht_cap.vht_supported) {
		int i;
		u16 rx_mcs_map;

		rx_mcs_map = le16_to_cpu(sta->sta.vht_cap.vht_mcs.rx_mcs_map);

		for (i = 7; i >= 0; i--) {
			u8 mcs = (rx_mcs_map >> (2 * i)) & 3;

			if (mcs != IEEE80211_VHT_MCS_NOT_SUPPORTED) {
				vht_rx_nss = i + 1;
				break;
			}
		}
		/* FIXME: consider rx_highest? */
	}

	ht_rx_nss = max(ht_rx_nss, vht_rx_nss);
	sta->sta.rx_nss = max_t(u8, 1, ht_rx_nss);
}

void ieee80211_vht_handle_opmode(struct ieee80211_sub_if_data *sdata,
				 struct sta_info *sta, u8 opmode,
				 enum ieee80211_band band, bool nss_only)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_supported_band *sband;
	enum ieee80211_sta_rx_bandwidth new_bw;
	u32 changed = 0;
	u8 nss;

	sband = local->hw.wiphy->bands[band];

	/* ignore - no support for BF yet */
	if (opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_TYPE_BF)
		return;

	nss = opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_MASK;
	nss >>= IEEE80211_OPMODE_NOTIF_RX_NSS_SHIFT;
	nss += 1;

	if (sta->sta.rx_nss != nss) {
		sta->sta.rx_nss = nss;
		changed |= IEEE80211_RC_NSS_CHANGED;
	}

	if (nss_only)
		goto change;

	switch (opmode & IEEE80211_OPMODE_NOTIF_CHANWIDTH_MASK) {
	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_20MHZ:
		sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_20;
		break;
	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_40MHZ:
		sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_40;
		break;
	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_80MHZ:
		sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80;
		break;
	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_160MHZ:
		sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160;
		break;
	}

	new_bw = ieee80211_sta_cur_vht_bw(sta);
	if (new_bw != sta->sta.bandwidth) {
		sta->sta.bandwidth = new_bw;
		changed |= IEEE80211_RC_NSS_CHANGED;
	}

 change:
	if (changed)
		rate_control_rate_update(local, sband, sta, changed);
}
Commit	Line	Data
818255ea MP	1	/*
	2	* VHT handling
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*/
	8
	9	#include <linux/ieee80211.h>
	10	#include <linux/export.h>
	11	#include <net/mac80211.h>
	12	#include "ieee80211_i.h"
0af83d3d	13	#include "rate.h"
818255ea MP	14
818255ea MP	15
4a3cb702 JB	16	void
	17	ieee80211_vht_cap_ie_to_sta_vht_cap(struct ieee80211_sub_if_data *sdata,
	18	struct ieee80211_supported_band *sband,
	19	const struct ieee80211_vht_cap *vht_cap_ie,
	20	struct sta_info *sta)
818255ea	21	{
4a34215e	22	struct ieee80211_sta_vht_cap *vht_cap = &sta->sta.vht_cap;
818255ea MP	23
	24	memset(vht_cap, 0, sizeof(*vht_cap));
	25
4a34215e JB	26	if (!sta->sta.ht_cap.ht_supported)
	27	return;
	28
818255ea MP	29	if (!vht_cap_ie \|\| !sband->vht_cap.vht_supported)
	30	return;
	31
e1a0c6b3 JB	32	/* A VHT STA must support 40 MHz */
	33	if (!(sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40))
	34	return;
	35
818255ea MP	36	vht_cap->vht_supported = true;
	37
	38	vht_cap->cap = le32_to_cpu(vht_cap_ie->vht_cap_info);
	39
	40	/* Copy peer MCS info, the driver might need them. */
	41	memcpy(&vht_cap->vht_mcs, &vht_cap_ie->supp_mcs,
	42	sizeof(struct ieee80211_vht_mcs_info));
e1a0c6b3	43
0af83d3d JB	44	switch (vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) {
	45	case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ:
	46	case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ:
	47	sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160;
	48	break;
	49	default:
	50	sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80;
	51	}
	52
e1a0c6b3 JB	53	sta->sta.bandwidth = ieee80211_sta_cur_vht_bw(sta);
	54	}
	55
	56	enum ieee80211_sta_rx_bandwidth ieee80211_sta_cur_vht_bw(struct sta_info *sta)
	57	{
	58	struct ieee80211_sub_if_data *sdata = sta->sdata;
	59	u32 cap = sta->sta.vht_cap.cap;
0af83d3d	60	enum ieee80211_sta_rx_bandwidth bw;
e1a0c6b3	61
0af83d3d JB	62	if (!sta->sta.vht_cap.vht_supported) {
0af83d3d JB	63	bw = sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
e1a0c6b3	64	IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
0af83d3d JB	65	goto check_max;
0af83d3d JB	66	}
e1a0c6b3 JB	67
	68	switch (sdata->vif.bss_conf.chandef.width) {
	69	default:
	70	WARN_ON_ONCE(1);
	71	/* fall through */
	72	case NL80211_CHAN_WIDTH_20_NOHT:
	73	case NL80211_CHAN_WIDTH_20:
	74	case NL80211_CHAN_WIDTH_40:
0af83d3d	75	bw = sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
e1a0c6b3	76	IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
0af83d3d	77	break;
e1a0c6b3	78	case NL80211_CHAN_WIDTH_160:
0af83d3d JB	79	if ((cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) ==
	80	IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ) {
	81	bw = IEEE80211_STA_RX_BW_160;
	82	break;
	83	}
e1a0c6b3 JB	84	/* fall through */
e1a0c6b3 JB	85	case NL80211_CHAN_WIDTH_80P80:
0af83d3d JB	86	if ((cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) ==
	87	IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) {
	88	bw = IEEE80211_STA_RX_BW_160;
	89	break;
	90	}
e1a0c6b3 JB	91	/* fall through */
e1a0c6b3 JB	92	case NL80211_CHAN_WIDTH_80:
0af83d3d	93	bw = IEEE80211_STA_RX_BW_80;
e1a0c6b3	94	}
0af83d3d JB	95
	96	check_max:
	97	if (bw > sta->cur_max_bandwidth)
	98	bw = sta->cur_max_bandwidth;
	99	return bw;
818255ea	100	}
8921d04e JB	101
	102	void ieee80211_sta_set_rx_nss(struct sta_info *sta)
	103	{
	104	u8 ht_rx_nss = 0, vht_rx_nss = 0;
	105
	106	/* if we received a notification already don't overwrite it */
	107	if (sta->sta.rx_nss)
	108	return;
	109
	110	if (sta->sta.ht_cap.ht_supported) {
	111	if (sta->sta.ht_cap.mcs.rx_mask[0])
	112	ht_rx_nss++;
	113	if (sta->sta.ht_cap.mcs.rx_mask[1])
	114	ht_rx_nss++;
	115	if (sta->sta.ht_cap.mcs.rx_mask[2])
	116	ht_rx_nss++;
	117	if (sta->sta.ht_cap.mcs.rx_mask[3])
	118	ht_rx_nss++;
	119	/* FIXME: consider rx_highest? */
	120	}
	121
	122	if (sta->sta.vht_cap.vht_supported) {
	123	int i;
	124	u16 rx_mcs_map;
	125
	126	rx_mcs_map = le16_to_cpu(sta->sta.vht_cap.vht_mcs.rx_mcs_map);
	127
	128	for (i = 7; i >= 0; i--) {
	129	u8 mcs = (rx_mcs_map >> (2 * i)) & 3;
	130
	131	if (mcs != IEEE80211_VHT_MCS_NOT_SUPPORTED) {
	132	vht_rx_nss = i + 1;
	133	break;
	134	}
	135	}
	136	/* FIXME: consider rx_highest? */
	137	}
	138
	139	ht_rx_nss = max(ht_rx_nss, vht_rx_nss);
	140	sta->sta.rx_nss = max_t(u8, 1, ht_rx_nss);
	141	}
0af83d3d JB	142
	143	void ieee80211_vht_handle_opmode(struct ieee80211_sub_if_data *sdata,
	144	struct sta_info *sta, u8 opmode,
bee7f586	145	enum ieee80211_band band, bool nss_only)
0af83d3d JB	146	{
	147	struct ieee80211_local *local = sdata->local;
	148	struct ieee80211_supported_band *sband;
	149	enum ieee80211_sta_rx_bandwidth new_bw;
	150	u32 changed = 0;
	151	u8 nss;
	152
	153	sband = local->hw.wiphy->bands[band];
	154
	155	/* ignore - no support for BF yet */
	156	if (opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_TYPE_BF)
	157	return;
	158
	159	nss = opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_MASK;
	160	nss >>= IEEE80211_OPMODE_NOTIF_RX_NSS_SHIFT;
	161	nss += 1;
	162
	163	if (sta->sta.rx_nss != nss) {
	164	sta->sta.rx_nss = nss;
	165	changed \|= IEEE80211_RC_NSS_CHANGED;
	166	}
	167
bee7f586 JB	168	if (nss_only)
	169	goto change;
	170
0af83d3d JB	171	switch (opmode & IEEE80211_OPMODE_NOTIF_CHANWIDTH_MASK) {
	172	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_20MHZ:
	173	sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_20;
	174	break;
	175	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_40MHZ:
	176	sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_40;
	177	break;
	178	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_80MHZ:
	179	sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80;
	180	break;
	181	case IEEE80211_OPMODE_NOTIF_CHANWIDTH_160MHZ:
	182	sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160;
	183	break;
	184	}
	185
	186	new_bw = ieee80211_sta_cur_vht_bw(sta);
	187	if (new_bw != sta->sta.bandwidth) {
	188	sta->sta.bandwidth = new_bw;
	189	changed \|= IEEE80211_RC_NSS_CHANGED;
	190	}
	191
bee7f586	192	change:
0af83d3d JB	193	if (changed)
	194	rate_control_rate_update(local, sband, sta, changed);
	195	}