[linux-block.git] / net / wireless / util.c

/*
 * Wireless utility functions
 *
 * Copyright 2007-2009	Johannes Berg <johannes@sipsolutions.net>
 */
#include <linux/bitops.h>
#include <linux/etherdevice.h>
#include <net/cfg80211.h>
#include <net/ip.h>
#include "core.h"

struct ieee80211_rate *
ieee80211_get_response_rate(struct ieee80211_supported_band *sband,
			    u32 basic_rates, int bitrate)
{
	struct ieee80211_rate *result = &sband->bitrates[0];
	int i;

	for (i = 0; i < sband->n_bitrates; i++) {
		if (!(basic_rates & BIT(i)))
			continue;
		if (sband->bitrates[i].bitrate > bitrate)
			continue;
		result = &sband->bitrates[i];
	}

	return result;
}
EXPORT_SYMBOL(ieee80211_get_response_rate);

int ieee80211_channel_to_frequency(int chan)
{
	if (chan < 14)
		return 2407 + chan * 5;

	if (chan == 14)
		return 2484;

	/* FIXME: 802.11j 17.3.8.3.2 */
	return (chan + 1000) * 5;
}
EXPORT_SYMBOL(ieee80211_channel_to_frequency);

int ieee80211_frequency_to_channel(int freq)
{
	if (freq == 2484)
		return 14;

	if (freq < 2484)
		return (freq - 2407) / 5;

	/* FIXME: 802.11j 17.3.8.3.2 */
	return freq/5 - 1000;
}
EXPORT_SYMBOL(ieee80211_frequency_to_channel);

struct ieee80211_channel *__ieee80211_get_channel(struct wiphy *wiphy,
						  int freq)
{
	enum ieee80211_band band;
	struct ieee80211_supported_band *sband;
	int i;

	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		sband = wiphy->bands[band];

		if (!sband)
			continue;

		for (i = 0; i < sband->n_channels; i++) {
			if (sband->channels[i].center_freq == freq)
				return &sband->channels[i];
		}
	}

	return NULL;
}
EXPORT_SYMBOL(__ieee80211_get_channel);

static void set_mandatory_flags_band(struct ieee80211_supported_band *sband,
				     enum ieee80211_band band)
{
	int i, want;

	switch (band) {
	case IEEE80211_BAND_5GHZ:
		want = 3;
		for (i = 0; i < sband->n_bitrates; i++) {
			if (sband->bitrates[i].bitrate == 60 ||
			    sband->bitrates[i].bitrate == 120 ||
			    sband->bitrates[i].bitrate == 240) {
				sband->bitrates[i].flags |=
					IEEE80211_RATE_MANDATORY_A;
				want--;
			}
		}
		WARN_ON(want);
		break;
	case IEEE80211_BAND_2GHZ:
		want = 7;
		for (i = 0; i < sband->n_bitrates; i++) {
			if (sband->bitrates[i].bitrate == 10) {
				sband->bitrates[i].flags |=
					IEEE80211_RATE_MANDATORY_B |
					IEEE80211_RATE_MANDATORY_G;
				want--;
			}

			if (sband->bitrates[i].bitrate == 20 ||
			    sband->bitrates[i].bitrate == 55 ||
			    sband->bitrates[i].bitrate == 110 ||
			    sband->bitrates[i].bitrate == 60 ||
			    sband->bitrates[i].bitrate == 120 ||
			    sband->bitrates[i].bitrate == 240) {
				sband->bitrates[i].flags |=
					IEEE80211_RATE_MANDATORY_G;
				want--;
			}

			if (sband->bitrates[i].bitrate != 10 &&
			    sband->bitrates[i].bitrate != 20 &&
			    sband->bitrates[i].bitrate != 55 &&
			    sband->bitrates[i].bitrate != 110)
				sband->bitrates[i].flags |=
					IEEE80211_RATE_ERP_G;
		}
		WARN_ON(want != 0 && want != 3 && want != 6);
		break;
	case IEEE80211_NUM_BANDS:
		WARN_ON(1);
		break;
	}
}

void ieee80211_set_bitrate_flags(struct wiphy *wiphy)
{
	enum ieee80211_band band;

	for (band = 0; band < IEEE80211_NUM_BANDS; band++)
		if (wiphy->bands[band])
			set_mandatory_flags_band(wiphy->bands[band], band);
}

int cfg80211_validate_key_settings(struct cfg80211_registered_device *rdev,
				   struct key_params *params, int key_idx,
				   const u8 *mac_addr)
{
	int i;

	if (key_idx > 5)
		return -EINVAL;

	/*
	 * Disallow pairwise keys with non-zero index unless it's WEP
	 * (because current deployments use pairwise WEP keys with
	 * non-zero indizes but 802.11i clearly specifies to use zero)
	 */
	if (mac_addr && key_idx &&
	    params->cipher != WLAN_CIPHER_SUITE_WEP40 &&
	    params->cipher != WLAN_CIPHER_SUITE_WEP104)
		return -EINVAL;

	switch (params->cipher) {
	case WLAN_CIPHER_SUITE_WEP40:
		if (params->key_len != WLAN_KEY_LEN_WEP40)
			return -EINVAL;
		break;
	case WLAN_CIPHER_SUITE_TKIP:
		if (params->key_len != WLAN_KEY_LEN_TKIP)
			return -EINVAL;
		break;
	case WLAN_CIPHER_SUITE_CCMP:
		if (params->key_len != WLAN_KEY_LEN_CCMP)
			return -EINVAL;
		break;
	case WLAN_CIPHER_SUITE_WEP104:
		if (params->key_len != WLAN_KEY_LEN_WEP104)
			return -EINVAL;
		break;
	case WLAN_CIPHER_SUITE_AES_CMAC:
		if (params->key_len != WLAN_KEY_LEN_AES_CMAC)
			return -EINVAL;
		break;
	default:
		return -EINVAL;
	}

	if (params->seq) {
		switch (params->cipher) {
		case WLAN_CIPHER_SUITE_WEP40:
		case WLAN_CIPHER_SUITE_WEP104:
			/* These ciphers do not use key sequence */
			return -EINVAL;
		case WLAN_CIPHER_SUITE_TKIP:
		case WLAN_CIPHER_SUITE_CCMP:
		case WLAN_CIPHER_SUITE_AES_CMAC:
			if (params->seq_len != 6)
				return -EINVAL;
			break;
		}
	}

	for (i = 0; i < rdev->wiphy.n_cipher_suites; i++)
		if (params->cipher == rdev->wiphy.cipher_suites[i])
			break;
	if (i == rdev->wiphy.n_cipher_suites)
		return -EINVAL;

	return 0;
}

/* See IEEE 802.1H for LLC/SNAP encapsulation/decapsulation */
/* Ethernet-II snap header (RFC1042 for most EtherTypes) */
const unsigned char rfc1042_header[] __aligned(2) =
	{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 };
EXPORT_SYMBOL(rfc1042_header);

/* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */
const unsigned char bridge_tunnel_header[] __aligned(2) =
	{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 };
EXPORT_SYMBOL(bridge_tunnel_header);

unsigned int ieee80211_hdrlen(__le16 fc)
{
	unsigned int hdrlen = 24;

	if (ieee80211_is_data(fc)) {
		if (ieee80211_has_a4(fc))
			hdrlen = 30;
		if (ieee80211_is_data_qos(fc))
			hdrlen += IEEE80211_QOS_CTL_LEN;
		goto out;
	}

	if (ieee80211_is_ctl(fc)) {
		/*
		 * ACK and CTS are 10 bytes, all others 16. To see how
		 * to get this condition consider
		 *   subtype mask:   0b0000000011110000 (0x00F0)
		 *   ACK subtype:    0b0000000011010000 (0x00D0)
		 *   CTS subtype:    0b0000000011000000 (0x00C0)
		 *   bits that matter:         ^^^      (0x00E0)
		 *   value of those: 0b0000000011000000 (0x00C0)
		 */
		if ((fc & cpu_to_le16(0x00E0)) == cpu_to_le16(0x00C0))
			hdrlen = 10;
		else
			hdrlen = 16;
	}
out:
	return hdrlen;
}
EXPORT_SYMBOL(ieee80211_hdrlen);

unsigned int ieee80211_get_hdrlen_from_skb(const struct sk_buff *skb)
{
	const struct ieee80211_hdr *hdr =
			(const struct ieee80211_hdr *)skb->data;
	unsigned int hdrlen;

	if (unlikely(skb->len < 10))
		return 0;
	hdrlen = ieee80211_hdrlen(hdr->frame_control);
	if (unlikely(hdrlen > skb->len))
		return 0;
	return hdrlen;
}
EXPORT_SYMBOL(ieee80211_get_hdrlen_from_skb);

static int ieee80211_get_mesh_hdrlen(struct ieee80211s_hdr *meshhdr)
{
	int ae = meshhdr->flags & MESH_FLAGS_AE;
	/* 7.1.3.5a.2 */
	switch (ae) {
	case 0:
		return 6;
	case MESH_FLAGS_AE_A4:
		return 12;
	case MESH_FLAGS_AE_A5_A6:
		return 18;
	case (MESH_FLAGS_AE_A4 | MESH_FLAGS_AE_A5_A6):
		return 24;
	default:
		return 6;
	}
}

int ieee80211_data_to_8023(struct sk_buff *skb, u8 *addr,
			   enum nl80211_iftype iftype)
{
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
	u16 hdrlen, ethertype;
	u8 *payload;
	u8 dst[ETH_ALEN];
	u8 src[ETH_ALEN] __aligned(2);

	if (unlikely(!ieee80211_is_data_present(hdr->frame_control)))
		return -1;

	hdrlen = ieee80211_hdrlen(hdr->frame_control);

	/* convert IEEE 802.11 header + possible LLC headers into Ethernet
	 * header
	 * IEEE 802.11 address fields:
	 * ToDS FromDS Addr1 Addr2 Addr3 Addr4
	 *   0     0   DA    SA    BSSID n/a
	 *   0     1   DA    BSSID SA    n/a
	 *   1     0   BSSID SA    DA    n/a
	 *   1     1   RA    TA    DA    SA
	 */
	memcpy(dst, ieee80211_get_DA(hdr), ETH_ALEN);
	memcpy(src, ieee80211_get_SA(hdr), ETH_ALEN);

	switch (hdr->frame_control &
		cpu_to_le16(IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) {
	case cpu_to_le16(IEEE80211_FCTL_TODS):
		if (unlikely(iftype != NL80211_IFTYPE_AP &&
			     iftype != NL80211_IFTYPE_AP_VLAN))
			return -1;
		break;
	case cpu_to_le16(IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS):
		if (unlikely(iftype != NL80211_IFTYPE_WDS &&
			     iftype != NL80211_IFTYPE_MESH_POINT))
			return -1;
		if (iftype == NL80211_IFTYPE_MESH_POINT) {
			struct ieee80211s_hdr *meshdr =
				(struct ieee80211s_hdr *) (skb->data + hdrlen);
			hdrlen += ieee80211_get_mesh_hdrlen(meshdr);
			if (meshdr->flags & MESH_FLAGS_AE_A5_A6) {
				memcpy(dst, meshdr->eaddr1, ETH_ALEN);
				memcpy(src, meshdr->eaddr2, ETH_ALEN);
			}
		}
		break;
	case cpu_to_le16(IEEE80211_FCTL_FROMDS):
		if ((iftype != NL80211_IFTYPE_STATION &&
		    iftype != NL80211_IFTYPE_MESH_POINT) ||
		    (is_multicast_ether_addr(dst) &&
		     !compare_ether_addr(src, addr)))
			return -1;
		if (iftype == NL80211_IFTYPE_MESH_POINT) {
			struct ieee80211s_hdr *meshdr =
				(struct ieee80211s_hdr *) (skb->data + hdrlen);
			hdrlen += ieee80211_get_mesh_hdrlen(meshdr);
			if (meshdr->flags & MESH_FLAGS_AE_A4)
				memcpy(src, meshdr->eaddr1, ETH_ALEN);
		}
		break;
	case cpu_to_le16(0):
		if (iftype != NL80211_IFTYPE_ADHOC)
			return -1;
		break;
	}

	if (unlikely(skb->len - hdrlen < 8))
		return -1;

	payload = skb->data + hdrlen;
	ethertype = (payload[6] << 8) | payload[7];

	if (likely((compare_ether_addr(payload, rfc1042_header) == 0 &&
		    ethertype != ETH_P_AARP && ethertype != ETH_P_IPX) ||
		   compare_ether_addr(payload, bridge_tunnel_header) == 0)) {
		/* remove RFC1042 or Bridge-Tunnel encapsulation and
		 * replace EtherType */
		skb_pull(skb, hdrlen + 6);
		memcpy(skb_push(skb, ETH_ALEN), src, ETH_ALEN);
		memcpy(skb_push(skb, ETH_ALEN), dst, ETH_ALEN);
	} else {
		struct ethhdr *ehdr;
		__be16 len;

		skb_pull(skb, hdrlen);
		len = htons(skb->len);
		ehdr = (struct ethhdr *) skb_push(skb, sizeof(struct ethhdr));
		memcpy(ehdr->h_dest, dst, ETH_ALEN);
		memcpy(ehdr->h_source, src, ETH_ALEN);
		ehdr->h_proto = len;
	}
	return 0;
}
EXPORT_SYMBOL(ieee80211_data_to_8023);

int ieee80211_data_from_8023(struct sk_buff *skb, u8 *addr,
			     enum nl80211_iftype iftype, u8 *bssid, bool qos)
{
	struct ieee80211_hdr hdr;
	u16 hdrlen, ethertype;
	__le16 fc;
	const u8 *encaps_data;
	int encaps_len, skip_header_bytes;
	int nh_pos, h_pos;
	int head_need;

	if (unlikely(skb->len < ETH_HLEN))
		return -EINVAL;

	nh_pos = skb_network_header(skb) - skb->data;
	h_pos = skb_transport_header(skb) - skb->data;

	/* convert Ethernet header to proper 802.11 header (based on
	 * operation mode) */
	ethertype = (skb->data[12] << 8) | skb->data[13];
	fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_DATA);

	switch (iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
		fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS);
		/* DA BSSID SA */
		memcpy(hdr.addr1, skb->data, ETH_ALEN);
		memcpy(hdr.addr2, addr, ETH_ALEN);
		memcpy(hdr.addr3, skb->data + ETH_ALEN, ETH_ALEN);
		hdrlen = 24;
		break;
	case NL80211_IFTYPE_STATION:
		fc |= cpu_to_le16(IEEE80211_FCTL_TODS);
		/* BSSID SA DA */
		memcpy(hdr.addr1, bssid, ETH_ALEN);
		memcpy(hdr.addr2, skb->data + ETH_ALEN, ETH_ALEN);
		memcpy(hdr.addr3, skb->data, ETH_ALEN);
		hdrlen = 24;
		break;
	case NL80211_IFTYPE_ADHOC:
		/* DA SA BSSID */
		memcpy(hdr.addr1, skb->data, ETH_ALEN);
		memcpy(hdr.addr2, skb->data + ETH_ALEN, ETH_ALEN);
		memcpy(hdr.addr3, bssid, ETH_ALEN);
		hdrlen = 24;
		break;
	default:
		return -EOPNOTSUPP;
	}

	if (qos) {
		fc |= cpu_to_le16(IEEE80211_STYPE_QOS_DATA);
		hdrlen += 2;
	}

	hdr.frame_control = fc;
	hdr.duration_id = 0;
	hdr.seq_ctrl = 0;

	skip_header_bytes = ETH_HLEN;
	if (ethertype == ETH_P_AARP || ethertype == ETH_P_IPX) {
		encaps_data = bridge_tunnel_header;
		encaps_len = sizeof(bridge_tunnel_header);
		skip_header_bytes -= 2;
	} else if (ethertype > 0x600) {
		encaps_data = rfc1042_header;
		encaps_len = sizeof(rfc1042_header);
		skip_header_bytes -= 2;
	} else {
		encaps_data = NULL;
		encaps_len = 0;
	}

	skb_pull(skb, skip_header_bytes);
	nh_pos -= skip_header_bytes;
	h_pos -= skip_header_bytes;

	head_need = hdrlen + encaps_len - skb_headroom(skb);

	if (head_need > 0 || skb_cloned(skb)) {
		head_need = max(head_need, 0);
		if (head_need)
			skb_orphan(skb);

		if (pskb_expand_head(skb, head_need, 0, GFP_ATOMIC)) {
			printk(KERN_ERR "failed to reallocate Tx buffer\n");
			return -ENOMEM;
		}
		skb->truesize += head_need;
	}

	if (encaps_data) {
		memcpy(skb_push(skb, encaps_len), encaps_data, encaps_len);
		nh_pos += encaps_len;
		h_pos += encaps_len;
	}

	memcpy(skb_push(skb, hdrlen), &hdr, hdrlen);

	nh_pos += hdrlen;
	h_pos += hdrlen;

	/* Update skb pointers to various headers since this modified frame
	 * is going to go through Linux networking code that may potentially
	 * need things like pointer to IP header. */
	skb_set_mac_header(skb, 0);
	skb_set_network_header(skb, nh_pos);
	skb_set_transport_header(skb, h_pos);

	return 0;
}
EXPORT_SYMBOL(ieee80211_data_from_8023);

/* Given a data frame determine the 802.1p/1d tag to use. */
unsigned int cfg80211_classify8021d(struct sk_buff *skb)
{
	unsigned int dscp;

	/* skb->priority values from 256->263 are magic values to
	 * directly indicate a specific 802.1d priority.  This is used
	 * to allow 802.1d priority to be passed directly in from VLAN
	 * tags, etc.
	 */
	if (skb->priority >= 256 && skb->priority <= 263)
		return skb->priority - 256;

	switch (skb->protocol) {
	case htons(ETH_P_IP):
		dscp = ip_hdr(skb)->tos & 0xfc;
		break;
	default:
		return 0;
	}

	return dscp >> 5;
}
EXPORT_SYMBOL(cfg80211_classify8021d);

const u8 *ieee80211_bss_get_ie(struct cfg80211_bss *bss, u8 ie)
{
	u8 *end, *pos;

	pos = bss->information_elements;
	if (pos == NULL)
		return NULL;
	end = pos + bss->len_information_elements;

	while (pos + 1 < end) {
		if (pos + 2 + pos[1] > end)
			break;
		if (pos[0] == ie)
			return pos;
		pos += 2 + pos[1];
	}

	return NULL;
}
EXPORT_SYMBOL(ieee80211_bss_get_ie);

void cfg80211_upload_connect_keys(struct wireless_dev *wdev)
{
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	struct net_device *dev = wdev->netdev;
	int i;

	if (!wdev->connect_keys)
		return;

	for (i = 0; i < 6; i++) {
		if (!wdev->connect_keys->params[i].cipher)
			continue;
		if (rdev->ops->add_key(wdev->wiphy, dev, i, NULL,
					&wdev->connect_keys->params[i])) {
			printk(KERN_ERR "%s: failed to set key %d\n",
				dev->name, i);
			continue;
		}
		if (wdev->connect_keys->def == i)
			if (rdev->ops->set_default_key(wdev->wiphy, dev, i)) {
				printk(KERN_ERR "%s: failed to set defkey %d\n",
					dev->name, i);
				continue;
			}
		if (wdev->connect_keys->defmgmt == i)
			if (rdev->ops->set_default_mgmt_key(wdev->wiphy, dev, i))
				printk(KERN_ERR "%s: failed to set mgtdef %d\n",
					dev->name, i);
	}

	kfree(wdev->connect_keys);
	wdev->connect_keys = NULL;
}
Commit	Line	Data
8318d78a JB	1	/*
	2	* Wireless utility functions
	3	*
d3236553	4	* Copyright 2007-2009 Johannes Berg <johannes@sipsolutions.net>
8318d78a	5	*/
d3236553	6	#include <linux/bitops.h>
e31a16d6	7	#include <linux/etherdevice.h>
d3236553	8	#include <net/cfg80211.h>
e31a16d6	9	#include <net/ip.h>
8318d78a JB	10	#include "core.h"
8318d78a JB	11
bd815252 JB	12	struct ieee80211_rate *
bd815252 JB	13	ieee80211_get_response_rate(struct ieee80211_supported_band *sband,
881d948c	14	u32 basic_rates, int bitrate)
bd815252 JB	15	{
	16	struct ieee80211_rate *result = &sband->bitrates[0];
	17	int i;
	18
	19	for (i = 0; i < sband->n_bitrates; i++) {
	20	if (!(basic_rates & BIT(i)))
	21	continue;
	22	if (sband->bitrates[i].bitrate > bitrate)
	23	continue;
	24	result = &sband->bitrates[i];
	25	}
	26
	27	return result;
	28	}
	29	EXPORT_SYMBOL(ieee80211_get_response_rate);
	30
8318d78a JB	31	int ieee80211_channel_to_frequency(int chan)
	32	{
	33	if (chan < 14)
	34	return 2407 + chan * 5;
	35
	36	if (chan == 14)
	37	return 2484;
	38
	39	/* FIXME: 802.11j 17.3.8.3.2 */
	40	return (chan + 1000) * 5;
	41	}
	42	EXPORT_SYMBOL(ieee80211_channel_to_frequency);
	43
	44	int ieee80211_frequency_to_channel(int freq)
	45	{
	46	if (freq == 2484)
	47	return 14;
	48
	49	if (freq < 2484)
	50	return (freq - 2407) / 5;
	51
	52	/* FIXME: 802.11j 17.3.8.3.2 */
	53	return freq/5 - 1000;
	54	}
	55	EXPORT_SYMBOL(ieee80211_frequency_to_channel);
	56
6c507cd0 JB	57	struct ieee80211_channel __ieee80211_get_channel(struct wiphy wiphy,
6c507cd0 JB	58	int freq)
906c730a JB	59	{
	60	enum ieee80211_band band;
	61	struct ieee80211_supported_band *sband;
	62	int i;
	63
	64	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
	65	sband = wiphy->bands[band];
	66
	67	if (!sband)
	68	continue;
	69
	70	for (i = 0; i < sband->n_channels; i++) {
	71	if (sband->channels[i].center_freq == freq)
	72	return &sband->channels[i];
	73	}
	74	}
	75
	76	return NULL;
	77	}
6c507cd0	78	EXPORT_SYMBOL(__ieee80211_get_channel);
906c730a	79
8318d78a JB	80	static void set_mandatory_flags_band(struct ieee80211_supported_band *sband,
	81	enum ieee80211_band band)
	82	{
	83	int i, want;
	84
	85	switch (band) {
	86	case IEEE80211_BAND_5GHZ:
	87	want = 3;
	88	for (i = 0; i < sband->n_bitrates; i++) {
	89	if (sband->bitrates[i].bitrate == 60 \|\|
	90	sband->bitrates[i].bitrate == 120 \|\|
	91	sband->bitrates[i].bitrate == 240) {
	92	sband->bitrates[i].flags \|=
	93	IEEE80211_RATE_MANDATORY_A;
	94	want--;
	95	}
	96	}
	97	WARN_ON(want);
	98	break;
	99	case IEEE80211_BAND_2GHZ:
	100	want = 7;
	101	for (i = 0; i < sband->n_bitrates; i++) {
	102	if (sband->bitrates[i].bitrate == 10) {
	103	sband->bitrates[i].flags \|=
	104	IEEE80211_RATE_MANDATORY_B \|
	105	IEEE80211_RATE_MANDATORY_G;
	106	want--;
	107	}
	108
	109	if (sband->bitrates[i].bitrate == 20 \|\|
	110	sband->bitrates[i].bitrate == 55 \|\|
	111	sband->bitrates[i].bitrate == 110 \|\|
	112	sband->bitrates[i].bitrate == 60 \|\|
	113	sband->bitrates[i].bitrate == 120 \|\|
	114	sband->bitrates[i].bitrate == 240) {
	115	sband->bitrates[i].flags \|=
	116	IEEE80211_RATE_MANDATORY_G;
	117	want--;
	118	}
	119
aac09fbf JB	120	if (sband->bitrates[i].bitrate != 10 &&
	121	sband->bitrates[i].bitrate != 20 &&
	122	sband->bitrates[i].bitrate != 55 &&
	123	sband->bitrates[i].bitrate != 110)
8318d78a JB	124	sband->bitrates[i].flags \|=
	125	IEEE80211_RATE_ERP_G;
	126	}
406f2388	127	WARN_ON(want != 0 && want != 3 && want != 6);
8318d78a JB	128	break;
	129	case IEEE80211_NUM_BANDS:
	130	WARN_ON(1);
	131	break;
	132	}
	133	}
	134
	135	void ieee80211_set_bitrate_flags(struct wiphy *wiphy)
	136	{
	137	enum ieee80211_band band;
	138
	139	for (band = 0; band < IEEE80211_NUM_BANDS; band++)
	140	if (wiphy->bands[band])
	141	set_mandatory_flags_band(wiphy->bands[band], band);
	142	}
08645126	143
fffd0934 JB	144	int cfg80211_validate_key_settings(struct cfg80211_registered_device *rdev,
fffd0934 JB	145	struct key_params *params, int key_idx,
08645126 JB	146	const u8 *mac_addr)
08645126 JB	147	{
fffd0934 JB	148	int i;
fffd0934 JB	149
08645126 JB	150	if (key_idx > 5)
	151	return -EINVAL;
	152
	153	/*
	154	* Disallow pairwise keys with non-zero index unless it's WEP
	155	* (because current deployments use pairwise WEP keys with
	156	* non-zero indizes but 802.11i clearly specifies to use zero)
	157	*/
	158	if (mac_addr && key_idx &&
	159	params->cipher != WLAN_CIPHER_SUITE_WEP40 &&
	160	params->cipher != WLAN_CIPHER_SUITE_WEP104)
	161	return -EINVAL;
	162
08645126 JB	163	switch (params->cipher) {
08645126 JB	164	case WLAN_CIPHER_SUITE_WEP40:
8fc0fee0	165	if (params->key_len != WLAN_KEY_LEN_WEP40)
08645126 JB	166	return -EINVAL;
	167	break;
	168	case WLAN_CIPHER_SUITE_TKIP:
8fc0fee0	169	if (params->key_len != WLAN_KEY_LEN_TKIP)
08645126 JB	170	return -EINVAL;
	171	break;
	172	case WLAN_CIPHER_SUITE_CCMP:
8fc0fee0	173	if (params->key_len != WLAN_KEY_LEN_CCMP)
08645126 JB	174	return -EINVAL;
	175	break;
	176	case WLAN_CIPHER_SUITE_WEP104:
8fc0fee0	177	if (params->key_len != WLAN_KEY_LEN_WEP104)
08645126 JB	178	return -EINVAL;
	179	break;
	180	case WLAN_CIPHER_SUITE_AES_CMAC:
8fc0fee0	181	if (params->key_len != WLAN_KEY_LEN_AES_CMAC)
08645126 JB	182	return -EINVAL;
	183	break;
	184	default:
	185	return -EINVAL;
	186	}
	187
9f26a952 JM	188	if (params->seq) {
	189	switch (params->cipher) {
	190	case WLAN_CIPHER_SUITE_WEP40:
	191	case WLAN_CIPHER_SUITE_WEP104:
	192	/* These ciphers do not use key sequence */
	193	return -EINVAL;
	194	case WLAN_CIPHER_SUITE_TKIP:
	195	case WLAN_CIPHER_SUITE_CCMP:
	196	case WLAN_CIPHER_SUITE_AES_CMAC:
	197	if (params->seq_len != 6)
	198	return -EINVAL;
	199	break;
	200	}
	201	}
	202
fffd0934 JB	203	for (i = 0; i < rdev->wiphy.n_cipher_suites; i++)
	204	if (params->cipher == rdev->wiphy.cipher_suites[i])
	205	break;
	206	if (i == rdev->wiphy.n_cipher_suites)
	207	return -EINVAL;
	208
08645126 JB	209	return 0;
08645126 JB	210	}
e31a16d6 ZY	211
	212	/* See IEEE 802.1H for LLC/SNAP encapsulation/decapsulation */
	213	/* Ethernet-II snap header (RFC1042 for most EtherTypes) */
	214	const unsigned char rfc1042_header[] __aligned(2) =
	215	{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 };
	216	EXPORT_SYMBOL(rfc1042_header);
	217
	218	/* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */
	219	const unsigned char bridge_tunnel_header[] __aligned(2) =
	220	{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 };
	221	EXPORT_SYMBOL(bridge_tunnel_header);
	222
	223	unsigned int ieee80211_hdrlen(__le16 fc)
	224	{
	225	unsigned int hdrlen = 24;
	226
	227	if (ieee80211_is_data(fc)) {
	228	if (ieee80211_has_a4(fc))
	229	hdrlen = 30;
	230	if (ieee80211_is_data_qos(fc))
	231	hdrlen += IEEE80211_QOS_CTL_LEN;
	232	goto out;
	233	}
	234
	235	if (ieee80211_is_ctl(fc)) {
	236	/*
	237	* ACK and CTS are 10 bytes, all others 16. To see how
	238	* to get this condition consider
	239	* subtype mask: 0b0000000011110000 (0x00F0)
	240	* ACK subtype: 0b0000000011010000 (0x00D0)
	241	* CTS subtype: 0b0000000011000000 (0x00C0)
	242	* bits that matter: ^^^ (0x00E0)
	243	* value of those: 0b0000000011000000 (0x00C0)
	244	*/
	245	if ((fc & cpu_to_le16(0x00E0)) == cpu_to_le16(0x00C0))
	246	hdrlen = 10;
	247	else
	248	hdrlen = 16;
	249	}
	250	out:
	251	return hdrlen;
	252	}
	253	EXPORT_SYMBOL(ieee80211_hdrlen);
	254
	255	unsigned int ieee80211_get_hdrlen_from_skb(const struct sk_buff *skb)
	256	{
	257	const struct ieee80211_hdr *hdr =
	258	(const struct ieee80211_hdr *)skb->data;
	259	unsigned int hdrlen;
	260
	261	if (unlikely(skb->len < 10))
	262	return 0;
	263	hdrlen = ieee80211_hdrlen(hdr->frame_control);
	264	if (unlikely(hdrlen > skb->len))
	265	return 0;
	266	return hdrlen;
	267	}
	268	EXPORT_SYMBOL(ieee80211_get_hdrlen_from_skb);
	269
60fd2b67	270	static int ieee80211_get_mesh_hdrlen(struct ieee80211s_hdr *meshhdr)
e31a16d6 ZY	271	{
	272	int ae = meshhdr->flags & MESH_FLAGS_AE;
	273	/* 7.1.3.5a.2 */
	274	switch (ae) {
	275	case 0:
	276	return 6;
3c5772a5	277	case MESH_FLAGS_AE_A4:
e31a16d6	278	return 12;
3c5772a5	279	case MESH_FLAGS_AE_A5_A6:
e31a16d6	280	return 18;
3c5772a5	281	case (MESH_FLAGS_AE_A4 \| MESH_FLAGS_AE_A5_A6):
e31a16d6 ZY	282	return 24;
	283	default:
	284	return 6;
	285	}
	286	}
	287
	288	int ieee80211_data_to_8023(struct sk_buff skb, u8 addr,
	289	enum nl80211_iftype iftype)
	290	{
	291	struct ieee80211_hdr hdr = (struct ieee80211_hdr ) skb->data;
	292	u16 hdrlen, ethertype;
	293	u8 *payload;
	294	u8 dst[ETH_ALEN];
	295	u8 src[ETH_ALEN] __aligned(2);
	296
	297	if (unlikely(!ieee80211_is_data_present(hdr->frame_control)))
	298	return -1;
	299
	300	hdrlen = ieee80211_hdrlen(hdr->frame_control);
	301
	302	/* convert IEEE 802.11 header + possible LLC headers into Ethernet
	303	* header
	304	* IEEE 802.11 address fields:
	305	* ToDS FromDS Addr1 Addr2 Addr3 Addr4
	306	* 0 0 DA SA BSSID n/a
	307	* 0 1 DA BSSID SA n/a
	308	* 1 0 BSSID SA DA n/a
	309	* 1 1 RA TA DA SA
	310	*/
	311	memcpy(dst, ieee80211_get_DA(hdr), ETH_ALEN);
	312	memcpy(src, ieee80211_get_SA(hdr), ETH_ALEN);
	313
	314	switch (hdr->frame_control &
	315	cpu_to_le16(IEEE80211_FCTL_TODS \| IEEE80211_FCTL_FROMDS)) {
	316	case cpu_to_le16(IEEE80211_FCTL_TODS):
	317	if (unlikely(iftype != NL80211_IFTYPE_AP &&
	318	iftype != NL80211_IFTYPE_AP_VLAN))
	319	return -1;
	320	break;
	321	case cpu_to_le16(IEEE80211_FCTL_TODS \| IEEE80211_FCTL_FROMDS):
	322	if (unlikely(iftype != NL80211_IFTYPE_WDS &&
	323	iftype != NL80211_IFTYPE_MESH_POINT))
	324	return -1;
	325	if (iftype == NL80211_IFTYPE_MESH_POINT) {
	326	struct ieee80211s_hdr *meshdr =
	327	(struct ieee80211s_hdr *) (skb->data + hdrlen);
	328	hdrlen += ieee80211_get_mesh_hdrlen(meshdr);
	329	if (meshdr->flags & MESH_FLAGS_AE_A5_A6) {
	330	memcpy(dst, meshdr->eaddr1, ETH_ALEN);
	331	memcpy(src, meshdr->eaddr2, ETH_ALEN);
	332	}
	333	}
	334	break;
	335	case cpu_to_le16(IEEE80211_FCTL_FROMDS):
3c5772a5 JC	336	if ((iftype != NL80211_IFTYPE_STATION &&
3c5772a5 JC	337	iftype != NL80211_IFTYPE_MESH_POINT) \|\|
e31a16d6 ZY	338	(is_multicast_ether_addr(dst) &&
	339	!compare_ether_addr(src, addr)))
	340	return -1;
3c5772a5 JC	341	if (iftype == NL80211_IFTYPE_MESH_POINT) {
	342	struct ieee80211s_hdr *meshdr =
	343	(struct ieee80211s_hdr *) (skb->data + hdrlen);
	344	hdrlen += ieee80211_get_mesh_hdrlen(meshdr);
	345	if (meshdr->flags & MESH_FLAGS_AE_A4)
	346	memcpy(src, meshdr->eaddr1, ETH_ALEN);
	347	}
e31a16d6 ZY	348	break;
	349	case cpu_to_le16(0):
	350	if (iftype != NL80211_IFTYPE_ADHOC)
	351	return -1;
	352	break;
	353	}
	354
	355	if (unlikely(skb->len - hdrlen < 8))
	356	return -1;
	357
	358	payload = skb->data + hdrlen;
	359	ethertype = (payload[6] << 8) \| payload[7];
	360
	361	if (likely((compare_ether_addr(payload, rfc1042_header) == 0 &&
	362	ethertype != ETH_P_AARP && ethertype != ETH_P_IPX) \|\|
	363	compare_ether_addr(payload, bridge_tunnel_header) == 0)) {
	364	/* remove RFC1042 or Bridge-Tunnel encapsulation and
	365	* replace EtherType */
	366	skb_pull(skb, hdrlen + 6);
	367	memcpy(skb_push(skb, ETH_ALEN), src, ETH_ALEN);
	368	memcpy(skb_push(skb, ETH_ALEN), dst, ETH_ALEN);
	369	} else {
	370	struct ethhdr *ehdr;
	371	__be16 len;
	372
	373	skb_pull(skb, hdrlen);
	374	len = htons(skb->len);
	375	ehdr = (struct ethhdr *) skb_push(skb, sizeof(struct ethhdr));
	376	memcpy(ehdr->h_dest, dst, ETH_ALEN);
	377	memcpy(ehdr->h_source, src, ETH_ALEN);
	378	ehdr->h_proto = len;
	379	}
	380	return 0;
	381	}
	382	EXPORT_SYMBOL(ieee80211_data_to_8023);
	383
	384	int ieee80211_data_from_8023(struct sk_buff skb, u8 addr,
	385	enum nl80211_iftype iftype, u8 *bssid, bool qos)
	386	{
	387	struct ieee80211_hdr hdr;
	388	u16 hdrlen, ethertype;
	389	__le16 fc;
	390	const u8 *encaps_data;
	391	int encaps_len, skip_header_bytes;
	392	int nh_pos, h_pos;
	393	int head_need;
	394
	395	if (unlikely(skb->len < ETH_HLEN))
	396	return -EINVAL;
	397
	398	nh_pos = skb_network_header(skb) - skb->data;
	399	h_pos = skb_transport_header(skb) - skb->data;
	400
	401	/* convert Ethernet header to proper 802.11 header (based on
	402	* operation mode) */
	403	ethertype = (skb->data[12] << 8) \| skb->data[13];
	404	fc = cpu_to_le16(IEEE80211_FTYPE_DATA \| IEEE80211_STYPE_DATA);
	405
	406	switch (iftype) {
	407	case NL80211_IFTYPE_AP:
	408	case NL80211_IFTYPE_AP_VLAN:
	409	fc \|= cpu_to_le16(IEEE80211_FCTL_FROMDS);
	410	/* DA BSSID SA */
	411	memcpy(hdr.addr1, skb->data, ETH_ALEN);
412	memcpy(hdr.addr2, addr, ETH_ALEN);
413	memcpy(hdr.addr3, skb->data + ETH_ALEN, ETH_ALEN);
414	hdrlen = 24;
415	break;
416	case NL80211_IFTYPE_STATION:
417	fc \|= cpu_to_le16(IEEE80211_FCTL_TODS);
418	/* BSSID SA DA */
419	memcpy(hdr.addr1, bssid, ETH_ALEN);
420	memcpy(hdr.addr2, skb->data + ETH_ALEN, ETH_ALEN);
421	memcpy(hdr.addr3, skb->data, ETH_ALEN);
422	hdrlen = 24;
423	break;
424	case NL80211_IFTYPE_ADHOC:
425	/* DA SA BSSID */
426	memcpy(hdr.addr1, skb->data, ETH_ALEN);
427	memcpy(hdr.addr2, skb->data + ETH_ALEN, ETH_ALEN);
428	memcpy(hdr.addr3, bssid, ETH_ALEN);
429	hdrlen = 24;
430	break;
431	default:
432	return -EOPNOTSUPP;
433	}
434
435	if (qos) {
436	fc \|= cpu_to_le16(IEEE80211_STYPE_QOS_DATA);
437	hdrlen += 2;
438	}
439
440	hdr.frame_control = fc;
441	hdr.duration_id = 0;
442	hdr.seq_ctrl = 0;
443
444	skip_header_bytes = ETH_HLEN;
445	if (ethertype == ETH_P_AARP \|\| ethertype == ETH_P_IPX) {
446	encaps_data = bridge_tunnel_header;
447	encaps_len = sizeof(bridge_tunnel_header);
448	skip_header_bytes -= 2;
449	} else if (ethertype > 0x600) {
450	encaps_data = rfc1042_header;
451	encaps_len = sizeof(rfc1042_header);
452	skip_header_bytes -= 2;
453	} else {
454	encaps_data = NULL;
455	encaps_len = 0;
456	}
457
458	skb_pull(skb, skip_header_bytes);
459	nh_pos -= skip_header_bytes;
460	h_pos -= skip_header_bytes;
461
462	head_need = hdrlen + encaps_len - skb_headroom(skb);
463
464	if (head_need > 0 \|\| skb_cloned(skb)) {
465	head_need = max(head_need, 0);
466	if (head_need)
467	skb_orphan(skb);
468
469	if (pskb_expand_head(skb, head_need, 0, GFP_ATOMIC)) {
470	printk(KERN_ERR "failed to reallocate Tx buffer\n");
471	return -ENOMEM;
472	}
473	skb->truesize += head_need;
474	}
475
476	if (encaps_data) {
477	memcpy(skb_push(skb, encaps_len), encaps_data, encaps_len);
478	nh_pos += encaps_len;
479	h_pos += encaps_len;
480	}
481
482	memcpy(skb_push(skb, hdrlen), &hdr, hdrlen);
483
484	nh_pos += hdrlen;
485	h_pos += hdrlen;
486
487	/* Update skb pointers to various headers since this modified frame
488	* is going to go through Linux networking code that may potentially
489	* need things like pointer to IP header. */
490	skb_set_mac_header(skb, 0);
491	skb_set_network_header(skb, nh_pos);
492	skb_set_transport_header(skb, h_pos);
493
494	return 0;
495	}
496	EXPORT_SYMBOL(ieee80211_data_from_8023);
497
498	/* Given a data frame determine the 802.1p/1d tag to use. */
499	unsigned int cfg80211_classify8021d(struct sk_buff *skb)
500	{
501	unsigned int dscp;
502
503	/* skb->priority values from 256->263 are magic values to
504	* directly indicate a specific 802.1d priority. This is used
505	* to allow 802.1d priority to be passed directly in from VLAN
506	* tags, etc.
507	*/
508	if (skb->priority >= 256 && skb->priority <= 263)
509	return skb->priority - 256;
510
511	switch (skb->protocol) {
512	case htons(ETH_P_IP):
513	dscp = ip_hdr(skb)->tos & 0xfc;
514	break;
515	default:
516	return 0;
517	}
518
519	return dscp >> 5;
520	}
521	EXPORT_SYMBOL(cfg80211_classify8021d);
517357c6 JB	522
	523	const u8 ieee80211_bss_get_ie(struct cfg80211_bss bss, u8 ie)
	524	{
	525	u8 end, pos;
	526
	527	pos = bss->information_elements;
	528	if (pos == NULL)
	529	return NULL;
	530	end = pos + bss->len_information_elements;
	531
	532	while (pos + 1 < end) {
	533	if (pos + 2 + pos[1] > end)
	534	break;
	535	if (pos[0] == ie)
	536	return pos;
	537	pos += 2 + pos[1];
	538	}
	539
	540	return NULL;
	541	}
	542	EXPORT_SYMBOL(ieee80211_bss_get_ie);
fffd0934 JB	543
	544	void cfg80211_upload_connect_keys(struct wireless_dev *wdev)
	545	{
	546	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	547	struct net_device *dev = wdev->netdev;
	548	int i;
	549
	550	if (!wdev->connect_keys)
	551	return;
	552
	553	for (i = 0; i < 6; i++) {
	554	if (!wdev->connect_keys->params[i].cipher)
	555	continue;
	556	if (rdev->ops->add_key(wdev->wiphy, dev, i, NULL,
1e056665	557	&wdev->connect_keys->params[i])) {
fffd0934 JB	558	printk(KERN_ERR "%s: failed to set key %d\n",
fffd0934 JB	559	dev->name, i);
1e056665 ZY	560	continue;
1e056665 ZY	561	}
fffd0934	562	if (wdev->connect_keys->def == i)
1e056665	563	if (rdev->ops->set_default_key(wdev->wiphy, dev, i)) {
fffd0934 JB	564	printk(KERN_ERR "%s: failed to set defkey %d\n",
fffd0934 JB	565	dev->name, i);
1e056665 ZY	566	continue;
1e056665 ZY	567	}
fffd0934 JB	568	if (wdev->connect_keys->defmgmt == i)
	569	if (rdev->ops->set_default_mgmt_key(wdev->wiphy, dev, i))
	570	printk(KERN_ERR "%s: failed to set mgtdef %d\n",
	571	dev->name, i);
	572	}
	573
	574	kfree(wdev->connect_keys);
	575	wdev->connect_keys = NULL;
	576	}