[mirror_ubuntu-artful-kernel.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"


void ieee80211_vht_cap_ie_to_sta_vht_cap(struct ieee80211_sub_if_data *sdata,
					 struct ieee80211_supported_band *sband,
					 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));

	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;

	if (!sta->sta.vht_cap.vht_supported)
		return sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
				IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;

	/* TODO: handle VHT opmode notification data */

	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:
		return sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
				IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
	case NL80211_CHAN_WIDTH_160:
		if (cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ)
			return IEEE80211_STA_RX_BW_160;
		/* fall through */
	case NL80211_CHAN_WIDTH_80P80:
		if (cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ)
			return IEEE80211_STA_RX_BW_160;
		/* fall through */
	case NL80211_CHAN_WIDTH_80:
		return IEEE80211_STA_RX_BW_80;
	}
}

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);
}
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"
	13
	14
	15	void ieee80211_vht_cap_ie_to_sta_vht_cap(struct ieee80211_sub_if_data *sdata,
	16	struct ieee80211_supported_band *sband,
	17	struct ieee80211_vht_cap *vht_cap_ie,
4a34215e	18	struct sta_info *sta)
818255ea	19	{
4a34215e	20	struct ieee80211_sta_vht_cap *vht_cap = &sta->sta.vht_cap;
818255ea MP	21
	22	memset(vht_cap, 0, sizeof(*vht_cap));
	23
4a34215e JB	24	if (!sta->sta.ht_cap.ht_supported)
	25	return;
	26
818255ea MP	27	if (!vht_cap_ie \|\| !sband->vht_cap.vht_supported)
	28	return;
	29
e1a0c6b3 JB	30	/* A VHT STA must support 40 MHz */
	31	if (!(sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40))
	32	return;
	33
818255ea MP	34	vht_cap->vht_supported = true;
	35
	36	vht_cap->cap = le32_to_cpu(vht_cap_ie->vht_cap_info);
	37
	38	/* Copy peer MCS info, the driver might need them. */
	39	memcpy(&vht_cap->vht_mcs, &vht_cap_ie->supp_mcs,
	40	sizeof(struct ieee80211_vht_mcs_info));
e1a0c6b3 JB	41
	42	sta->sta.bandwidth = ieee80211_sta_cur_vht_bw(sta);
	43	}
	44
	45	enum ieee80211_sta_rx_bandwidth ieee80211_sta_cur_vht_bw(struct sta_info *sta)
	46	{
	47	struct ieee80211_sub_if_data *sdata = sta->sdata;
	48	u32 cap = sta->sta.vht_cap.cap;
	49
	50	if (!sta->sta.vht_cap.vht_supported)
	51	return sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
	52	IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
	53
	54	/* TODO: handle VHT opmode notification data */
	55
	56	switch (sdata->vif.bss_conf.chandef.width) {
	57	default:
	58	WARN_ON_ONCE(1);
	59	/* fall through */
	60	case NL80211_CHAN_WIDTH_20_NOHT:
	61	case NL80211_CHAN_WIDTH_20:
	62	case NL80211_CHAN_WIDTH_40:
	63	return sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
	64	IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
	65	case NL80211_CHAN_WIDTH_160:
	66	if (cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ)
	67	return IEEE80211_STA_RX_BW_160;
	68	/* fall through */
	69	case NL80211_CHAN_WIDTH_80P80:
	70	if (cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ)
	71	return IEEE80211_STA_RX_BW_160;
	72	/* fall through */
	73	case NL80211_CHAN_WIDTH_80:
	74	return IEEE80211_STA_RX_BW_80;
	75	}
818255ea	76	}
8921d04e JB	77
	78	void ieee80211_sta_set_rx_nss(struct sta_info *sta)
	79	{
	80	u8 ht_rx_nss = 0, vht_rx_nss = 0;
	81
	82	/* if we received a notification already don't overwrite it */
	83	if (sta->sta.rx_nss)
	84	return;
	85
	86	if (sta->sta.ht_cap.ht_supported) {
	87	if (sta->sta.ht_cap.mcs.rx_mask[0])
	88	ht_rx_nss++;
	89	if (sta->sta.ht_cap.mcs.rx_mask[1])
	90	ht_rx_nss++;
	91	if (sta->sta.ht_cap.mcs.rx_mask[2])
	92	ht_rx_nss++;
	93	if (sta->sta.ht_cap.mcs.rx_mask[3])
	94	ht_rx_nss++;
	95	/* FIXME: consider rx_highest? */
	96	}
	97
	98	if (sta->sta.vht_cap.vht_supported) {
	99	int i;
	100	u16 rx_mcs_map;
	101
	102	rx_mcs_map = le16_to_cpu(sta->sta.vht_cap.vht_mcs.rx_mcs_map);
	103
	104	for (i = 7; i >= 0; i--) {
	105	u8 mcs = (rx_mcs_map >> (2 * i)) & 3;
	106
	107	if (mcs != IEEE80211_VHT_MCS_NOT_SUPPORTED) {
	108	vht_rx_nss = i + 1;
	109	break;
	110	}
	111	}
	112	/* FIXME: consider rx_highest? */
	113	}
	114
	115	ht_rx_nss = max(ht_rx_nss, vht_rx_nss);
	116	sta->sta.rx_nss = max_t(u8, 1, ht_rx_nss);
	117	}