|  | 
 | /* | 
 |  * mac80211 debugfs for wireless PHYs | 
 |  * | 
 |  * Copyright 2007	Johannes Berg <johannes@sipsolutions.net> | 
 |  * | 
 |  * GPLv2 | 
 |  * | 
 |  */ | 
 |  | 
 | #include <linux/debugfs.h> | 
 | #include <linux/rtnetlink.h> | 
 | #include "ieee80211_i.h" | 
 | #include "driver-ops.h" | 
 | #include "rate.h" | 
 | #include "debugfs.h" | 
 |  | 
 | int mac80211_open_file_generic(struct inode *inode, struct file *file) | 
 | { | 
 | 	file->private_data = inode->i_private; | 
 | 	return 0; | 
 | } | 
 |  | 
 | #define DEBUGFS_FORMAT_BUFFER_SIZE 100 | 
 |  | 
 | int mac80211_format_buffer(char __user *userbuf, size_t count, | 
 | 				  loff_t *ppos, char *fmt, ...) | 
 | { | 
 | 	va_list args; | 
 | 	char buf[DEBUGFS_FORMAT_BUFFER_SIZE]; | 
 | 	int res; | 
 |  | 
 | 	va_start(args, fmt); | 
 | 	res = vscnprintf(buf, sizeof(buf), fmt, args); | 
 | 	va_end(args); | 
 |  | 
 | 	return simple_read_from_buffer(userbuf, count, ppos, buf, res); | 
 | } | 
 |  | 
 | #define DEBUGFS_READONLY_FILE(name, fmt, value...)			\ | 
 | static ssize_t name## _read(struct file *file, char __user *userbuf,	\ | 
 | 			    size_t count, loff_t *ppos)			\ | 
 | {									\ | 
 | 	struct ieee80211_local *local = file->private_data;		\ | 
 | 									\ | 
 | 	return mac80211_format_buffer(userbuf, count, ppos, 		\ | 
 | 				      fmt "\n", ##value);		\ | 
 | }									\ | 
 | 									\ | 
 | static const struct file_operations name## _ops = {			\ | 
 | 	.read = name## _read,						\ | 
 | 	.open = mac80211_open_file_generic,				\ | 
 | 	.llseek = generic_file_llseek,					\ | 
 | }; | 
 |  | 
 | #define DEBUGFS_ADD(name)						\ | 
 | 	debugfs_create_file(#name, 0400, phyd, local, &name## _ops); | 
 |  | 
 | #define DEBUGFS_ADD_MODE(name, mode)					\ | 
 | 	debugfs_create_file(#name, mode, phyd, local, &name## _ops); | 
 |  | 
 |  | 
 | DEBUGFS_READONLY_FILE(user_power, "%d", | 
 | 		      local->user_power_level); | 
 | DEBUGFS_READONLY_FILE(power, "%d", | 
 | 		      local->hw.conf.power_level); | 
 | DEBUGFS_READONLY_FILE(frequency, "%d", | 
 | 		      local->hw.conf.channel->center_freq); | 
 | DEBUGFS_READONLY_FILE(total_ps_buffered, "%d", | 
 | 		      local->total_ps_buffered); | 
 | DEBUGFS_READONLY_FILE(wep_iv, "%#08x", | 
 | 		      local->wep_iv & 0xffffff); | 
 | DEBUGFS_READONLY_FILE(rate_ctrl_alg, "%s", | 
 | 	local->rate_ctrl ? local->rate_ctrl->ops->name : "hw/driver"); | 
 |  | 
 | static ssize_t tsf_read(struct file *file, char __user *user_buf, | 
 | 			     size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	u64 tsf; | 
 |  | 
 | 	tsf = drv_get_tsf(local); | 
 |  | 
 | 	return mac80211_format_buffer(user_buf, count, ppos, "0x%016llx\n", | 
 | 				      (unsigned long long) tsf); | 
 | } | 
 |  | 
 | static ssize_t tsf_write(struct file *file, | 
 |                          const char __user *user_buf, | 
 |                          size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	unsigned long long tsf; | 
 | 	char buf[100]; | 
 | 	size_t len; | 
 |  | 
 | 	len = min(count, sizeof(buf) - 1); | 
 | 	if (copy_from_user(buf, user_buf, len)) | 
 | 		return -EFAULT; | 
 | 	buf[len] = '\0'; | 
 |  | 
 | 	if (strncmp(buf, "reset", 5) == 0) { | 
 | 		if (local->ops->reset_tsf) { | 
 | 			drv_reset_tsf(local); | 
 | 			wiphy_info(local->hw.wiphy, "debugfs reset TSF\n"); | 
 | 		} | 
 | 	} else { | 
 | 		tsf = simple_strtoul(buf, NULL, 0); | 
 | 		if (local->ops->set_tsf) { | 
 | 			drv_set_tsf(local, tsf); | 
 | 			wiphy_info(local->hw.wiphy, | 
 | 				   "debugfs set TSF to %#018llx\n", tsf); | 
 |  | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | static const struct file_operations tsf_ops = { | 
 | 	.read = tsf_read, | 
 | 	.write = tsf_write, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = default_llseek, | 
 | }; | 
 |  | 
 | static ssize_t reset_write(struct file *file, const char __user *user_buf, | 
 | 			   size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 |  | 
 | 	rtnl_lock(); | 
 | 	__ieee80211_suspend(&local->hw); | 
 | 	__ieee80211_resume(&local->hw); | 
 | 	rtnl_unlock(); | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | static const struct file_operations reset_ops = { | 
 | 	.write = reset_write, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = noop_llseek, | 
 | }; | 
 |  | 
 | static ssize_t noack_read(struct file *file, char __user *user_buf, | 
 | 			  size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 |  | 
 | 	return mac80211_format_buffer(user_buf, count, ppos, "%d\n", | 
 | 				      local->wifi_wme_noack_test); | 
 | } | 
 |  | 
 | static ssize_t noack_write(struct file *file, | 
 | 			   const char __user *user_buf, | 
 | 			   size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	char buf[10]; | 
 | 	size_t len; | 
 |  | 
 | 	len = min(count, sizeof(buf) - 1); | 
 | 	if (copy_from_user(buf, user_buf, len)) | 
 | 		return -EFAULT; | 
 | 	buf[len] = '\0'; | 
 |  | 
 | 	local->wifi_wme_noack_test = !!simple_strtoul(buf, NULL, 0); | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | static const struct file_operations noack_ops = { | 
 | 	.read = noack_read, | 
 | 	.write = noack_write, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = default_llseek, | 
 | }; | 
 |  | 
 | static ssize_t uapsd_queues_read(struct file *file, char __user *user_buf, | 
 | 				 size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	return mac80211_format_buffer(user_buf, count, ppos, "0x%x\n", | 
 | 				      local->uapsd_queues); | 
 | } | 
 |  | 
 | static ssize_t uapsd_queues_write(struct file *file, | 
 | 				  const char __user *user_buf, | 
 | 				  size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	unsigned long val; | 
 | 	char buf[10]; | 
 | 	size_t len; | 
 | 	int ret; | 
 |  | 
 | 	len = min(count, sizeof(buf) - 1); | 
 | 	if (copy_from_user(buf, user_buf, len)) | 
 | 		return -EFAULT; | 
 | 	buf[len] = '\0'; | 
 |  | 
 | 	ret = strict_strtoul(buf, 0, &val); | 
 |  | 
 | 	if (ret) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (val & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) | 
 | 		return -ERANGE; | 
 |  | 
 | 	local->uapsd_queues = val; | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | static const struct file_operations uapsd_queues_ops = { | 
 | 	.read = uapsd_queues_read, | 
 | 	.write = uapsd_queues_write, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = default_llseek, | 
 | }; | 
 |  | 
 | static ssize_t uapsd_max_sp_len_read(struct file *file, char __user *user_buf, | 
 | 				     size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 |  | 
 | 	return mac80211_format_buffer(user_buf, count, ppos, "0x%x\n", | 
 | 				      local->uapsd_max_sp_len); | 
 | } | 
 |  | 
 | static ssize_t uapsd_max_sp_len_write(struct file *file, | 
 | 				      const char __user *user_buf, | 
 | 				      size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	unsigned long val; | 
 | 	char buf[10]; | 
 | 	size_t len; | 
 | 	int ret; | 
 |  | 
 | 	len = min(count, sizeof(buf) - 1); | 
 | 	if (copy_from_user(buf, user_buf, len)) | 
 | 		return -EFAULT; | 
 | 	buf[len] = '\0'; | 
 |  | 
 | 	ret = strict_strtoul(buf, 0, &val); | 
 |  | 
 | 	if (ret) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (val & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) | 
 | 		return -ERANGE; | 
 |  | 
 | 	local->uapsd_max_sp_len = val; | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | static const struct file_operations uapsd_max_sp_len_ops = { | 
 | 	.read = uapsd_max_sp_len_read, | 
 | 	.write = uapsd_max_sp_len_write, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = default_llseek, | 
 | }; | 
 |  | 
 | static ssize_t channel_type_read(struct file *file, char __user *user_buf, | 
 | 		       size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	const char *buf; | 
 |  | 
 | 	switch (local->hw.conf.channel_type) { | 
 | 	case NL80211_CHAN_NO_HT: | 
 | 		buf = "no ht\n"; | 
 | 		break; | 
 | 	case NL80211_CHAN_HT20: | 
 | 		buf = "ht20\n"; | 
 | 		break; | 
 | 	case NL80211_CHAN_HT40MINUS: | 
 | 		buf = "ht40-\n"; | 
 | 		break; | 
 | 	case NL80211_CHAN_HT40PLUS: | 
 | 		buf = "ht40+\n"; | 
 | 		break; | 
 | 	default: | 
 | 		buf = "???"; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	return simple_read_from_buffer(user_buf, count, ppos, buf, strlen(buf)); | 
 | } | 
 |  | 
 | static const struct file_operations channel_type_ops = { | 
 | 	.read = channel_type_read, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = default_llseek, | 
 | }; | 
 |  | 
 | static ssize_t queues_read(struct file *file, char __user *user_buf, | 
 | 			   size_t count, loff_t *ppos) | 
 | { | 
 | 	struct ieee80211_local *local = file->private_data; | 
 | 	unsigned long flags; | 
 | 	char buf[IEEE80211_MAX_QUEUES * 20]; | 
 | 	int q, res = 0; | 
 |  | 
 | 	spin_lock_irqsave(&local->queue_stop_reason_lock, flags); | 
 | 	for (q = 0; q < local->hw.queues; q++) | 
 | 		res += sprintf(buf + res, "%02d: %#.8lx/%d\n", q, | 
 | 				local->queue_stop_reasons[q], | 
 | 				skb_queue_len(&local->pending[q])); | 
 | 	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); | 
 |  | 
 | 	return simple_read_from_buffer(user_buf, count, ppos, buf, res); | 
 | } | 
 |  | 
 | static const struct file_operations queues_ops = { | 
 | 	.read = queues_read, | 
 | 	.open = mac80211_open_file_generic, | 
 | 	.llseek = default_llseek, | 
 | }; | 
 |  | 
 | /* statistics stuff */ | 
 |  | 
 | static ssize_t format_devstat_counter(struct ieee80211_local *local, | 
 | 	char __user *userbuf, | 
 | 	size_t count, loff_t *ppos, | 
 | 	int (*printvalue)(struct ieee80211_low_level_stats *stats, char *buf, | 
 | 			  int buflen)) | 
 | { | 
 | 	struct ieee80211_low_level_stats stats; | 
 | 	char buf[20]; | 
 | 	int res; | 
 |  | 
 | 	rtnl_lock(); | 
 | 	res = drv_get_stats(local, &stats); | 
 | 	rtnl_unlock(); | 
 | 	if (res) | 
 | 		return res; | 
 | 	res = printvalue(&stats, buf, sizeof(buf)); | 
 | 	return simple_read_from_buffer(userbuf, count, ppos, buf, res); | 
 | } | 
 |  | 
 | #define DEBUGFS_DEVSTATS_FILE(name)					\ | 
 | static int print_devstats_##name(struct ieee80211_low_level_stats *stats,\ | 
 | 				 char *buf, int buflen)			\ | 
 | {									\ | 
 | 	return scnprintf(buf, buflen, "%u\n", stats->name);		\ | 
 | }									\ | 
 | static ssize_t stats_ ##name## _read(struct file *file,			\ | 
 | 				     char __user *userbuf,		\ | 
 | 				     size_t count, loff_t *ppos)	\ | 
 | {									\ | 
 | 	return format_devstat_counter(file->private_data,		\ | 
 | 				      userbuf,				\ | 
 | 				      count,				\ | 
 | 				      ppos,				\ | 
 | 				      print_devstats_##name);		\ | 
 | }									\ | 
 | 									\ | 
 | static const struct file_operations stats_ ##name## _ops = {		\ | 
 | 	.read = stats_ ##name## _read,					\ | 
 | 	.open = mac80211_open_file_generic,				\ | 
 | 	.llseek = generic_file_llseek,					\ | 
 | }; | 
 |  | 
 | #define DEBUGFS_STATS_ADD(name, field)					\ | 
 | 	debugfs_create_u32(#name, 0400, statsd, (u32 *) &field); | 
 | #define DEBUGFS_DEVSTATS_ADD(name)					\ | 
 | 	debugfs_create_file(#name, 0400, statsd, local, &stats_ ##name## _ops); | 
 |  | 
 | DEBUGFS_DEVSTATS_FILE(dot11ACKFailureCount); | 
 | DEBUGFS_DEVSTATS_FILE(dot11RTSFailureCount); | 
 | DEBUGFS_DEVSTATS_FILE(dot11FCSErrorCount); | 
 | DEBUGFS_DEVSTATS_FILE(dot11RTSSuccessCount); | 
 |  | 
 | void debugfs_hw_add(struct ieee80211_local *local) | 
 | { | 
 | 	struct dentry *phyd = local->hw.wiphy->debugfsdir; | 
 | 	struct dentry *statsd; | 
 |  | 
 | 	if (!phyd) | 
 | 		return; | 
 |  | 
 | 	local->debugfs.keys = debugfs_create_dir("keys", phyd); | 
 |  | 
 | 	DEBUGFS_ADD(frequency); | 
 | 	DEBUGFS_ADD(total_ps_buffered); | 
 | 	DEBUGFS_ADD(wep_iv); | 
 | 	DEBUGFS_ADD(tsf); | 
 | 	DEBUGFS_ADD(queues); | 
 | 	DEBUGFS_ADD_MODE(reset, 0200); | 
 | 	DEBUGFS_ADD(noack); | 
 | 	DEBUGFS_ADD(uapsd_queues); | 
 | 	DEBUGFS_ADD(uapsd_max_sp_len); | 
 | 	DEBUGFS_ADD(channel_type); | 
 | 	DEBUGFS_ADD(user_power); | 
 | 	DEBUGFS_ADD(power); | 
 |  | 
 | 	statsd = debugfs_create_dir("statistics", phyd); | 
 |  | 
 | 	/* if the dir failed, don't put all the other things into the root! */ | 
 | 	if (!statsd) | 
 | 		return; | 
 |  | 
 | 	DEBUGFS_STATS_ADD(transmitted_fragment_count, | 
 | 		local->dot11TransmittedFragmentCount); | 
 | 	DEBUGFS_STATS_ADD(multicast_transmitted_frame_count, | 
 | 		local->dot11MulticastTransmittedFrameCount); | 
 | 	DEBUGFS_STATS_ADD(failed_count, local->dot11FailedCount); | 
 | 	DEBUGFS_STATS_ADD(retry_count, local->dot11RetryCount); | 
 | 	DEBUGFS_STATS_ADD(multiple_retry_count, | 
 | 		local->dot11MultipleRetryCount); | 
 | 	DEBUGFS_STATS_ADD(frame_duplicate_count, | 
 | 		local->dot11FrameDuplicateCount); | 
 | 	DEBUGFS_STATS_ADD(received_fragment_count, | 
 | 		local->dot11ReceivedFragmentCount); | 
 | 	DEBUGFS_STATS_ADD(multicast_received_frame_count, | 
 | 		local->dot11MulticastReceivedFrameCount); | 
 | 	DEBUGFS_STATS_ADD(transmitted_frame_count, | 
 | 		local->dot11TransmittedFrameCount); | 
 | #ifdef CONFIG_MAC80211_DEBUG_COUNTERS | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_drop, local->tx_handlers_drop); | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_queued, local->tx_handlers_queued); | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_drop_unencrypted, | 
 | 		local->tx_handlers_drop_unencrypted); | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_drop_fragment, | 
 | 		local->tx_handlers_drop_fragment); | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_drop_wep, | 
 | 		local->tx_handlers_drop_wep); | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_drop_not_assoc, | 
 | 		local->tx_handlers_drop_not_assoc); | 
 | 	DEBUGFS_STATS_ADD(tx_handlers_drop_unauth_port, | 
 | 		local->tx_handlers_drop_unauth_port); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_drop, local->rx_handlers_drop); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_queued, local->rx_handlers_queued); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_drop_nullfunc, | 
 | 		local->rx_handlers_drop_nullfunc); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_drop_defrag, | 
 | 		local->rx_handlers_drop_defrag); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_drop_short, | 
 | 		local->rx_handlers_drop_short); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_drop_passive_scan, | 
 | 		local->rx_handlers_drop_passive_scan); | 
 | 	DEBUGFS_STATS_ADD(tx_expand_skb_head, | 
 | 		local->tx_expand_skb_head); | 
 | 	DEBUGFS_STATS_ADD(tx_expand_skb_head_cloned, | 
 | 		local->tx_expand_skb_head_cloned); | 
 | 	DEBUGFS_STATS_ADD(rx_expand_skb_head, | 
 | 		local->rx_expand_skb_head); | 
 | 	DEBUGFS_STATS_ADD(rx_expand_skb_head2, | 
 | 		local->rx_expand_skb_head2); | 
 | 	DEBUGFS_STATS_ADD(rx_handlers_fragments, | 
 | 		local->rx_handlers_fragments); | 
 | 	DEBUGFS_STATS_ADD(tx_status_drop, | 
 | 		local->tx_status_drop); | 
 | #endif | 
 | 	DEBUGFS_DEVSTATS_ADD(dot11ACKFailureCount); | 
 | 	DEBUGFS_DEVSTATS_ADD(dot11RTSFailureCount); | 
 | 	DEBUGFS_DEVSTATS_ADD(dot11FCSErrorCount); | 
 | 	DEBUGFS_DEVSTATS_ADD(dot11RTSSuccessCount); | 
 | } |