Emmanuel Grumbachmac80211: implement SMPS for AP687da1313 years agoHistory
727 lines · 20.8 KB · C
RawDownload
/* * Copyright (c) 2006	Jiri Benc <jbenc@suse.cz> * Copyright 2007	Johannes Berg <johannes@sipsolutions.net> * * 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/kernel.h>#include <linux/device.h>#include <linux/if.h>#include <linux/if_ether.h>#include <linux/interrupt.h>#include <linux/netdevice.h>#include <linux/rtnetlink.h>#include <linux/slab.h>#include <linux/notifier.h>#include <net/mac80211.h>#include <net/cfg80211.h>#include "ieee80211_i.h"#include "rate.h"#include "debugfs.h"#include "debugfs_netdev.h"#include "driver-ops.h" static ssize_t ieee80211_if_read(	struct ieee80211_sub_if_data *sdata,	char __user *userbuf,	size_t count, loff_t *ppos,	ssize_t (*format)(const struct ieee80211_sub_if_data *, char *, int)){	char buf[70];	ssize_t ret = -EINVAL; 	read_lock(&dev_base_lock);	if (sdata->dev->reg_state == NETREG_REGISTERED)		ret = (*format)(sdata, buf, sizeof(buf));	read_unlock(&dev_base_lock); 	if (ret >= 0)		ret = simple_read_from_buffer(userbuf, count, ppos, buf, ret); 	return ret;} static ssize_t ieee80211_if_write(	struct ieee80211_sub_if_data *sdata,	const char __user *userbuf,	size_t count, loff_t *ppos,	ssize_t (*write)(struct ieee80211_sub_if_data *, const char *, int)){	char buf[64];	ssize_t ret; 	if (count >= sizeof(buf))		return -E2BIG; 	if (copy_from_user(buf, userbuf, count))		return -EFAULT;	buf[count] = '\0'; 	ret = -ENODEV;	rtnl_lock();	if (sdata->dev->reg_state == NETREG_REGISTERED)		ret = (*write)(sdata, buf, count);	rtnl_unlock(); 	return ret;} #define IEEE80211_IF_FMT(name, field, format_string)			\static ssize_t ieee80211_if_fmt_##name(					\	const struct ieee80211_sub_if_data *sdata, char *buf,		\	int buflen)							\{									\	return scnprintf(buf, buflen, format_string, sdata->field);	\}#define IEEE80211_IF_FMT_DEC(name, field)				\		IEEE80211_IF_FMT(name, field, "%d\n")#define IEEE80211_IF_FMT_HEX(name, field)				\		IEEE80211_IF_FMT(name, field, "%#x\n")#define IEEE80211_IF_FMT_LHEX(name, field)				\		IEEE80211_IF_FMT(name, field, "%#lx\n")#define IEEE80211_IF_FMT_SIZE(name, field)				\		IEEE80211_IF_FMT(name, field, "%zd\n") #define IEEE80211_IF_FMT_HEXARRAY(name, field)				\static ssize_t ieee80211_if_fmt_##name(					\	const struct ieee80211_sub_if_data *sdata,			\	char *buf, int buflen)						\{									\	char *p = buf;							\	int i;								\	for (i = 0; i < sizeof(sdata->field); i++) {			\		p += scnprintf(p, buflen + buf - p, "%.2x ",		\				 sdata->field[i]);			\	}								\	p += scnprintf(p, buflen + buf - p, "\n");			\	return p - buf;							\} #define IEEE80211_IF_FMT_ATOMIC(name, field)				\static ssize_t ieee80211_if_fmt_##name(					\	const struct ieee80211_sub_if_data *sdata,			\	char *buf, int buflen)						\{									\	return scnprintf(buf, buflen, "%d\n", atomic_read(&sdata->field));\} #define IEEE80211_IF_FMT_MAC(name, field)				\static ssize_t ieee80211_if_fmt_##name(					\	const struct ieee80211_sub_if_data *sdata, char *buf,		\	int buflen)							\{									\	return scnprintf(buf, buflen, "%pM\n", sdata->field);		\} #define IEEE80211_IF_FMT_DEC_DIV_16(name, field)			\static ssize_t ieee80211_if_fmt_##name(					\	const struct ieee80211_sub_if_data *sdata,			\	char *buf, int buflen)						\{									\	return scnprintf(buf, buflen, "%d\n", sdata->field / 16);	\} #define IEEE80211_IF_FMT_JIFFIES_TO_MS(name, field)			\static ssize_t ieee80211_if_fmt_##name(					\	const struct ieee80211_sub_if_data *sdata,			\	char *buf, int buflen)						\{									\	return scnprintf(buf, buflen, "%d\n",				\			 jiffies_to_msecs(sdata->field));		\} #define __IEEE80211_IF_FILE(name, _write)				\static ssize_t ieee80211_if_read_##name(struct file *file,		\					char __user *userbuf,		\					size_t count, loff_t *ppos)	\{									\	return ieee80211_if_read(file->private_data,			\				 userbuf, count, ppos,			\				 ieee80211_if_fmt_##name);		\}									\static const struct file_operations name##_ops = {			\	.read = ieee80211_if_read_##name,				\	.write = (_write),						\	.open = simple_open,						\	.llseek = generic_file_llseek,					\} #define __IEEE80211_IF_FILE_W(name)					\static ssize_t ieee80211_if_write_##name(struct file *file,		\					 const char __user *userbuf,	\					 size_t count, loff_t *ppos)	\{									\	return ieee80211_if_write(file->private_data, userbuf, count,	\				  ppos, ieee80211_if_parse_##name);	\}									\__IEEE80211_IF_FILE(name, ieee80211_if_write_##name)  #define IEEE80211_IF_FILE(name, field, format)				\		IEEE80211_IF_FMT_##format(name, field)			\		__IEEE80211_IF_FILE(name, NULL) /* common attributes */IEEE80211_IF_FILE(drop_unencrypted, drop_unencrypted, DEC);IEEE80211_IF_FILE(rc_rateidx_mask_2ghz, rc_rateidx_mask[IEEE80211_BAND_2GHZ],		  HEX);IEEE80211_IF_FILE(rc_rateidx_mask_5ghz, rc_rateidx_mask[IEEE80211_BAND_5GHZ],		  HEX);IEEE80211_IF_FILE(rc_rateidx_mcs_mask_2ghz,		  rc_rateidx_mcs_mask[IEEE80211_BAND_2GHZ], HEXARRAY);IEEE80211_IF_FILE(rc_rateidx_mcs_mask_5ghz,		  rc_rateidx_mcs_mask[IEEE80211_BAND_5GHZ], HEXARRAY); IEEE80211_IF_FILE(flags, flags, HEX);IEEE80211_IF_FILE(state, state, LHEX);IEEE80211_IF_FILE(txpower, vif.bss_conf.txpower, DEC);IEEE80211_IF_FILE(ap_power_level, ap_power_level, DEC);IEEE80211_IF_FILE(user_power_level, user_power_level, DEC); static ssize_tieee80211_if_fmt_hw_queues(const struct ieee80211_sub_if_data *sdata,			   char *buf, int buflen){	int len; 	len = scnprintf(buf, buflen, "AC queues: VO:%d VI:%d BE:%d BK:%d\n",			sdata->vif.hw_queue[IEEE80211_AC_VO],			sdata->vif.hw_queue[IEEE80211_AC_VI],			sdata->vif.hw_queue[IEEE80211_AC_BE],			sdata->vif.hw_queue[IEEE80211_AC_BK]); 	if (sdata->vif.type == NL80211_IFTYPE_AP)		len += scnprintf(buf + len, buflen - len, "cab queue: %d\n",				 sdata->vif.cab_queue); 	return len;}__IEEE80211_IF_FILE(hw_queues, NULL); /* STA attributes */IEEE80211_IF_FILE(bssid, u.mgd.bssid, MAC);IEEE80211_IF_FILE(aid, u.mgd.aid, DEC);IEEE80211_IF_FILE(last_beacon, u.mgd.last_beacon_signal, DEC);IEEE80211_IF_FILE(ave_beacon, u.mgd.ave_beacon_signal, DEC_DIV_16);IEEE80211_IF_FILE(beacon_timeout, u.mgd.beacon_timeout, JIFFIES_TO_MS); static int ieee80211_set_smps(struct ieee80211_sub_if_data *sdata,			      enum ieee80211_smps_mode smps_mode){	struct ieee80211_local *local = sdata->local;	int err; 	if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_STATIC_SMPS) &&	    smps_mode == IEEE80211_SMPS_STATIC)		return -EINVAL; 	/* auto should be dynamic if in PS mode */	if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS) &&	    (smps_mode == IEEE80211_SMPS_DYNAMIC ||	     smps_mode == IEEE80211_SMPS_AUTOMATIC))		return -EINVAL; 	if (sdata->vif.type != NL80211_IFTYPE_STATION &&	    sdata->vif.type != NL80211_IFTYPE_AP)		return -EOPNOTSUPP; 	sdata_lock(sdata);	if (sdata->vif.type == NL80211_IFTYPE_STATION)		err = __ieee80211_request_smps_mgd(sdata, smps_mode);	else		err = __ieee80211_request_smps_ap(sdata, smps_mode);	sdata_unlock(sdata); 	return err;} static const char *smps_modes[IEEE80211_SMPS_NUM_MODES] = {	[IEEE80211_SMPS_AUTOMATIC] = "auto",	[IEEE80211_SMPS_OFF] = "off",	[IEEE80211_SMPS_STATIC] = "static",	[IEEE80211_SMPS_DYNAMIC] = "dynamic",}; static ssize_t ieee80211_if_fmt_smps(const struct ieee80211_sub_if_data *sdata,				     char *buf, int buflen){	if (sdata->vif.type == NL80211_IFTYPE_STATION)		return snprintf(buf, buflen, "request: %s\nused: %s\n",				smps_modes[sdata->u.mgd.req_smps],				smps_modes[sdata->smps_mode]);	if (sdata->vif.type == NL80211_IFTYPE_AP)		return snprintf(buf, buflen, "request: %s\nused: %s\n",				smps_modes[sdata->u.ap.req_smps],				smps_modes[sdata->smps_mode]);	return -EINVAL;} static ssize_t ieee80211_if_parse_smps(struct ieee80211_sub_if_data *sdata,				       const char *buf, int buflen){	enum ieee80211_smps_mode mode; 	for (mode = 0; mode < IEEE80211_SMPS_NUM_MODES; mode++) {		if (strncmp(buf, smps_modes[mode], buflen) == 0) {			int err = ieee80211_set_smps(sdata, mode);			if (!err)				return buflen;			return err;		}	} 	return -EINVAL;} __IEEE80211_IF_FILE_W(smps); static ssize_t ieee80211_if_fmt_tkip_mic_test(	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen){	return -EOPNOTSUPP;} static ssize_t ieee80211_if_parse_tkip_mic_test(	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen){	struct ieee80211_local *local = sdata->local;	u8 addr[ETH_ALEN];	struct sk_buff *skb;	struct ieee80211_hdr *hdr;	__le16 fc; 	if (!mac_pton(buf, addr))		return -EINVAL; 	if (!ieee80211_sdata_running(sdata))		return -ENOTCONN; 	skb = dev_alloc_skb(local->hw.extra_tx_headroom + 24 + 100);	if (!skb)		return -ENOMEM;	skb_reserve(skb, local->hw.extra_tx_headroom); 	hdr = (struct ieee80211_hdr *) skb_put(skb, 24);	memset(hdr, 0, 24);	fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_DATA); 	switch (sdata->vif.type) {	case NL80211_IFTYPE_AP:		fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS);		/* DA BSSID SA */		memcpy(hdr->addr1, addr, ETH_ALEN);		memcpy(hdr->addr2, sdata->vif.addr, ETH_ALEN);		memcpy(hdr->addr3, sdata->vif.addr, ETH_ALEN);		break;	case NL80211_IFTYPE_STATION:		fc |= cpu_to_le16(IEEE80211_FCTL_TODS);		/* BSSID SA DA */		sdata_lock(sdata);		if (!sdata->u.mgd.associated) {			sdata_unlock(sdata);			dev_kfree_skb(skb);			return -ENOTCONN;		}		memcpy(hdr->addr1, sdata->u.mgd.associated->bssid, ETH_ALEN);		memcpy(hdr->addr2, sdata->vif.addr, ETH_ALEN);		memcpy(hdr->addr3, addr, ETH_ALEN);		sdata_unlock(sdata);		break;	default:		dev_kfree_skb(skb);		return -EOPNOTSUPP;	}	hdr->frame_control = fc; 	/*	 * Add some length to the test frame to make it look bit more valid.	 * The exact contents does not matter since the recipient is required	 * to drop this because of the Michael MIC failure.	 */	memset(skb_put(skb, 50), 0, 50); 	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_TKIP_MIC_FAILURE; 	ieee80211_tx_skb(sdata, skb); 	return buflen;} __IEEE80211_IF_FILE_W(tkip_mic_test); static ssize_t ieee80211_if_fmt_uapsd_queues(	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen){	const struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; 	return snprintf(buf, buflen, "0x%x\n", ifmgd->uapsd_queues);} static ssize_t ieee80211_if_parse_uapsd_queues(	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen){	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;	u8 val;	int ret; 	ret = kstrtou8(buf, 0, &val);	if (ret)		return ret; 	if (val & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)		return -ERANGE; 	ifmgd->uapsd_queues = val; 	return buflen;}__IEEE80211_IF_FILE_W(uapsd_queues); static ssize_t ieee80211_if_fmt_uapsd_max_sp_len(	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen){	const struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; 	return snprintf(buf, buflen, "0x%x\n", ifmgd->uapsd_max_sp_len);} static ssize_t ieee80211_if_parse_uapsd_max_sp_len(	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen){	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;	unsigned long val;	int ret; 	ret = kstrtoul(buf, 0, &val);	if (ret)		return -EINVAL; 	if (val & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)		return -ERANGE; 	ifmgd->uapsd_max_sp_len = val; 	return buflen;}__IEEE80211_IF_FILE_W(uapsd_max_sp_len); /* AP attributes */IEEE80211_IF_FILE(num_mcast_sta, u.ap.num_mcast_sta, ATOMIC);IEEE80211_IF_FILE(num_sta_ps, u.ap.ps.num_sta_ps, ATOMIC);IEEE80211_IF_FILE(dtim_count, u.ap.ps.dtim_count, DEC); static ssize_t ieee80211_if_fmt_num_buffered_multicast(	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen){	return scnprintf(buf, buflen, "%u\n",			 skb_queue_len(&sdata->u.ap.ps.bc_buf));}__IEEE80211_IF_FILE(num_buffered_multicast, NULL); /* IBSS attributes */static ssize_t ieee80211_if_fmt_tsf(	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen){	struct ieee80211_local *local = sdata->local;	u64 tsf; 	tsf = drv_get_tsf(local, (struct ieee80211_sub_if_data *)sdata); 	return scnprintf(buf, buflen, "0x%016llx\n", (unsigned long long) tsf);} static ssize_t ieee80211_if_parse_tsf(	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen){	struct ieee80211_local *local = sdata->local;	unsigned long long tsf;	int ret;	int tsf_is_delta = 0; 	if (strncmp(buf, "reset", 5) == 0) {		if (local->ops->reset_tsf) {			drv_reset_tsf(local, sdata);			wiphy_info(local->hw.wiphy, "debugfs reset TSF\n");		}	} else {		if (buflen > 10 && buf[1] == '=') {			if (buf[0] == '+')				tsf_is_delta = 1;			else if (buf[0] == '-')				tsf_is_delta = -1;			else				return -EINVAL;			buf += 2;		}		ret = kstrtoull(buf, 10, &tsf);		if (ret < 0)			return ret;		if (tsf_is_delta)			tsf = drv_get_tsf(local, sdata) + tsf_is_delta * tsf;		if (local->ops->set_tsf) {			drv_set_tsf(local, sdata, tsf);			wiphy_info(local->hw.wiphy,				   "debugfs set TSF to %#018llx\n", tsf);		}	} 	return buflen;}__IEEE80211_IF_FILE_W(tsf);  /* WDS attributes */IEEE80211_IF_FILE(peer, u.wds.remote_addr, MAC); #ifdef CONFIG_MAC80211_MESHIEEE80211_IF_FILE(estab_plinks, u.mesh.estab_plinks, ATOMIC); /* Mesh stats attributes */IEEE80211_IF_FILE(fwded_mcast, u.mesh.mshstats.fwded_mcast, DEC);IEEE80211_IF_FILE(fwded_unicast, u.mesh.mshstats.fwded_unicast, DEC);IEEE80211_IF_FILE(fwded_frames, u.mesh.mshstats.fwded_frames, DEC);IEEE80211_IF_FILE(dropped_frames_ttl, u.mesh.mshstats.dropped_frames_ttl, DEC);IEEE80211_IF_FILE(dropped_frames_congestion,		  u.mesh.mshstats.dropped_frames_congestion, DEC);IEEE80211_IF_FILE(dropped_frames_no_route,		  u.mesh.mshstats.dropped_frames_no_route, DEC); /* Mesh parameters */IEEE80211_IF_FILE(dot11MeshMaxRetries,		  u.mesh.mshcfg.dot11MeshMaxRetries, DEC);IEEE80211_IF_FILE(dot11MeshRetryTimeout,		  u.mesh.mshcfg.dot11MeshRetryTimeout, DEC);IEEE80211_IF_FILE(dot11MeshConfirmTimeout,		  u.mesh.mshcfg.dot11MeshConfirmTimeout, DEC);IEEE80211_IF_FILE(dot11MeshHoldingTimeout,		  u.mesh.mshcfg.dot11MeshHoldingTimeout, DEC);

Lines 1–500 of 727.