// SPDX-License-Identifier: GPL-2.0-or-later/*   Broadcom B43 wireless driver   debugfs driver debugging code   Copyright (c) 2005-2007 Michael Buesch <m@bues.ch>  */ #include <linux/fs.h>#include <linux/debugfs.h>#include <linux/slab.h>#include <linux/netdevice.h>#include <linux/pci.h>#include <linux/mutex.h> #include "b43.h"#include "main.h"#include "debugfs.h"#include "dma.h"#include "xmit.h"  /* The root directory. */static struct dentry *rootdir; struct b43_debugfs_fops {	ssize_t (*read)(struct b43_wldev *dev, char *buf, size_t bufsize);	int (*write)(struct b43_wldev *dev, const char *buf, size_t count);	/* Offset of struct b43_dfs_file in struct b43_dfsentry */	size_t file_struct_offset;}; static inlinestruct b43_dfs_file *fops_to_dfs_file(struct b43_wldev *dev,				      const struct b43_debugfs_fops *dfops){	void *p; 	p = dev->dfsentry;	p += dfops->file_struct_offset; 	return p;}  #define fappend(fmt, x...)	\	do {							\		if (bufsize - count)				\			count += scnprintf(buf + count,		\					  bufsize - count,	\					  fmt , ##x);		\		else						\			printk(KERN_ERR "b43: fappend overflow\n"); \	} while (0)  /* The biggest address values for SHM access from the debugfs files. */#define B43_MAX_SHM_ROUTING	4#define B43_MAX_SHM_ADDR	0xFFFF static ssize_t shm16read__read_file(struct b43_wldev *dev,				    char *buf, size_t bufsize){	ssize_t count = 0;	unsigned int routing, addr;	u16 val; 	routing = dev->dfsentry->shm16read_routing_next;	addr = dev->dfsentry->shm16read_addr_next;	if ((routing > B43_MAX_SHM_ROUTING) ||	    (addr > B43_MAX_SHM_ADDR))		return -EDESTADDRREQ; 	val = b43_shm_read16(dev, routing, addr);	fappend("0x%04X\n", val); 	return count;} static int shm16read__write_file(struct b43_wldev *dev,				 const char *buf, size_t count){	unsigned int routing, addr;	int res; 	res = sscanf(buf, "0x%X 0x%X", &routing, &addr);	if (res != 2)		return -EINVAL;	if (routing > B43_MAX_SHM_ROUTING)		return -EADDRNOTAVAIL;	if (addr > B43_MAX_SHM_ADDR)		return -EADDRNOTAVAIL;	if (routing == B43_SHM_SHARED) {		if ((addr % 2) != 0)			return -EADDRNOTAVAIL;	} 	dev->dfsentry->shm16read_routing_next = routing;	dev->dfsentry->shm16read_addr_next = addr; 	return 0;} static int shm16write__write_file(struct b43_wldev *dev,				  const char *buf, size_t count){	unsigned int routing, addr, mask, set;	u16 val;	int res; 	res = sscanf(buf, "0x%X 0x%X 0x%X 0x%X",		     &routing, &addr, &mask, &set);	if (res != 4)		return -EINVAL;	if (routing > B43_MAX_SHM_ROUTING)		return -EADDRNOTAVAIL;	if (addr > B43_MAX_SHM_ADDR)		return -EADDRNOTAVAIL;	if (routing == B43_SHM_SHARED) {		if ((addr % 2) != 0)			return -EADDRNOTAVAIL;	}	if ((mask > 0xFFFF) || (set > 0xFFFF))		return -E2BIG; 	if (mask == 0)		val = 0;	else		val = b43_shm_read16(dev, routing, addr);	val &= mask;	val |= set;	b43_shm_write16(dev, routing, addr, val); 	return 0;} static ssize_t shm32read__read_file(struct b43_wldev *dev,				    char *buf, size_t bufsize){	ssize_t count = 0;	unsigned int routing, addr;	u32 val; 	routing = dev->dfsentry->shm32read_routing_next;	addr = dev->dfsentry->shm32read_addr_next;	if ((routing > B43_MAX_SHM_ROUTING) ||	    (addr > B43_MAX_SHM_ADDR))		return -EDESTADDRREQ; 	val = b43_shm_read32(dev, routing, addr);	fappend("0x%08X\n", val); 	return count;} static int shm32read__write_file(struct b43_wldev *dev,				 const char *buf, size_t count){	unsigned int routing, addr;	int res; 	res = sscanf(buf, "0x%X 0x%X", &routing, &addr);	if (res != 2)		return -EINVAL;	if (routing > B43_MAX_SHM_ROUTING)		return -EADDRNOTAVAIL;	if (addr > B43_MAX_SHM_ADDR)		return -EADDRNOTAVAIL;	if (routing == B43_SHM_SHARED) {		if ((addr % 2) != 0)			return -EADDRNOTAVAIL;	} 	dev->dfsentry->shm32read_routing_next = routing;	dev->dfsentry->shm32read_addr_next = addr; 	return 0;} static int shm32write__write_file(struct b43_wldev *dev,				  const char *buf, size_t count){	unsigned int routing, addr, mask, set;	u32 val;	int res; 	res = sscanf(buf, "0x%X 0x%X 0x%X 0x%X",		     &routing, &addr, &mask, &set);	if (res != 4)		return -EINVAL;	if (routing > B43_MAX_SHM_ROUTING)		return -EADDRNOTAVAIL;	if (addr > B43_MAX_SHM_ADDR)		return -EADDRNOTAVAIL;	if (routing == B43_SHM_SHARED) {		if ((addr % 2) != 0)			return -EADDRNOTAVAIL;	}	if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))		return -E2BIG; 	if (mask == 0)		val = 0;	else		val = b43_shm_read32(dev, routing, addr);	val &= mask;	val |= set;	b43_shm_write32(dev, routing, addr, val); 	return 0;} /* The biggest MMIO address that we allow access to from the debugfs files. */#define B43_MAX_MMIO_ACCESS	(0xF00 - 1) static ssize_t mmio16read__read_file(struct b43_wldev *dev,				     char *buf, size_t bufsize){	ssize_t count = 0;	unsigned int addr;	u16 val; 	addr = dev->dfsentry->mmio16read_next;	if (addr > B43_MAX_MMIO_ACCESS)		return -EDESTADDRREQ; 	val = b43_read16(dev, addr);	fappend("0x%04X\n", val); 	return count;} static int mmio16read__write_file(struct b43_wldev *dev,				  const char *buf, size_t count){	unsigned int addr;	int res; 	res = sscanf(buf, "0x%X", &addr);	if (res != 1)		return -EINVAL;	if (addr > B43_MAX_MMIO_ACCESS)		return -EADDRNOTAVAIL;	if ((addr % 2) != 0)		return -EINVAL; 	dev->dfsentry->mmio16read_next = addr; 	return 0;} static int mmio16write__write_file(struct b43_wldev *dev,				   const char *buf, size_t count){	unsigned int addr, mask, set;	int res;	u16 val; 	res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);	if (res != 3)		return -EINVAL;	if (addr > B43_MAX_MMIO_ACCESS)		return -EADDRNOTAVAIL;	if ((mask > 0xFFFF) || (set > 0xFFFF))		return -E2BIG;	if ((addr % 2) != 0)		return -EINVAL; 	if (mask == 0)		val = 0;	else		val = b43_read16(dev, addr);	val &= mask;	val |= set;	b43_write16(dev, addr, val); 	return 0;} static ssize_t mmio32read__read_file(struct b43_wldev *dev,				     char *buf, size_t bufsize){	ssize_t count = 0;	unsigned int addr;	u32 val; 	addr = dev->dfsentry->mmio32read_next;	if (addr > B43_MAX_MMIO_ACCESS)		return -EDESTADDRREQ; 	val = b43_read32(dev, addr);	fappend("0x%08X\n", val); 	return count;} static int mmio32read__write_file(struct b43_wldev *dev,				  const char *buf, size_t count){	unsigned int addr;	int res; 	res = sscanf(buf, "0x%X", &addr);	if (res != 1)		return -EINVAL;	if (addr > B43_MAX_MMIO_ACCESS)		return -EADDRNOTAVAIL;	if ((addr % 4) != 0)		return -EINVAL; 	dev->dfsentry->mmio32read_next = addr; 	return 0;} static int mmio32write__write_file(struct b43_wldev *dev,				   const char *buf, size_t count){	unsigned int addr, mask, set;	int res;	u32 val; 	res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);	if (res != 3)		return -EINVAL;	if (addr > B43_MAX_MMIO_ACCESS)		return -EADDRNOTAVAIL;	if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))		return -E2BIG;	if ((addr % 4) != 0)		return -EINVAL; 	if (mask == 0)		val = 0;	else		val = b43_read32(dev, addr);	val &= mask;	val |= set;	b43_write32(dev, addr, val); 	return 0;} static ssize_t txstat_read_file(struct b43_wldev *dev,				char *buf, size_t bufsize){	struct b43_txstatus_log *log = &dev->dfsentry->txstatlog;	ssize_t count = 0;	int i, idx;	struct b43_txstatus *stat; 	if (log->end < 0) {		fappend("Nothing transmitted, yet\n");		goto out;	}	fappend("b43 TX status reports:\n\n"		"index | cookie | seq | phy_stat | frame_count | "		"rts_count | supp_reason | pm_indicated | "		"intermediate | for_ampdu | acked\n" "---\n");	i = log->end + 1;	idx = 0;	while (1) {		if (i == B43_NR_LOGGED_TXSTATUS)			i = 0;		stat = &(log->log[i]);		if (stat->cookie) {			fappend("%03d | "				"0x%04X | 0x%04X | 0x%02X | "				"0x%X | 0x%X | "				"%u | %u | "				"%u | %u | %u\n",				idx,				stat->cookie, stat->seq, stat->phy_stat,				stat->frame_count, stat->rts_count,				stat->supp_reason, stat->pm_indicated,				stat->intermediate, stat->for_ampdu,				stat->acked);			idx++;		}		if (i == log->end)			break;		i++;	}out: 	return count;} static int restart_write_file(struct b43_wldev *dev,			      const char *buf, size_t count){	int err = 0; 	if (count > 0 && buf[0] == '1') {		b43_controller_restart(dev, "manually restarted");	} else		err = -EINVAL; 	return err;} static unsigned long calc_expire_secs(unsigned long now,				      unsigned long time,				      unsigned long expire){	expire = time + expire; 	if (time_after(now, expire))		return 0; /* expired */	if (expire < now) {		/* jiffies wrapped */		expire -= MAX_JIFFY_OFFSET;		now -= MAX_JIFFY_OFFSET;	}	B43_WARN_ON(expire < now); 	return (expire - now) / HZ;} static ssize_t loctls_read_file(struct b43_wldev *dev,				char *buf, size_t bufsize){	ssize_t count = 0;	struct b43_txpower_lo_control *lo;	int i, err = 0;	struct b43_lo_calib *cal;	unsigned long now = jiffies;	struct b43_phy *phy = &dev->phy; 	if (phy->type != B43_PHYTYPE_G) {		fappend("Device is not a G-PHY\n");		err = -ENODEV;		goto out;	}	lo = phy->g->lo_control;	fappend("-- Local Oscillator calibration data --\n\n");	fappend("HW-power-control enabled: %d\n",		dev->phy.hardware_power_control);	fappend("TX Bias: 0x%02X,  TX Magn: 0x%02X  (expire in %lu sec)\n",		lo->tx_bias, lo->tx_magn,		calc_expire_secs(now, lo->txctl_measured_time,				 B43_LO_TXCTL_EXPIRE));	fappend("Power Vector: 0x%08X%08X  (expires in %lu sec)\n",		(unsigned int)((lo->power_vector & 0xFFFFFFFF00000000ULL) >> 32),		(unsigned int)(lo->power_vector & 0x00000000FFFFFFFFULL),		calc_expire_secs(now, lo->pwr_vec_read_time,				 B43_LO_PWRVEC_EXPIRE)); 	fappend("\nCalibrated settings:\n");	list_for_each_entry(cal, &lo->calib_list, list) {		bool active; 		active = (b43_compare_bbatt(&cal->bbatt, &phy->g->bbatt) &&			  b43_compare_rfatt(&cal->rfatt, &phy->g->rfatt));		fappend("BB(%d), RF(%d,%d)  ->  I=%d, Q=%d  "			"(expires in %lu sec)%s\n",			cal->bbatt.att,			cal->rfatt.att, cal->rfatt.with_padmix,			cal->ctl.i, cal->ctl.q,			calc_expire_secs(now, cal->calib_time,					 B43_LO_CALIB_EXPIRE),			active ? "  ACTIVE" : "");	} 	fappend("\nUsed RF attenuation values:  Value(WithPadmix flag)\n");	for (i = 0; i < lo->rfatt_list.len; i++) {		fappend("%u(%d), ",			lo->rfatt_list.list[i].att,			lo->rfatt_list.list[i].with_padmix);	}	fappend("\n");	fappend("\nUsed Baseband attenuation values:\n");	for (i = 0; i < lo->bbatt_list.len; i++) {		fappend("%u, ",			lo->bbatt_list.list[i].att);	}	fappend("\n"); out:	return err ? err : count;} #undef fappend static ssize_t b43_debugfs_read(struct file *file, char __user *userbuf,				size_t count, loff_t *ppos){	struct b43_wldev *dev;	const struct b43_debugfs_fops *dfops;	struct b43_dfs_file *dfile;	ssize_t ret;	char *buf;	const size_t bufsize = 1024 * 16; /* 16 kiB buffer */	int err = 0; 	if (!count)

Lines 1–500 of 765. Load more