| /* | 
 |  * 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/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" | 
 |  | 
 | 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 != -EINVAL) | 
 | 		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)) | 
 | { | 
 | 	u8 *buf; | 
 | 	ssize_t ret; | 
 |  | 
 | 	buf = kmalloc(count, GFP_KERNEL); | 
 | 	if (!buf) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	ret = -EFAULT; | 
 | 	if (copy_from_user(buf, userbuf, count)) | 
 | 		goto freebuf; | 
 |  | 
 | 	ret = -ENODEV; | 
 | 	rtnl_lock(); | 
 | 	if (sdata->dev->reg_state == NETREG_REGISTERED) | 
 | 		ret = (*write)(sdata, buf, count); | 
 | 	rtnl_unlock(); | 
 |  | 
 | freebuf: | 
 | 	kfree(buf); | 
 | 	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_SIZE(name, field)				\ | 
 | 		IEEE80211_IF_FMT(name, field, "%zd\n") | 
 |  | 
 | #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_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 = mac80211_open_file_generic,				\ | 
 | } | 
 |  | 
 | #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); | 
 |  | 
 | /* 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); | 
 |  | 
 | 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; | 
 |  | 
 | 	/* supported only on managed interfaces for now */ | 
 | 	if (sdata->vif.type != NL80211_IFTYPE_STATION) | 
 | 		return -EOPNOTSUPP; | 
 |  | 
 | 	mutex_lock(&local->iflist_mtx); | 
 | 	err = __ieee80211_request_smps(sdata, smps_mode); | 
 | 	mutex_unlock(&local->iflist_mtx); | 
 |  | 
 | 	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 -EOPNOTSUPP; | 
 |  | 
 | 	return snprintf(buf, buflen, "request: %s\nused: %s\n", | 
 | 			smps_modes[sdata->u.mgd.req_smps], | 
 | 			smps_modes[sdata->u.mgd.ap_smps]); | 
 | } | 
 |  | 
 | 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); | 
 |  | 
 | /* AP attributes */ | 
 | IEEE80211_IF_FILE(num_sta_ps, u.ap.num_sta_ps, ATOMIC); | 
 | IEEE80211_IF_FILE(dtim_count, u.ap.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); | 
 |  | 
 | /* WDS attributes */ | 
 | IEEE80211_IF_FILE(peer, u.wds.remote_addr, MAC); | 
 |  | 
 | #ifdef CONFIG_MAC80211_MESH | 
 | /* 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_no_route, | 
 | 		u.mesh.mshstats.dropped_frames_no_route, DEC); | 
 | IEEE80211_IF_FILE(estab_plinks, u.mesh.mshstats.estab_plinks, ATOMIC); | 
 |  | 
 | /* 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); | 
 | IEEE80211_IF_FILE(dot11MeshTTL, u.mesh.mshcfg.dot11MeshTTL, DEC); | 
 | IEEE80211_IF_FILE(auto_open_plinks, u.mesh.mshcfg.auto_open_plinks, DEC); | 
 | IEEE80211_IF_FILE(dot11MeshMaxPeerLinks, | 
 | 		u.mesh.mshcfg.dot11MeshMaxPeerLinks, DEC); | 
 | IEEE80211_IF_FILE(dot11MeshHWMPactivePathTimeout, | 
 | 		u.mesh.mshcfg.dot11MeshHWMPactivePathTimeout, DEC); | 
 | IEEE80211_IF_FILE(dot11MeshHWMPpreqMinInterval, | 
 | 		u.mesh.mshcfg.dot11MeshHWMPpreqMinInterval, DEC); | 
 | IEEE80211_IF_FILE(dot11MeshHWMPnetDiameterTraversalTime, | 
 | 		u.mesh.mshcfg.dot11MeshHWMPnetDiameterTraversalTime, DEC); | 
 | IEEE80211_IF_FILE(dot11MeshHWMPmaxPREQretries, | 
 | 		u.mesh.mshcfg.dot11MeshHWMPmaxPREQretries, DEC); | 
 | IEEE80211_IF_FILE(path_refresh_time, | 
 | 		u.mesh.mshcfg.path_refresh_time, DEC); | 
 | IEEE80211_IF_FILE(min_discovery_timeout, | 
 | 		u.mesh.mshcfg.min_discovery_timeout, DEC); | 
 | IEEE80211_IF_FILE(dot11MeshHWMPRootMode, | 
 | 		u.mesh.mshcfg.dot11MeshHWMPRootMode, DEC); | 
 | #endif | 
 |  | 
 |  | 
 | #define DEBUGFS_ADD(name) \ | 
 | 	debugfs_create_file(#name, 0400, sdata->debugfs.dir, \ | 
 | 			    sdata, &name##_ops); | 
 |  | 
 | #define DEBUGFS_ADD_MODE(name, mode) \ | 
 | 	debugfs_create_file(#name, mode, sdata->debugfs.dir, \ | 
 | 			    sdata, &name##_ops); | 
 |  | 
 | static void add_sta_files(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	DEBUGFS_ADD(drop_unencrypted); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_2ghz); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_5ghz); | 
 |  | 
 | 	DEBUGFS_ADD(bssid); | 
 | 	DEBUGFS_ADD(aid); | 
 | 	DEBUGFS_ADD(last_beacon); | 
 | 	DEBUGFS_ADD(ave_beacon); | 
 | 	DEBUGFS_ADD_MODE(smps, 0600); | 
 | } | 
 |  | 
 | static void add_ap_files(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	DEBUGFS_ADD(drop_unencrypted); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_2ghz); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_5ghz); | 
 |  | 
 | 	DEBUGFS_ADD(num_sta_ps); | 
 | 	DEBUGFS_ADD(dtim_count); | 
 | 	DEBUGFS_ADD(num_buffered_multicast); | 
 | } | 
 |  | 
 | static void add_wds_files(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	DEBUGFS_ADD(drop_unencrypted); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_2ghz); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_5ghz); | 
 |  | 
 | 	DEBUGFS_ADD(peer); | 
 | } | 
 |  | 
 | static void add_vlan_files(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	DEBUGFS_ADD(drop_unencrypted); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_2ghz); | 
 | 	DEBUGFS_ADD(rc_rateidx_mask_5ghz); | 
 | } | 
 |  | 
 | static void add_monitor_files(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | } | 
 |  | 
 | #ifdef CONFIG_MAC80211_MESH | 
 |  | 
 | static void add_mesh_stats(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	struct dentry *dir = debugfs_create_dir("mesh_stats", | 
 | 						sdata->debugfs.dir); | 
 |  | 
 | #define MESHSTATS_ADD(name)\ | 
 | 	debugfs_create_file(#name, 0400, dir, sdata, &name##_ops); | 
 |  | 
 | 	MESHSTATS_ADD(fwded_mcast); | 
 | 	MESHSTATS_ADD(fwded_unicast); | 
 | 	MESHSTATS_ADD(fwded_frames); | 
 | 	MESHSTATS_ADD(dropped_frames_ttl); | 
 | 	MESHSTATS_ADD(dropped_frames_no_route); | 
 | 	MESHSTATS_ADD(estab_plinks); | 
 | #undef MESHSTATS_ADD | 
 | } | 
 |  | 
 | static void add_mesh_config(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	struct dentry *dir = debugfs_create_dir("mesh_config", | 
 | 						sdata->debugfs.dir); | 
 |  | 
 | #define MESHPARAMS_ADD(name) \ | 
 | 	debugfs_create_file(#name, 0600, dir, sdata, &name##_ops); | 
 |  | 
 | 	MESHPARAMS_ADD(dot11MeshMaxRetries); | 
 | 	MESHPARAMS_ADD(dot11MeshRetryTimeout); | 
 | 	MESHPARAMS_ADD(dot11MeshConfirmTimeout); | 
 | 	MESHPARAMS_ADD(dot11MeshHoldingTimeout); | 
 | 	MESHPARAMS_ADD(dot11MeshTTL); | 
 | 	MESHPARAMS_ADD(auto_open_plinks); | 
 | 	MESHPARAMS_ADD(dot11MeshMaxPeerLinks); | 
 | 	MESHPARAMS_ADD(dot11MeshHWMPactivePathTimeout); | 
 | 	MESHPARAMS_ADD(dot11MeshHWMPpreqMinInterval); | 
 | 	MESHPARAMS_ADD(dot11MeshHWMPnetDiameterTraversalTime); | 
 | 	MESHPARAMS_ADD(dot11MeshHWMPmaxPREQretries); | 
 | 	MESHPARAMS_ADD(path_refresh_time); | 
 | 	MESHPARAMS_ADD(min_discovery_timeout); | 
 |  | 
 | #undef MESHPARAMS_ADD | 
 | } | 
 | #endif | 
 |  | 
 | static void add_files(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	if (!sdata->debugfs.dir) | 
 | 		return; | 
 |  | 
 | 	switch (sdata->vif.type) { | 
 | 	case NL80211_IFTYPE_MESH_POINT: | 
 | #ifdef CONFIG_MAC80211_MESH | 
 | 		add_mesh_stats(sdata); | 
 | 		add_mesh_config(sdata); | 
 | #endif | 
 | 		break; | 
 | 	case NL80211_IFTYPE_STATION: | 
 | 		add_sta_files(sdata); | 
 | 		break; | 
 | 	case NL80211_IFTYPE_ADHOC: | 
 | 		/* XXX */ | 
 | 		break; | 
 | 	case NL80211_IFTYPE_AP: | 
 | 		add_ap_files(sdata); | 
 | 		break; | 
 | 	case NL80211_IFTYPE_WDS: | 
 | 		add_wds_files(sdata); | 
 | 		break; | 
 | 	case NL80211_IFTYPE_MONITOR: | 
 | 		add_monitor_files(sdata); | 
 | 		break; | 
 | 	case NL80211_IFTYPE_AP_VLAN: | 
 | 		add_vlan_files(sdata); | 
 | 		break; | 
 | 	default: | 
 | 		break; | 
 | 	} | 
 | } | 
 |  | 
 | void ieee80211_debugfs_add_netdev(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	char buf[10+IFNAMSIZ]; | 
 |  | 
 | 	sprintf(buf, "netdev:%s", sdata->name); | 
 | 	sdata->debugfs.dir = debugfs_create_dir(buf, | 
 | 		sdata->local->hw.wiphy->debugfsdir); | 
 | 	add_files(sdata); | 
 | } | 
 |  | 
 | void ieee80211_debugfs_remove_netdev(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	if (!sdata->debugfs.dir) | 
 | 		return; | 
 |  | 
 | 	debugfs_remove_recursive(sdata->debugfs.dir); | 
 | 	sdata->debugfs.dir = NULL; | 
 | } | 
 |  | 
 | void ieee80211_debugfs_rename_netdev(struct ieee80211_sub_if_data *sdata) | 
 | { | 
 | 	struct dentry *dir; | 
 | 	char buf[10 + IFNAMSIZ]; | 
 |  | 
 | 	dir = sdata->debugfs.dir; | 
 |  | 
 | 	if (!dir) | 
 | 		return; | 
 |  | 
 | 	sprintf(buf, "netdev:%s", sdata->name); | 
 | 	if (!debugfs_rename(dir->d_parent, dir, dir->d_parent, buf)) | 
 | 		printk(KERN_ERR "mac80211: debugfs: failed to rename debugfs " | 
 | 		       "dir to %s\n", buf); | 
 | } |