1105 lines · 31.3 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0-only/* * Copyright (c) 2006	Jiri Benc <jbenc@suse.cz> * Copyright 2007	Johannes Berg <johannes@sipsolutions.net> * Copyright (C) 2020-2023 Intel Corporation */ #include <linux/kernel.h>#include <linux/device.h>#include <linux/hex.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" struct ieee80211_if_read_sdata_data {	ssize_t (*format)(const struct ieee80211_sub_if_data *, char *, int);	struct ieee80211_sub_if_data *sdata;}; static ssize_t ieee80211_if_read_sdata_handler(struct wiphy *wiphy,					       struct file *file,					       char *buf,					       size_t bufsize,					       void *data){	struct ieee80211_if_read_sdata_data *d = data; 	return d->format(d->sdata, buf, bufsize);} static ssize_t ieee80211_if_read_sdata(	struct file *file,	char __user *userbuf,	size_t count, loff_t *ppos,	ssize_t (*format)(const struct ieee80211_sub_if_data *sdata, char *, int)){	struct ieee80211_sub_if_data *sdata = file->private_data;	struct ieee80211_if_read_sdata_data data = {		.format = format,		.sdata = sdata,	};	char buf[200]; 	return wiphy_locked_debugfs_read(sdata->local->hw.wiphy,					 file, buf, sizeof(buf),					 userbuf, count, ppos,					 ieee80211_if_read_sdata_handler,					 &data);} struct ieee80211_if_write_sdata_data {	ssize_t (*write)(struct ieee80211_sub_if_data *, const char *, int);	struct ieee80211_sub_if_data *sdata;}; static ssize_t ieee80211_if_write_sdata_handler(struct wiphy *wiphy,						struct file *file,						char *buf,						size_t count,						void *data){	struct ieee80211_if_write_sdata_data *d = data; 	return d->write(d->sdata, buf, count);} static ssize_t ieee80211_if_write_sdata(	struct file *file,	const char __user *userbuf,	size_t count, loff_t *ppos,	ssize_t (*write)(struct ieee80211_sub_if_data *sdata, const char *, int)){	struct ieee80211_sub_if_data *sdata = file->private_data;	struct ieee80211_if_write_sdata_data data = {		.write = write,		.sdata = sdata,	};	char buf[64]; 	return wiphy_locked_debugfs_write(sdata->local->hw.wiphy,					  file, buf, sizeof(buf),					  userbuf, count,					  ieee80211_if_write_sdata_handler,					  &data);} struct ieee80211_if_read_link_data {	ssize_t (*format)(const struct ieee80211_link_data *, char *, int);	struct ieee80211_link_data *link;}; static ssize_t ieee80211_if_read_link_handler(struct wiphy *wiphy,					      struct file *file,					      char *buf,					      size_t bufsize,					      void *data){	struct ieee80211_if_read_link_data *d = data; 	return d->format(d->link, buf, bufsize);} static ssize_t ieee80211_if_read_link(	struct file *file,	char __user *userbuf,	size_t count, loff_t *ppos,	ssize_t (*format)(const struct ieee80211_link_data *link, char *, int)){	struct ieee80211_link_data *link = file->private_data;	struct ieee80211_if_read_link_data data = {		.format = format,		.link = link,	};	char buf[200]; 	return wiphy_locked_debugfs_read(link->sdata->local->hw.wiphy,					 file, buf, sizeof(buf),					 userbuf, count, ppos,					 ieee80211_if_read_link_handler,					 &data);} struct ieee80211_if_write_link_data {	ssize_t (*write)(struct ieee80211_link_data *, const char *, int);	struct ieee80211_link_data *link;}; static ssize_t ieee80211_if_write_link_handler(struct wiphy *wiphy,					       struct file *file,					       char *buf,					       size_t count,					       void *data){	struct ieee80211_if_write_sdata_data *d = data; 	return d->write(d->sdata, buf, count);} static ssize_t ieee80211_if_write_link(	struct file *file,	const char __user *userbuf,	size_t count, loff_t *ppos,	ssize_t (*write)(struct ieee80211_link_data *link, const char *, int)){	struct ieee80211_link_data *link = file->private_data;	struct ieee80211_if_write_link_data data = {		.write = write,		.link = link,	};	char buf[64]; 	return wiphy_locked_debugfs_write(link->sdata->local->hw.wiphy,					  file, buf, sizeof(buf),					  userbuf, count,					  ieee80211_if_write_link_handler,					  &data);} #define IEEE80211_IF_FMT(name, type, field, format_string)		\static ssize_t ieee80211_if_fmt_##name(					\	const type *data, char *buf,					\	int buflen)							\{									\	return scnprintf(buf, buflen, format_string, data->field);	\}#define IEEE80211_IF_FMT_DEC(name, type, field)				\		IEEE80211_IF_FMT(name, type, field, "%d\n")#define IEEE80211_IF_FMT_HEX(name, type, field)				\		IEEE80211_IF_FMT(name, type, field, "%#x\n")#define IEEE80211_IF_FMT_LHEX(name, type, field)			\		IEEE80211_IF_FMT(name, type, field, "%#lx\n") #define IEEE80211_IF_FMT_HEXARRAY(name, type, field)			\static ssize_t ieee80211_if_fmt_##name(					\	const type *data,						\	char *buf, int buflen)						\{									\	char *p = buf;							\	int i;								\	for (i = 0; i < sizeof(data->field); i++) {			\		p += scnprintf(p, buflen + buf - p, "%.2x ",		\				 data->field[i]);			\	}								\	p += scnprintf(p, buflen + buf - p, "\n");			\	return p - buf;							\} #define IEEE80211_IF_FMT_ATOMIC(name, type, field)			\static ssize_t ieee80211_if_fmt_##name(					\	const type *data,						\	char *buf, int buflen)						\{									\	return scnprintf(buf, buflen, "%d\n", atomic_read(&data->field));\} #define IEEE80211_IF_FMT_MAC(name, type, field)				\static ssize_t ieee80211_if_fmt_##name(					\	const type *data, char *buf,					\	int buflen)							\{									\	return scnprintf(buf, buflen, "%pM\n", data->field);		\} #define IEEE80211_IF_FMT_JIFFIES_TO_MS(name, type, field)		\static ssize_t ieee80211_if_fmt_##name(					\	const type *data,						\	char *buf, int buflen)						\{									\	return scnprintf(buf, buflen, "%d\n",				\			 jiffies_to_msecs(data->field));		\} #define _IEEE80211_IF_FILE_OPS(name, _read, _write)			\static const struct debugfs_short_fops name##_ops = {				\	.read = (_read),						\	.write = (_write),						\	.llseek = generic_file_llseek,					\} #define _IEEE80211_IF_FILE_R_FN(name)					\static ssize_t ieee80211_if_read_##name(struct file *file,		\					char __user *userbuf,		\					size_t count, loff_t *ppos)	\{									\	return ieee80211_if_read_sdata(file,				\				       userbuf, count, ppos,		\				       ieee80211_if_fmt_##name);	\} #define _IEEE80211_IF_FILE_W_FN(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_sdata(file, userbuf,			\					count, ppos,			\					ieee80211_if_parse_##name);	\} #define IEEE80211_IF_FILE_R(name)					\	_IEEE80211_IF_FILE_R_FN(name)					\	_IEEE80211_IF_FILE_OPS(name, ieee80211_if_read_##name, NULL) #define IEEE80211_IF_FILE_W(name)					\	_IEEE80211_IF_FILE_W_FN(name)					\	_IEEE80211_IF_FILE_OPS(name, NULL, ieee80211_if_write_##name) #define IEEE80211_IF_FILE_RW(name)					\	_IEEE80211_IF_FILE_R_FN(name)					\	_IEEE80211_IF_FILE_W_FN(name)					\	_IEEE80211_IF_FILE_OPS(name, ieee80211_if_read_##name,		\			       ieee80211_if_write_##name) #define IEEE80211_IF_FILE(name, field, format)				\	IEEE80211_IF_FMT_##format(name, struct ieee80211_sub_if_data, field) \	IEEE80211_IF_FILE_R(name) #define _IEEE80211_IF_LINK_R_FN(name)					\static ssize_t ieee80211_if_read_##name(struct file *file,		\					char __user *userbuf,		\					size_t count, loff_t *ppos)	\{									\	return ieee80211_if_read_link(file,				\				      userbuf, count, ppos,		\				      ieee80211_if_fmt_##name);	\} #define _IEEE80211_IF_LINK_W_FN(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_link(file, userbuf,			\				       count, ppos,			\				       ieee80211_if_parse_##name);	\} #define IEEE80211_IF_LINK_FILE_R(name)					\	_IEEE80211_IF_LINK_R_FN(name)					\	_IEEE80211_IF_FILE_OPS(link_##name, ieee80211_if_read_##name, NULL) #define IEEE80211_IF_LINK_FILE_W(name)					\	_IEEE80211_IF_LINK_W_FN(name)					\	_IEEE80211_IF_FILE_OPS(link_##name, NULL, ieee80211_if_write_##name) #define IEEE80211_IF_LINK_FILE_RW(name)					\	_IEEE80211_IF_LINK_R_FN(name)					\	_IEEE80211_IF_LINK_W_FN(name)					\	_IEEE80211_IF_FILE_OPS(link_##name, ieee80211_if_read_##name,	\			       ieee80211_if_write_##name) #define IEEE80211_IF_LINK_FILE(name, field, format)				\	IEEE80211_IF_FMT_##format(name, struct ieee80211_link_data, field) \	IEEE80211_IF_LINK_FILE_R(name) /* common attributes */IEEE80211_IF_FILE(rc_rateidx_mask_2ghz, rc_rateidx_mask[NL80211_BAND_2GHZ],		  HEX);IEEE80211_IF_FILE(rc_rateidx_mask_5ghz, rc_rateidx_mask[NL80211_BAND_5GHZ],		  HEX);IEEE80211_IF_FILE(rc_rateidx_mcs_mask_2ghz,		  rc_rateidx_mcs_mask[NL80211_BAND_2GHZ], HEXARRAY);IEEE80211_IF_FILE(rc_rateidx_mcs_mask_5ghz,		  rc_rateidx_mcs_mask[NL80211_BAND_5GHZ], HEXARRAY); static ssize_t ieee80211_if_fmt_rc_rateidx_vht_mcs_mask_2ghz(				const struct ieee80211_sub_if_data *sdata,				char *buf, int buflen){	int i, len = 0;	const u16 *mask = sdata->rc_rateidx_vht_mcs_mask[NL80211_BAND_2GHZ]; 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++)		len += scnprintf(buf + len, buflen - len, "%04x ", mask[i]);	len += scnprintf(buf + len, buflen - len, "\n"); 	return len;} IEEE80211_IF_FILE_R(rc_rateidx_vht_mcs_mask_2ghz); static ssize_t ieee80211_if_fmt_rc_rateidx_vht_mcs_mask_5ghz(				const struct ieee80211_sub_if_data *sdata,				char *buf, int buflen){	int i, len = 0;	const u16 *mask = sdata->rc_rateidx_vht_mcs_mask[NL80211_BAND_5GHZ]; 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++)		len += scnprintf(buf + len, buflen - len, "%04x ", mask[i]);	len += scnprintf(buf + len, buflen - len, "\n"); 	return len;} IEEE80211_IF_FILE_R(rc_rateidx_vht_mcs_mask_5ghz); IEEE80211_IF_FILE(flags, flags, HEX);IEEE80211_IF_FILE(state, state, LHEX);IEEE80211_IF_LINK_FILE(txpower, conf->txpower, DEC);IEEE80211_IF_LINK_FILE(ap_power_level, ap_power_level, DEC);IEEE80211_IF_LINK_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_R(hw_queues); /* STA attributes */IEEE80211_IF_FILE(bssid, deflink.u.mgd.bssid, MAC);IEEE80211_IF_FILE(aid, vif.cfg.aid, DEC);IEEE80211_IF_FILE(beacon_timeout, u.mgd.beacon_timeout, JIFFIES_TO_MS); static int ieee80211_set_smps(struct ieee80211_link_data *link,			      enum ieee80211_smps_mode smps_mode){	struct ieee80211_sub_if_data *sdata = link->sdata;	struct ieee80211_local *local = sdata->local; 	/* The driver indicated that EML is enabled for the interface, thus do	 * not allow to override the SMPS state.	 */	if (sdata->vif.driver_flags & IEEE80211_VIF_EML_ACTIVE)		return -EOPNOTSUPP; 	if (!(local->hw.wiphy->features & NL80211_FEATURE_STATIC_SMPS) &&	    smps_mode == IEEE80211_SMPS_STATIC)		return -EINVAL; 	/* auto should be dynamic if in PS mode */	if (!(local->hw.wiphy->features & NL80211_FEATURE_DYNAMIC_SMPS) &&	    (smps_mode == IEEE80211_SMPS_DYNAMIC ||	     smps_mode == IEEE80211_SMPS_AUTOMATIC))		return -EINVAL; 	if (sdata->vif.type != NL80211_IFTYPE_STATION)		return -EOPNOTSUPP; 	return __ieee80211_request_smps_mgd(link->sdata, link, smps_mode);} 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_link_data *link,				     char *buf, int buflen){	if (link->sdata->vif.type == NL80211_IFTYPE_STATION)		return snprintf(buf, buflen, "request: %s\nused: %s\n",				smps_modes[link->u.mgd.req_smps],				smps_modes[link->smps_mode]);	return -EINVAL;} static ssize_t ieee80211_if_parse_smps(struct ieee80211_link_data *link,				       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(link, mode);			if (!err)				return buflen;			return err;		}	} 	return -EINVAL;}IEEE80211_IF_LINK_FILE_RW(smps); 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 = skb_put_zero(skb, 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 */		if (!sdata->u.mgd.associated) {			dev_kfree_skb(skb);			return -ENOTCONN;		}		memcpy(hdr->addr1, sdata->deflink.u.mgd.bssid, ETH_ALEN);		memcpy(hdr->addr2, sdata->vif.addr, ETH_ALEN);		memcpy(hdr->addr3, addr, ETH_ALEN);		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.	 */	skb_put_zero(skb, 50); 	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_TKIP_MIC_FAILURE; 	ieee80211_tx_skb(sdata, skb);

Lines 1–500 of 1105.