472 строки
11 KiB
C
472 строки
11 KiB
C
/*
|
|
|
|
Broadcom BCM43xx wireless driver
|
|
|
|
SYSFS support routines
|
|
|
|
Copyright (c) 2006 Michael Buesch <mbuesch@freenet.de>
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program; see the file COPYING. If not, write to
|
|
the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
|
|
Boston, MA 02110-1301, USA.
|
|
|
|
*/
|
|
|
|
#include "bcm43xx_sysfs.h"
|
|
#include "bcm43xx.h"
|
|
#include "bcm43xx_main.h"
|
|
#include "bcm43xx_radio.h"
|
|
|
|
#include <linux/capability.h>
|
|
|
|
|
|
#define GENERIC_FILESIZE 64
|
|
|
|
|
|
static int get_integer(const char *buf, size_t count)
|
|
{
|
|
char tmp[10 + 1] = { 0 };
|
|
int ret = -EINVAL;
|
|
|
|
if (count == 0)
|
|
goto out;
|
|
count = min(count, (size_t)10);
|
|
memcpy(tmp, buf, count);
|
|
ret = simple_strtol(tmp, NULL, 10);
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static int get_boolean(const char *buf, size_t count)
|
|
{
|
|
if (count != 0) {
|
|
if (buf[0] == '1')
|
|
return 1;
|
|
if (buf[0] == '0')
|
|
return 0;
|
|
if (count >= 4 && memcmp(buf, "true", 4) == 0)
|
|
return 1;
|
|
if (count >= 5 && memcmp(buf, "false", 5) == 0)
|
|
return 0;
|
|
if (count >= 3 && memcmp(buf, "yes", 3) == 0)
|
|
return 1;
|
|
if (count >= 2 && memcmp(buf, "no", 2) == 0)
|
|
return 0;
|
|
if (count >= 2 && memcmp(buf, "on", 2) == 0)
|
|
return 1;
|
|
if (count >= 3 && memcmp(buf, "off", 3) == 0)
|
|
return 0;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int sprom2hex(const u16 *sprom, char *buf, size_t buf_len)
|
|
{
|
|
int i, pos = 0;
|
|
|
|
for (i = 0; i < BCM43xx_SPROM_SIZE; i++) {
|
|
pos += snprintf(buf + pos, buf_len - pos - 1,
|
|
"%04X", swab16(sprom[i]) & 0xFFFF);
|
|
}
|
|
pos += snprintf(buf + pos, buf_len - pos - 1, "\n");
|
|
|
|
return pos + 1;
|
|
}
|
|
|
|
static int hex2sprom(u16 *sprom, const char *dump, size_t len)
|
|
{
|
|
char tmp[5] = { 0 };
|
|
int cnt = 0;
|
|
unsigned long parsed;
|
|
|
|
if (len < BCM43xx_SPROM_SIZE * sizeof(u16) * 2)
|
|
return -EINVAL;
|
|
|
|
while (cnt < BCM43xx_SPROM_SIZE) {
|
|
memcpy(tmp, dump, 4);
|
|
dump += 4;
|
|
parsed = simple_strtoul(tmp, NULL, 16);
|
|
sprom[cnt++] = swab16((u16)parsed);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t bcm43xx_attr_sprom_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
u16 *sprom;
|
|
unsigned long flags;
|
|
int err;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
assert(BCM43xx_SPROM_SIZE * sizeof(u16) <= PAGE_SIZE);
|
|
sprom = kmalloc(BCM43xx_SPROM_SIZE * sizeof(*sprom),
|
|
GFP_KERNEL);
|
|
if (!sprom)
|
|
return -ENOMEM;
|
|
mutex_lock(&bcm->mutex);
|
|
spin_lock_irqsave(&bcm->irq_lock, flags);
|
|
err = bcm43xx_sprom_read(bcm, sprom);
|
|
if (!err)
|
|
err = sprom2hex(sprom, buf, PAGE_SIZE);
|
|
mmiowb();
|
|
spin_unlock_irqrestore(&bcm->irq_lock, flags);
|
|
mutex_unlock(&bcm->mutex);
|
|
kfree(sprom);
|
|
|
|
return err;
|
|
}
|
|
|
|
static ssize_t bcm43xx_attr_sprom_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
u16 *sprom;
|
|
unsigned long flags;
|
|
int err;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
sprom = kmalloc(BCM43xx_SPROM_SIZE * sizeof(*sprom),
|
|
GFP_KERNEL);
|
|
if (!sprom)
|
|
return -ENOMEM;
|
|
err = hex2sprom(sprom, buf, count);
|
|
if (err)
|
|
goto out_kfree;
|
|
mutex_lock(&bcm->mutex);
|
|
spin_lock_irqsave(&bcm->irq_lock, flags);
|
|
spin_lock(&bcm->leds_lock);
|
|
err = bcm43xx_sprom_write(bcm, sprom);
|
|
mmiowb();
|
|
spin_unlock(&bcm->leds_lock);
|
|
spin_unlock_irqrestore(&bcm->irq_lock, flags);
|
|
mutex_unlock(&bcm->mutex);
|
|
out_kfree:
|
|
kfree(sprom);
|
|
|
|
return err ? err : count;
|
|
|
|
}
|
|
|
|
static DEVICE_ATTR(sprom, 0600,
|
|
bcm43xx_attr_sprom_show,
|
|
bcm43xx_attr_sprom_store);
|
|
|
|
static ssize_t bcm43xx_attr_interfmode_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
ssize_t count = 0;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
mutex_lock(&bcm->mutex);
|
|
|
|
switch (bcm43xx_current_radio(bcm)->interfmode) {
|
|
case BCM43xx_RADIO_INTERFMODE_NONE:
|
|
count = snprintf(buf, PAGE_SIZE, "0 (No Interference Mitigation)\n");
|
|
break;
|
|
case BCM43xx_RADIO_INTERFMODE_NONWLAN:
|
|
count = snprintf(buf, PAGE_SIZE, "1 (Non-WLAN Interference Mitigation)\n");
|
|
break;
|
|
case BCM43xx_RADIO_INTERFMODE_MANUALWLAN:
|
|
count = snprintf(buf, PAGE_SIZE, "2 (WLAN Interference Mitigation)\n");
|
|
break;
|
|
default:
|
|
assert(0);
|
|
}
|
|
|
|
mutex_unlock(&bcm->mutex);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
static ssize_t bcm43xx_attr_interfmode_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
unsigned long flags;
|
|
int err;
|
|
int mode;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
mode = get_integer(buf, count);
|
|
switch (mode) {
|
|
case 0:
|
|
mode = BCM43xx_RADIO_INTERFMODE_NONE;
|
|
break;
|
|
case 1:
|
|
mode = BCM43xx_RADIO_INTERFMODE_NONWLAN;
|
|
break;
|
|
case 2:
|
|
mode = BCM43xx_RADIO_INTERFMODE_MANUALWLAN;
|
|
break;
|
|
case 3:
|
|
mode = BCM43xx_RADIO_INTERFMODE_AUTOWLAN;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
mutex_lock(&bcm->mutex);
|
|
spin_lock_irqsave(&bcm->irq_lock, flags);
|
|
|
|
err = bcm43xx_radio_set_interference_mitigation(bcm, mode);
|
|
if (err) {
|
|
printk(KERN_ERR PFX "Interference Mitigation not "
|
|
"supported by device\n");
|
|
}
|
|
mmiowb();
|
|
spin_unlock_irqrestore(&bcm->irq_lock, flags);
|
|
mutex_unlock(&bcm->mutex);
|
|
|
|
return err ? err : count;
|
|
}
|
|
|
|
static DEVICE_ATTR(interference, 0644,
|
|
bcm43xx_attr_interfmode_show,
|
|
bcm43xx_attr_interfmode_store);
|
|
|
|
static ssize_t bcm43xx_attr_preamble_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
ssize_t count;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
mutex_lock(&bcm->mutex);
|
|
|
|
if (bcm->short_preamble)
|
|
count = snprintf(buf, PAGE_SIZE, "1 (Short Preamble enabled)\n");
|
|
else
|
|
count = snprintf(buf, PAGE_SIZE, "0 (Short Preamble disabled)\n");
|
|
|
|
mutex_unlock(&bcm->mutex);
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t bcm43xx_attr_preamble_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
unsigned long flags;
|
|
int value;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
value = get_boolean(buf, count);
|
|
if (value < 0)
|
|
return value;
|
|
mutex_lock(&bcm->mutex);
|
|
spin_lock_irqsave(&bcm->irq_lock, flags);
|
|
|
|
bcm->short_preamble = !!value;
|
|
|
|
spin_unlock_irqrestore(&bcm->irq_lock, flags);
|
|
mutex_unlock(&bcm->mutex);
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(shortpreamble, 0644,
|
|
bcm43xx_attr_preamble_show,
|
|
bcm43xx_attr_preamble_store);
|
|
|
|
static ssize_t bcm43xx_attr_phymode_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
int phytype;
|
|
int err = -EINVAL;
|
|
|
|
if (count < 1)
|
|
goto out;
|
|
switch (buf[0]) {
|
|
case 'a': case 'A':
|
|
phytype = BCM43xx_PHYTYPE_A;
|
|
break;
|
|
case 'b': case 'B':
|
|
phytype = BCM43xx_PHYTYPE_B;
|
|
break;
|
|
case 'g': case 'G':
|
|
phytype = BCM43xx_PHYTYPE_G;
|
|
break;
|
|
default:
|
|
goto out;
|
|
}
|
|
|
|
bcm43xx_periodic_tasks_delete(bcm);
|
|
mutex_lock(&(bcm)->mutex);
|
|
err = bcm43xx_select_wireless_core(bcm, phytype);
|
|
if (!err)
|
|
bcm43xx_periodic_tasks_setup(bcm);
|
|
mutex_unlock(&(bcm)->mutex);
|
|
if (err == -ESRCH)
|
|
err = -ENODEV;
|
|
|
|
out:
|
|
return err ? err : count;
|
|
}
|
|
|
|
static ssize_t bcm43xx_attr_phymode_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
ssize_t count = 0;
|
|
|
|
mutex_lock(&(bcm)->mutex);
|
|
switch (bcm43xx_current_phy(bcm)->type) {
|
|
case BCM43xx_PHYTYPE_A:
|
|
snprintf(buf, PAGE_SIZE, "A");
|
|
break;
|
|
case BCM43xx_PHYTYPE_B:
|
|
snprintf(buf, PAGE_SIZE, "B");
|
|
break;
|
|
case BCM43xx_PHYTYPE_G:
|
|
snprintf(buf, PAGE_SIZE, "G");
|
|
break;
|
|
default:
|
|
assert(0);
|
|
}
|
|
mutex_unlock(&(bcm)->mutex);
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(phymode, 0644,
|
|
bcm43xx_attr_phymode_show,
|
|
bcm43xx_attr_phymode_store);
|
|
|
|
static ssize_t bcm43xx_attr_microcode_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
unsigned long flags;
|
|
struct bcm43xx_private *bcm = dev_to_bcm(dev);
|
|
ssize_t count = 0;
|
|
u16 status;
|
|
|
|
if (!capable(CAP_NET_ADMIN))
|
|
return -EPERM;
|
|
|
|
mutex_lock(&(bcm)->mutex);
|
|
spin_lock_irqsave(&bcm->irq_lock, flags);
|
|
status = bcm43xx_shm_read16(bcm, BCM43xx_SHM_SHARED,
|
|
BCM43xx_UCODE_STATUS);
|
|
|
|
spin_unlock_irqrestore(&bcm->irq_lock, flags);
|
|
mutex_unlock(&(bcm)->mutex);
|
|
switch (status) {
|
|
case 0x0000:
|
|
count = snprintf(buf, PAGE_SIZE, "0x%.4x (invalid)\n",
|
|
status);
|
|
break;
|
|
case 0x0001:
|
|
count = snprintf(buf, PAGE_SIZE, "0x%.4x (init)\n",
|
|
status);
|
|
break;
|
|
case 0x0002:
|
|
count = snprintf(buf, PAGE_SIZE, "0x%.4x (active)\n",
|
|
status);
|
|
break;
|
|
case 0x0003:
|
|
count = snprintf(buf, PAGE_SIZE, "0x%.4x (suspended)\n",
|
|
status);
|
|
break;
|
|
case 0x0004:
|
|
count = snprintf(buf, PAGE_SIZE, "0x%.4x (asleep)\n",
|
|
status);
|
|
break;
|
|
default:
|
|
count = snprintf(buf, PAGE_SIZE, "0x%.4x (unknown)\n",
|
|
status);
|
|
break;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(microcodestatus, 0444,
|
|
bcm43xx_attr_microcode_show,
|
|
NULL);
|
|
|
|
int bcm43xx_sysfs_register(struct bcm43xx_private *bcm)
|
|
{
|
|
struct device *dev = &bcm->pci_dev->dev;
|
|
int err;
|
|
|
|
assert(bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED);
|
|
|
|
err = device_create_file(dev, &dev_attr_sprom);
|
|
if (err)
|
|
goto out;
|
|
err = device_create_file(dev, &dev_attr_interference);
|
|
if (err)
|
|
goto err_remove_sprom;
|
|
err = device_create_file(dev, &dev_attr_shortpreamble);
|
|
if (err)
|
|
goto err_remove_interfmode;
|
|
err = device_create_file(dev, &dev_attr_phymode);
|
|
if (err)
|
|
goto err_remove_shortpreamble;
|
|
err = device_create_file(dev, &dev_attr_microcodestatus);
|
|
if (err)
|
|
goto err_remove_phymode;
|
|
|
|
out:
|
|
return err;
|
|
err_remove_phymode:
|
|
device_remove_file(dev, &dev_attr_phymode);
|
|
err_remove_shortpreamble:
|
|
device_remove_file(dev, &dev_attr_shortpreamble);
|
|
err_remove_interfmode:
|
|
device_remove_file(dev, &dev_attr_interference);
|
|
err_remove_sprom:
|
|
device_remove_file(dev, &dev_attr_sprom);
|
|
goto out;
|
|
}
|
|
|
|
void bcm43xx_sysfs_unregister(struct bcm43xx_private *bcm)
|
|
{
|
|
struct device *dev = &bcm->pci_dev->dev;
|
|
|
|
device_remove_file(dev, &dev_attr_microcodestatus);
|
|
device_remove_file(dev, &dev_attr_phymode);
|
|
device_remove_file(dev, &dev_attr_shortpreamble);
|
|
device_remove_file(dev, &dev_attr_interference);
|
|
device_remove_file(dev, &dev_attr_sprom);
|
|
}
|