hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

b43: Add mask/set capability to debugfs MMIO interface 

This adds an atomic mask/set capability to the debugfs MMIO interface.
This is needed to support mask and/or set operations from the userspace
debugging tools.

Signed-off-by: Michael Buesch <mb@bu3sch.de>
Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
Michael Buesch 2008-06-19 19:38:32 +02:00 committed by John W. Linville
parent 6bbc321a96
commit efa275822b
1 changed files with 30 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

38
drivers/net/wireless/b43/debugfs.c
View File

@ -267,6 +267,8 @@ static int mmio16read__write_file(struct b43_wldev *dev,
return -EINVAL; return -EINVAL;
if (addr > B43_MAX_MMIO_ACCESS) if (addr > B43_MAX_MMIO_ACCESS)
return -EADDRNOTAVAIL; return -EADDRNOTAVAIL;
if ((addr % 2) != 0)
return -EINVAL;
dev->dfsentry->mmio16read_next = addr; dev->dfsentry->mmio16read_next = addr;
@ -276,17 +278,26 @@ static int mmio16read__write_file(struct b43_wldev *dev,
static int mmio16write__write_file(struct b43_wldev *dev, static int mmio16write__write_file(struct b43_wldev *dev,
const char *buf, size_t count) const char *buf, size_t count)
{ {
unsigned int addr, val; unsigned int addr, mask, set;
int res; int res;
u16 val;
res = sscanf(buf, "0x%X = 0x%X", &addr, &val); res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);
if (res != 2) if (res != 3)
return -EINVAL; return -EINVAL;
if (addr > B43_MAX_MMIO_ACCESS) if (addr > B43_MAX_MMIO_ACCESS)
return -EADDRNOTAVAIL; return -EADDRNOTAVAIL;
if (val > 0xFFFF) if ((mask > 0xFFFF) || (set > 0xFFFF))
return -E2BIG; 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); b43_write16(dev, addr, val);
return 0; return 0;
@ -320,6 +331,8 @@ static int mmio32read__write_file(struct b43_wldev *dev,
return -EINVAL; return -EINVAL;
if (addr > B43_MAX_MMIO_ACCESS) if (addr > B43_MAX_MMIO_ACCESS)
return -EADDRNOTAVAIL; return -EADDRNOTAVAIL;
if ((addr % 4) != 0)
return -EINVAL;
dev->dfsentry->mmio32read_next = addr; dev->dfsentry->mmio32read_next = addr;
@ -329,17 +342,26 @@ static int mmio32read__write_file(struct b43_wldev *dev,
static int mmio32write__write_file(struct b43_wldev *dev, static int mmio32write__write_file(struct b43_wldev *dev,
const char *buf, size_t count) const char *buf, size_t count)
{ {
unsigned int addr, val; unsigned int addr, mask, set;
int res; int res;
u32 val;
res = sscanf(buf, "0x%X = 0x%X", &addr, &val); res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);
if (res != 2) if (res != 3)
return -EINVAL; return -EINVAL;
if (addr > B43_MAX_MMIO_ACCESS) if (addr > B43_MAX_MMIO_ACCESS)
return -EADDRNOTAVAIL; return -EADDRNOTAVAIL;
if (val > 0xFFFFFFFF) if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))
return -E2BIG; 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); b43_write32(dev, addr, val);
return 0; return 0;