mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-08 01:08:03 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
36
drivers/net/wimax/i2400m/Kconfig
Normal file
36
drivers/net/wimax/i2400m/Kconfig
Normal file
|
@ -0,0 +1,36 @@
|
|||
|
||||
config WIMAX_I2400M
|
||||
tristate
|
||||
depends on WIMAX
|
||||
select FW_LOADER
|
||||
|
||||
comment "Enable USB support to see WiMAX USB drivers"
|
||||
depends on USB = n
|
||||
|
||||
config WIMAX_I2400M_USB
|
||||
tristate "Intel Wireless WiMAX Connection 2400 over USB (including 5x50)"
|
||||
depends on WIMAX && USB
|
||||
select WIMAX_I2400M
|
||||
help
|
||||
Select if you have a device based on the Intel WiMAX
|
||||
Connection 2400 over USB (like any of the Intel Wireless
|
||||
WiMAX/WiFi Link 5x50 series).
|
||||
|
||||
If unsure, it is safe to select M (module).
|
||||
|
||||
config WIMAX_I2400M_DEBUG_LEVEL
|
||||
int "WiMAX i2400m debug level"
|
||||
depends on WIMAX_I2400M
|
||||
default 8
|
||||
help
|
||||
|
||||
Select the maximum debug verbosity level to be compiled into
|
||||
the WiMAX i2400m driver code.
|
||||
|
||||
By default, this is disabled at runtime and can be
|
||||
selectively enabled at runtime for different parts of the
|
||||
code using the sysfs debug-levels file.
|
||||
|
||||
If set at zero, this will compile out all the debug code.
|
||||
|
||||
It is recommended that it is left at 8.
|
22
drivers/net/wimax/i2400m/Makefile
Normal file
22
drivers/net/wimax/i2400m/Makefile
Normal file
|
@ -0,0 +1,22 @@
|
|||
|
||||
obj-$(CONFIG_WIMAX_I2400M) += i2400m.o
|
||||
obj-$(CONFIG_WIMAX_I2400M_USB) += i2400m-usb.o
|
||||
|
||||
i2400m-y := \
|
||||
control.o \
|
||||
driver.o \
|
||||
fw.o \
|
||||
op-rfkill.o \
|
||||
sysfs.o \
|
||||
netdev.o \
|
||||
tx.o \
|
||||
rx.o
|
||||
|
||||
i2400m-$(CONFIG_DEBUG_FS) += debugfs.o
|
||||
|
||||
i2400m-usb-y := \
|
||||
usb-fw.o \
|
||||
usb-notif.o \
|
||||
usb-tx.o \
|
||||
usb-rx.o \
|
||||
usb.o
|
1436
drivers/net/wimax/i2400m/control.c
Normal file
1436
drivers/net/wimax/i2400m/control.c
Normal file
File diff suppressed because it is too large
Load diff
46
drivers/net/wimax/i2400m/debug-levels.h
Normal file
46
drivers/net/wimax/i2400m/debug-levels.h
Normal file
|
@ -0,0 +1,46 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Debug levels control file for the i2400m module
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*/
|
||||
#ifndef __debug_levels__h__
|
||||
#define __debug_levels__h__
|
||||
|
||||
/* Maximum compile and run time debug level for all submodules */
|
||||
#define D_MODULENAME i2400m
|
||||
#define D_MASTER CONFIG_WIMAX_I2400M_DEBUG_LEVEL
|
||||
|
||||
#include <linux/wimax/debug.h>
|
||||
|
||||
/* List of all the enabled modules */
|
||||
enum d_module {
|
||||
D_SUBMODULE_DECLARE(control),
|
||||
D_SUBMODULE_DECLARE(driver),
|
||||
D_SUBMODULE_DECLARE(debugfs),
|
||||
D_SUBMODULE_DECLARE(fw),
|
||||
D_SUBMODULE_DECLARE(netdev),
|
||||
D_SUBMODULE_DECLARE(rfkill),
|
||||
D_SUBMODULE_DECLARE(rx),
|
||||
D_SUBMODULE_DECLARE(sysfs),
|
||||
D_SUBMODULE_DECLARE(tx),
|
||||
};
|
||||
|
||||
|
||||
#endif /* #ifndef __debug_levels__h__ */
|
371
drivers/net/wimax/i2400m/debugfs.c
Normal file
371
drivers/net/wimax/i2400m/debugfs.c
Normal file
|
@ -0,0 +1,371 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Debugfs interfaces to manipulate driver and device information
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007 Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include <linux/debugfs.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/etherdevice.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/export.h>
|
||||
#include "i2400m.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE debugfs
|
||||
#include "debug-levels.h"
|
||||
|
||||
static
|
||||
int debugfs_netdev_queue_stopped_get(void *data, u64 *val)
|
||||
{
|
||||
struct i2400m *i2400m = data;
|
||||
*val = netif_queue_stopped(i2400m->wimax_dev.net_dev);
|
||||
return 0;
|
||||
}
|
||||
DEFINE_SIMPLE_ATTRIBUTE(fops_netdev_queue_stopped,
|
||||
debugfs_netdev_queue_stopped_get,
|
||||
NULL, "%llu\n");
|
||||
|
||||
|
||||
static
|
||||
struct dentry *debugfs_create_netdev_queue_stopped(
|
||||
const char *name, struct dentry *parent, struct i2400m *i2400m)
|
||||
{
|
||||
return debugfs_create_file(name, 0400, parent, i2400m,
|
||||
&fops_netdev_queue_stopped);
|
||||
}
|
||||
|
||||
/*
|
||||
* We don't allow partial reads of this file, as then the reader would
|
||||
* get weirdly confused data as it is updated.
|
||||
*
|
||||
* So or you read it all or nothing; if you try to read with an offset
|
||||
* != 0, we consider you are done reading.
|
||||
*/
|
||||
static
|
||||
ssize_t i2400m_rx_stats_read(struct file *filp, char __user *buffer,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct i2400m *i2400m = filp->private_data;
|
||||
char buf[128];
|
||||
unsigned long flags;
|
||||
|
||||
if (*ppos != 0)
|
||||
return 0;
|
||||
if (count < sizeof(buf))
|
||||
return -ENOSPC;
|
||||
spin_lock_irqsave(&i2400m->rx_lock, flags);
|
||||
snprintf(buf, sizeof(buf), "%u %u %u %u %u %u %u\n",
|
||||
i2400m->rx_pl_num, i2400m->rx_pl_min,
|
||||
i2400m->rx_pl_max, i2400m->rx_num,
|
||||
i2400m->rx_size_acc,
|
||||
i2400m->rx_size_min, i2400m->rx_size_max);
|
||||
spin_unlock_irqrestore(&i2400m->rx_lock, flags);
|
||||
return simple_read_from_buffer(buffer, count, ppos, buf, strlen(buf));
|
||||
}
|
||||
|
||||
|
||||
/* Any write clears the stats */
|
||||
static
|
||||
ssize_t i2400m_rx_stats_write(struct file *filp, const char __user *buffer,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct i2400m *i2400m = filp->private_data;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&i2400m->rx_lock, flags);
|
||||
i2400m->rx_pl_num = 0;
|
||||
i2400m->rx_pl_max = 0;
|
||||
i2400m->rx_pl_min = UINT_MAX;
|
||||
i2400m->rx_num = 0;
|
||||
i2400m->rx_size_acc = 0;
|
||||
i2400m->rx_size_min = UINT_MAX;
|
||||
i2400m->rx_size_max = 0;
|
||||
spin_unlock_irqrestore(&i2400m->rx_lock, flags);
|
||||
return count;
|
||||
}
|
||||
|
||||
static
|
||||
const struct file_operations i2400m_rx_stats_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = simple_open,
|
||||
.read = i2400m_rx_stats_read,
|
||||
.write = i2400m_rx_stats_write,
|
||||
.llseek = default_llseek,
|
||||
};
|
||||
|
||||
|
||||
/* See i2400m_rx_stats_read() */
|
||||
static
|
||||
ssize_t i2400m_tx_stats_read(struct file *filp, char __user *buffer,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct i2400m *i2400m = filp->private_data;
|
||||
char buf[128];
|
||||
unsigned long flags;
|
||||
|
||||
if (*ppos != 0)
|
||||
return 0;
|
||||
if (count < sizeof(buf))
|
||||
return -ENOSPC;
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
snprintf(buf, sizeof(buf), "%u %u %u %u %u %u %u\n",
|
||||
i2400m->tx_pl_num, i2400m->tx_pl_min,
|
||||
i2400m->tx_pl_max, i2400m->tx_num,
|
||||
i2400m->tx_size_acc,
|
||||
i2400m->tx_size_min, i2400m->tx_size_max);
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
return simple_read_from_buffer(buffer, count, ppos, buf, strlen(buf));
|
||||
}
|
||||
|
||||
/* Any write clears the stats */
|
||||
static
|
||||
ssize_t i2400m_tx_stats_write(struct file *filp, const char __user *buffer,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct i2400m *i2400m = filp->private_data;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
i2400m->tx_pl_num = 0;
|
||||
i2400m->tx_pl_max = 0;
|
||||
i2400m->tx_pl_min = UINT_MAX;
|
||||
i2400m->tx_num = 0;
|
||||
i2400m->tx_size_acc = 0;
|
||||
i2400m->tx_size_min = UINT_MAX;
|
||||
i2400m->tx_size_max = 0;
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
return count;
|
||||
}
|
||||
|
||||
static
|
||||
const struct file_operations i2400m_tx_stats_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = simple_open,
|
||||
.read = i2400m_tx_stats_read,
|
||||
.write = i2400m_tx_stats_write,
|
||||
.llseek = default_llseek,
|
||||
};
|
||||
|
||||
|
||||
/* Write 1 to ask the device to go into suspend */
|
||||
static
|
||||
int debugfs_i2400m_suspend_set(void *data, u64 val)
|
||||
{
|
||||
int result;
|
||||
struct i2400m *i2400m = data;
|
||||
result = i2400m_cmd_enter_powersave(i2400m);
|
||||
if (result >= 0)
|
||||
result = 0;
|
||||
return result;
|
||||
}
|
||||
DEFINE_SIMPLE_ATTRIBUTE(fops_i2400m_suspend,
|
||||
NULL, debugfs_i2400m_suspend_set,
|
||||
"%llu\n");
|
||||
|
||||
static
|
||||
struct dentry *debugfs_create_i2400m_suspend(
|
||||
const char *name, struct dentry *parent, struct i2400m *i2400m)
|
||||
{
|
||||
return debugfs_create_file(name, 0200, parent, i2400m,
|
||||
&fops_i2400m_suspend);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Reset the device
|
||||
*
|
||||
* Write 0 to ask the device to soft reset, 1 to cold reset, 2 to bus
|
||||
* reset (as defined by enum i2400m_reset_type).
|
||||
*/
|
||||
static
|
||||
int debugfs_i2400m_reset_set(void *data, u64 val)
|
||||
{
|
||||
int result;
|
||||
struct i2400m *i2400m = data;
|
||||
enum i2400m_reset_type rt = val;
|
||||
switch(rt) {
|
||||
case I2400M_RT_WARM:
|
||||
case I2400M_RT_COLD:
|
||||
case I2400M_RT_BUS:
|
||||
result = i2400m_reset(i2400m, rt);
|
||||
if (result >= 0)
|
||||
result = 0;
|
||||
break;
|
||||
default:
|
||||
result = -EINVAL;
|
||||
}
|
||||
return result;
|
||||
}
|
||||
DEFINE_SIMPLE_ATTRIBUTE(fops_i2400m_reset,
|
||||
NULL, debugfs_i2400m_reset_set,
|
||||
"%llu\n");
|
||||
|
||||
static
|
||||
struct dentry *debugfs_create_i2400m_reset(
|
||||
const char *name, struct dentry *parent, struct i2400m *i2400m)
|
||||
{
|
||||
return debugfs_create_file(name, 0200, parent, i2400m,
|
||||
&fops_i2400m_reset);
|
||||
}
|
||||
|
||||
|
||||
#define __debugfs_register(prefix, name, parent) \
|
||||
do { \
|
||||
result = d_level_register_debugfs(prefix, name, parent); \
|
||||
if (result < 0) \
|
||||
goto error; \
|
||||
} while (0)
|
||||
|
||||
|
||||
int i2400m_debugfs_add(struct i2400m *i2400m)
|
||||
{
|
||||
int result;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct dentry *dentry = i2400m->wimax_dev.debugfs_dentry;
|
||||
struct dentry *fd;
|
||||
|
||||
dentry = debugfs_create_dir("i2400m", dentry);
|
||||
result = PTR_ERR(dentry);
|
||||
if (IS_ERR(dentry)) {
|
||||
if (result == -ENODEV)
|
||||
result = 0; /* No debugfs support */
|
||||
goto error;
|
||||
}
|
||||
i2400m->debugfs_dentry = dentry;
|
||||
__debugfs_register("dl_", control, dentry);
|
||||
__debugfs_register("dl_", driver, dentry);
|
||||
__debugfs_register("dl_", debugfs, dentry);
|
||||
__debugfs_register("dl_", fw, dentry);
|
||||
__debugfs_register("dl_", netdev, dentry);
|
||||
__debugfs_register("dl_", rfkill, dentry);
|
||||
__debugfs_register("dl_", rx, dentry);
|
||||
__debugfs_register("dl_", tx, dentry);
|
||||
|
||||
fd = debugfs_create_size_t("tx_in", 0400, dentry,
|
||||
&i2400m->tx_in);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"tx_in: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_size_t("tx_out", 0400, dentry,
|
||||
&i2400m->tx_out);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"tx_out: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_u32("state", 0600, dentry,
|
||||
&i2400m->state);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"state: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
/*
|
||||
* Trace received messages from user space
|
||||
*
|
||||
* In order to tap the bidirectional message stream in the
|
||||
* 'msg' pipe, user space can read from the 'msg' pipe;
|
||||
* however, due to limitations in libnl, we can't know what
|
||||
* the different applications are sending down to the kernel.
|
||||
*
|
||||
* So we have this hack where the driver will echo any message
|
||||
* received on the msg pipe from user space [through a call to
|
||||
* wimax_dev->op_msg_from_user() into
|
||||
* i2400m_op_msg_from_user()] into the 'trace' pipe that this
|
||||
* driver creates.
|
||||
*
|
||||
* So then, reading from both the 'trace' and 'msg' pipes in
|
||||
* user space will provide a full dump of the traffic.
|
||||
*
|
||||
* Write 1 to activate, 0 to clear.
|
||||
*
|
||||
* It is not really very atomic, but it is also not too
|
||||
* critical.
|
||||
*/
|
||||
fd = debugfs_create_u8("trace_msg_from_user", 0600, dentry,
|
||||
&i2400m->trace_msg_from_user);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"trace_msg_from_user: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_netdev_queue_stopped("netdev_queue_stopped",
|
||||
dentry, i2400m);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"netdev_queue_stopped: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_file("rx_stats", 0600, dentry, i2400m,
|
||||
&i2400m_rx_stats_fops);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"rx_stats: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_file("tx_stats", 0600, dentry, i2400m,
|
||||
&i2400m_tx_stats_fops);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"tx_stats: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_i2400m_suspend("suspend", dentry, i2400m);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry suspend: %d\n",
|
||||
result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_i2400m_reset("reset", dentry, i2400m);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry reset: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
result = 0;
|
||||
error:
|
||||
return result;
|
||||
}
|
||||
|
||||
void i2400m_debugfs_rm(struct i2400m *i2400m)
|
||||
{
|
||||
debugfs_remove_recursive(i2400m->debugfs_dentry);
|
||||
}
|
1025
drivers/net/wimax/i2400m/driver.c
Normal file
1025
drivers/net/wimax/i2400m/driver.c
Normal file
File diff suppressed because it is too large
Load diff
1657
drivers/net/wimax/i2400m/fw.c
Normal file
1657
drivers/net/wimax/i2400m/fw.c
Normal file
File diff suppressed because it is too large
Load diff
275
drivers/net/wimax/i2400m/i2400m-usb.h
Normal file
275
drivers/net/wimax/i2400m/i2400m-usb.h
Normal file
|
@ -0,0 +1,275 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* USB-specific i2400m driver definitions
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* * Neither the name of Intel Corporation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||||
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||||
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
*
|
||||
* Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* - Initial implementation
|
||||
*
|
||||
*
|
||||
* This driver implements the bus-specific part of the i2400m for
|
||||
* USB. Check i2400m.h for a generic driver description.
|
||||
*
|
||||
* ARCHITECTURE
|
||||
*
|
||||
* This driver listens to notifications sent from the notification
|
||||
* endpoint (in usb-notif.c); when data is ready to read, the code in
|
||||
* there schedules a read from the device (usb-rx.c) and then passes
|
||||
* the data to the generic RX code (rx.c).
|
||||
*
|
||||
* When the generic driver needs to send data (network or control), it
|
||||
* queues up in the TX FIFO (tx.c) and that will notify the driver
|
||||
* through the i2400m->bus_tx_kick() callback
|
||||
* (usb-tx.c:i2400mu_bus_tx_kick) which will send the items in the
|
||||
* FIFO queue.
|
||||
*
|
||||
* This driver, as well, implements the USB-specific ops for the generic
|
||||
* driver to be able to setup/teardown communication with the device
|
||||
* [i2400m_bus_dev_start() and i2400m_bus_dev_stop()], reseting the
|
||||
* device [i2400m_bus_reset()] and performing firmware upload
|
||||
* [i2400m_bus_bm_cmd() and i2400_bus_bm_wait_for_ack()].
|
||||
*/
|
||||
|
||||
#ifndef __I2400M_USB_H__
|
||||
#define __I2400M_USB_H__
|
||||
|
||||
#include "i2400m.h"
|
||||
#include <linux/kthread.h>
|
||||
|
||||
|
||||
/*
|
||||
* Error Density Count: cheapo error density (over time) counter
|
||||
*
|
||||
* Originally by Reinette Chatre <reinette.chatre@intel.com>
|
||||
*
|
||||
* Embed an 'struct edc' somewhere. Each time there is a soft or
|
||||
* retryable error, call edc_inc() and check if the error top
|
||||
* watermark has been reached.
|
||||
*/
|
||||
enum {
|
||||
EDC_MAX_ERRORS = 10,
|
||||
EDC_ERROR_TIMEFRAME = HZ,
|
||||
};
|
||||
|
||||
/* error density counter */
|
||||
struct edc {
|
||||
unsigned long timestart;
|
||||
u16 errorcount;
|
||||
};
|
||||
|
||||
struct i2400m_endpoint_cfg {
|
||||
unsigned char bulk_out;
|
||||
unsigned char notification;
|
||||
unsigned char reset_cold;
|
||||
unsigned char bulk_in;
|
||||
};
|
||||
|
||||
static inline void edc_init(struct edc *edc)
|
||||
{
|
||||
edc->timestart = jiffies;
|
||||
}
|
||||
|
||||
/**
|
||||
* edc_inc - report a soft error and check if we are over the watermark
|
||||
*
|
||||
* @edc: pointer to error density counter.
|
||||
* @max_err: maximum number of errors we can accept over the timeframe
|
||||
* @timeframe: length of the timeframe (in jiffies).
|
||||
*
|
||||
* Returns: !0 1 if maximum acceptable errors per timeframe has been
|
||||
* exceeded. 0 otherwise.
|
||||
*
|
||||
* This is way to determine if the number of acceptable errors per time
|
||||
* period has been exceeded. It is not accurate as there are cases in which
|
||||
* this scheme will not work, for example if there are periodic occurrences
|
||||
* of errors that straddle updates to the start time. This scheme is
|
||||
* sufficient for our usage.
|
||||
*
|
||||
* To use, embed a 'struct edc' somewhere, initialize it with
|
||||
* edc_init() and when an error hits:
|
||||
*
|
||||
* if (do_something_fails_with_a_soft_error) {
|
||||
* if (edc_inc(&my->edc, MAX_ERRORS, MAX_TIMEFRAME))
|
||||
* Ops, hard error, do something about it
|
||||
* else
|
||||
* Retry or ignore, depending on whatever
|
||||
* }
|
||||
*/
|
||||
static inline int edc_inc(struct edc *edc, u16 max_err, u16 timeframe)
|
||||
{
|
||||
unsigned long now;
|
||||
|
||||
now = jiffies;
|
||||
if (now - edc->timestart > timeframe) {
|
||||
edc->errorcount = 1;
|
||||
edc->timestart = now;
|
||||
} else if (++edc->errorcount > max_err) {
|
||||
edc->errorcount = 0;
|
||||
edc->timestart = now;
|
||||
return 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Host-Device interface for USB */
|
||||
enum {
|
||||
I2400M_USB_BOOT_RETRIES = 3,
|
||||
I2400MU_MAX_NOTIFICATION_LEN = 256,
|
||||
I2400MU_BLK_SIZE = 16,
|
||||
I2400MU_PL_SIZE_MAX = 0x3EFF,
|
||||
|
||||
/* Device IDs */
|
||||
USB_DEVICE_ID_I6050 = 0x0186,
|
||||
USB_DEVICE_ID_I6050_2 = 0x0188,
|
||||
USB_DEVICE_ID_I6150 = 0x07d6,
|
||||
USB_DEVICE_ID_I6150_2 = 0x07d7,
|
||||
USB_DEVICE_ID_I6150_3 = 0x07d9,
|
||||
USB_DEVICE_ID_I6250 = 0x0187,
|
||||
};
|
||||
|
||||
|
||||
/**
|
||||
* struct i2400mu - descriptor for a USB connected i2400m
|
||||
*
|
||||
* @i2400m: bus-generic i2400m implementation; has to be first (see
|
||||
* it's documentation in i2400m.h).
|
||||
*
|
||||
* @usb_dev: pointer to our USB device
|
||||
*
|
||||
* @usb_iface: pointer to our USB interface
|
||||
*
|
||||
* @urb_edc: error density counter; used to keep a density-on-time tab
|
||||
* on how many soft (retryable or ignorable) errors we get. If we
|
||||
* go over the threshold, we consider the bus transport is failing
|
||||
* too much and reset.
|
||||
*
|
||||
* @notif_urb: URB for receiving notifications from the device.
|
||||
*
|
||||
* @tx_kthread: thread we use for data TX. We use a thread because in
|
||||
* order to do deep power saving and put the device to sleep, we
|
||||
* need to call usb_autopm_*() [blocking functions].
|
||||
*
|
||||
* @tx_wq: waitqueue for the TX kthread to sleep when there is no data
|
||||
* to be sent; when more data is available, it is woken up by
|
||||
* i2400mu_bus_tx_kick().
|
||||
*
|
||||
* @rx_kthread: thread we use for data RX. We use a thread because in
|
||||
* order to do deep power saving and put the device to sleep, we
|
||||
* need to call usb_autopm_*() [blocking functions].
|
||||
*
|
||||
* @rx_wq: waitqueue for the RX kthread to sleep when there is no data
|
||||
* to receive. When data is available, it is woken up by
|
||||
* usb-notif.c:i2400mu_notification_grok().
|
||||
*
|
||||
* @rx_pending_count: number of rx-data-ready notifications that were
|
||||
* still not handled by the RX kthread.
|
||||
*
|
||||
* @rx_size: current RX buffer size that is being used.
|
||||
*
|
||||
* @rx_size_acc: accumulator of the sizes of the previous read
|
||||
* transactions.
|
||||
*
|
||||
* @rx_size_cnt: number of read transactions accumulated in
|
||||
* @rx_size_acc.
|
||||
*
|
||||
* @do_autopm: disable(0)/enable(>0) calling the
|
||||
* usb_autopm_get/put_interface() barriers when executing
|
||||
* commands. See doc in i2400mu_suspend() for more information.
|
||||
*
|
||||
* @rx_size_auto_shrink: if true, the rx_size is shrunk
|
||||
* automatically based on the average size of the received
|
||||
* transactions. This allows the receive code to allocate smaller
|
||||
* chunks of memory and thus reduce pressure on the memory
|
||||
* allocator by not wasting so much space. By default it is
|
||||
* enabled.
|
||||
*
|
||||
* @debugfs_dentry: hookup for debugfs files.
|
||||
* These have to be in a separate directory, a child of
|
||||
* (wimax_dev->debugfs_dentry) so they can be removed when the
|
||||
* module unloads, as we don't keep each dentry.
|
||||
*/
|
||||
struct i2400mu {
|
||||
struct i2400m i2400m; /* FIRST! See doc */
|
||||
|
||||
struct usb_device *usb_dev;
|
||||
struct usb_interface *usb_iface;
|
||||
struct edc urb_edc; /* Error density counter */
|
||||
struct i2400m_endpoint_cfg endpoint_cfg;
|
||||
|
||||
struct urb *notif_urb;
|
||||
struct task_struct *tx_kthread;
|
||||
wait_queue_head_t tx_wq;
|
||||
|
||||
struct task_struct *rx_kthread;
|
||||
wait_queue_head_t rx_wq;
|
||||
atomic_t rx_pending_count;
|
||||
size_t rx_size, rx_size_acc, rx_size_cnt;
|
||||
atomic_t do_autopm;
|
||||
u8 rx_size_auto_shrink;
|
||||
|
||||
struct dentry *debugfs_dentry;
|
||||
unsigned i6050:1; /* 1 if this is a 6050 based SKU */
|
||||
};
|
||||
|
||||
|
||||
static inline
|
||||
void i2400mu_init(struct i2400mu *i2400mu)
|
||||
{
|
||||
i2400m_init(&i2400mu->i2400m);
|
||||
edc_init(&i2400mu->urb_edc);
|
||||
init_waitqueue_head(&i2400mu->tx_wq);
|
||||
atomic_set(&i2400mu->rx_pending_count, 0);
|
||||
init_waitqueue_head(&i2400mu->rx_wq);
|
||||
i2400mu->rx_size = PAGE_SIZE - sizeof(struct skb_shared_info);
|
||||
atomic_set(&i2400mu->do_autopm, 1);
|
||||
i2400mu->rx_size_auto_shrink = 1;
|
||||
}
|
||||
|
||||
int i2400mu_notification_setup(struct i2400mu *);
|
||||
void i2400mu_notification_release(struct i2400mu *);
|
||||
|
||||
int i2400mu_rx_setup(struct i2400mu *);
|
||||
void i2400mu_rx_release(struct i2400mu *);
|
||||
void i2400mu_rx_kick(struct i2400mu *);
|
||||
|
||||
int i2400mu_tx_setup(struct i2400mu *);
|
||||
void i2400mu_tx_release(struct i2400mu *);
|
||||
void i2400mu_bus_tx_kick(struct i2400m *);
|
||||
|
||||
ssize_t i2400mu_bus_bm_cmd_send(struct i2400m *,
|
||||
const struct i2400m_bootrom_header *, size_t,
|
||||
int);
|
||||
ssize_t i2400mu_bus_bm_wait_for_ack(struct i2400m *,
|
||||
struct i2400m_bootrom_header *, size_t);
|
||||
#endif /* #ifndef __I2400M_USB_H__ */
|
973
drivers/net/wimax/i2400m/i2400m.h
Normal file
973
drivers/net/wimax/i2400m/i2400m.h
Normal file
|
@ -0,0 +1,973 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Declarations for bus-generic internal APIs
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* * Neither the name of Intel Corporation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||||
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||||
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
*
|
||||
* Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* - Initial implementation
|
||||
*
|
||||
*
|
||||
* GENERAL DRIVER ARCHITECTURE
|
||||
*
|
||||
* The i2400m driver is split in the following two major parts:
|
||||
*
|
||||
* - bus specific driver
|
||||
* - bus generic driver (this part)
|
||||
*
|
||||
* The bus specific driver sets up stuff specific to the bus the
|
||||
* device is connected to (USB, PCI, tam-tam...non-authoritative
|
||||
* nor binding list) which is basically the device-model management
|
||||
* (probe/disconnect, etc), moving data from device to kernel and
|
||||
* back, doing the power saving details and reseting the device.
|
||||
*
|
||||
* For details on each bus-specific driver, see it's include file,
|
||||
* i2400m-BUSNAME.h
|
||||
*
|
||||
* The bus-generic functionality break up is:
|
||||
*
|
||||
* - Firmware upload: fw.c - takes care of uploading firmware to the
|
||||
* device. bus-specific driver just needs to provides a way to
|
||||
* execute boot-mode commands and to reset the device.
|
||||
*
|
||||
* - RX handling: rx.c - receives data from the bus-specific code and
|
||||
* feeds it to the network or WiMAX stack or uses it to modify
|
||||
* the driver state. bus-specific driver only has to receive
|
||||
* frames and pass them to this module.
|
||||
*
|
||||
* - TX handling: tx.c - manages the TX FIFO queue and provides means
|
||||
* for the bus-specific TX code to pull data from the FIFO
|
||||
* queue. bus-specific code just pulls frames from this module
|
||||
* to sends them to the device.
|
||||
*
|
||||
* - netdev glue: netdev.c - interface with Linux networking
|
||||
* stack. Pass around data frames, and configure when the
|
||||
* device is up and running or shutdown (through ifconfig up /
|
||||
* down). Bus-generic only.
|
||||
*
|
||||
* - control ops: control.c - implements various commands for
|
||||
* controlling the device. bus-generic only.
|
||||
*
|
||||
* - device model glue: driver.c - implements helpers for the
|
||||
* device-model glue done by the bus-specific layer
|
||||
* (setup/release the driver resources), turning the device on
|
||||
* and off, handling the device reboots/resets and a few simple
|
||||
* WiMAX stack ops.
|
||||
*
|
||||
* Code is also broken up in linux-glue / device-glue.
|
||||
*
|
||||
* Linux glue contains functions that deal mostly with gluing with the
|
||||
* rest of the Linux kernel.
|
||||
*
|
||||
* Device-glue are functions that deal mostly with the way the device
|
||||
* does things and talk the device's language.
|
||||
*
|
||||
* device-glue code is licensed BSD so other open source OSes can take
|
||||
* it to implement their drivers.
|
||||
*
|
||||
*
|
||||
* APIs AND HEADER FILES
|
||||
*
|
||||
* This bus generic code exports three APIs:
|
||||
*
|
||||
* - HDI (host-device interface) definitions common to all busses
|
||||
* (include/linux/wimax/i2400m.h); these can be also used by user
|
||||
* space code.
|
||||
* - internal API for the bus-generic code
|
||||
* - external API for the bus-specific drivers
|
||||
*
|
||||
*
|
||||
* LIFE CYCLE:
|
||||
*
|
||||
* When the bus-specific driver probes, it allocates a network device
|
||||
* with enough space for it's data structue, that must contain a
|
||||
* &struct i2400m at the top.
|
||||
*
|
||||
* On probe, it needs to fill the i2400m members marked as [fill], as
|
||||
* well as i2400m->wimax_dev.net_dev and call i2400m_setup(). The
|
||||
* i2400m driver will only register with the WiMAX and network stacks;
|
||||
* the only access done to the device is to read the MAC address so we
|
||||
* can register a network device.
|
||||
*
|
||||
* The high-level call flow is:
|
||||
*
|
||||
* bus_probe()
|
||||
* i2400m_setup()
|
||||
* i2400m->bus_setup()
|
||||
* boot rom initialization / read mac addr
|
||||
* network / WiMAX stacks registration
|
||||
* i2400m_dev_start()
|
||||
* i2400m->bus_dev_start()
|
||||
* i2400m_dev_initialize()
|
||||
*
|
||||
* The reverse applies for a disconnect() call:
|
||||
*
|
||||
* bus_disconnect()
|
||||
* i2400m_release()
|
||||
* i2400m_dev_stop()
|
||||
* i2400m_dev_shutdown()
|
||||
* i2400m->bus_dev_stop()
|
||||
* network / WiMAX stack unregistration
|
||||
* i2400m->bus_release()
|
||||
*
|
||||
* At this point, control and data communications are possible.
|
||||
*
|
||||
* While the device is up, it might reset. The bus-specific driver has
|
||||
* to catch that situation and call i2400m_dev_reset_handle() to deal
|
||||
* with it (reset the internal driver structures and go back to square
|
||||
* one).
|
||||
*/
|
||||
|
||||
#ifndef __I2400M_H__
|
||||
#define __I2400M_H__
|
||||
|
||||
#include <linux/usb.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/completion.h>
|
||||
#include <linux/rwsem.h>
|
||||
#include <linux/atomic.h>
|
||||
#include <net/wimax.h>
|
||||
#include <linux/wimax/i2400m.h>
|
||||
#include <asm/byteorder.h>
|
||||
|
||||
enum {
|
||||
/* netdev interface */
|
||||
/*
|
||||
* Out of NWG spec (R1_v1.2.2), 3.3.3 ASN Bearer Plane MTU Size
|
||||
*
|
||||
* The MTU is 1400 or less
|
||||
*/
|
||||
I2400M_MAX_MTU = 1400,
|
||||
};
|
||||
|
||||
/* Misc constants */
|
||||
enum {
|
||||
/* Size of the Boot Mode Command buffer */
|
||||
I2400M_BM_CMD_BUF_SIZE = 16 * 1024,
|
||||
I2400M_BM_ACK_BUF_SIZE = 256,
|
||||
};
|
||||
|
||||
enum {
|
||||
/* Maximum number of bus reset can be retried */
|
||||
I2400M_BUS_RESET_RETRIES = 3,
|
||||
};
|
||||
|
||||
/**
|
||||
* struct i2400m_poke_table - Hardware poke table for the Intel 2400m
|
||||
*
|
||||
* This structure will be used to create a device specific poke table
|
||||
* to put the device in a consistent state at boot time.
|
||||
*
|
||||
* @address: The device address to poke
|
||||
*
|
||||
* @data: The data value to poke to the device address
|
||||
*
|
||||
*/
|
||||
struct i2400m_poke_table{
|
||||
__le32 address;
|
||||
__le32 data;
|
||||
};
|
||||
|
||||
#define I2400M_FW_POKE(a, d) { \
|
||||
.address = cpu_to_le32(a), \
|
||||
.data = cpu_to_le32(d) \
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* i2400m_reset_type - methods to reset a device
|
||||
*
|
||||
* @I2400M_RT_WARM: Reset without device disconnection, device handles
|
||||
* are kept valid but state is back to power on, with firmware
|
||||
* re-uploaded.
|
||||
* @I2400M_RT_COLD: Tell the device to disconnect itself from the bus
|
||||
* and reconnect. Renders all device handles invalid.
|
||||
* @I2400M_RT_BUS: Tells the bus to reset the device; last measure
|
||||
* used when both types above don't work.
|
||||
*/
|
||||
enum i2400m_reset_type {
|
||||
I2400M_RT_WARM, /* first measure */
|
||||
I2400M_RT_COLD, /* second measure */
|
||||
I2400M_RT_BUS, /* call in artillery */
|
||||
};
|
||||
|
||||
struct i2400m_reset_ctx;
|
||||
struct i2400m_roq;
|
||||
struct i2400m_barker_db;
|
||||
|
||||
/**
|
||||
* struct i2400m - descriptor for an Intel 2400m
|
||||
*
|
||||
* Members marked with [fill] must be filled out/initialized before
|
||||
* calling i2400m_setup().
|
||||
*
|
||||
* Note the @bus_setup/@bus_release, @bus_dev_start/@bus_dev_release
|
||||
* call pairs are very much doing almost the same, and depending on
|
||||
* the underlying bus, some stuff has to be put in one or the
|
||||
* other. The idea of setup/release is that they setup the minimal
|
||||
* amount needed for loading firmware, where us dev_start/stop setup
|
||||
* the rest needed to do full data/control traffic.
|
||||
*
|
||||
* @bus_tx_block_size: [fill] USB imposes a 16 block size, but other
|
||||
* busses will differ. So we have a tx_blk_size variable that the
|
||||
* bus layer sets to tell the engine how much of that we need.
|
||||
*
|
||||
* @bus_tx_room_min: [fill] Minimum room required while allocating
|
||||
* TX queue's buffer space for message header. USB requires
|
||||
* 16 bytes. Refer to bus specific driver code for details.
|
||||
*
|
||||
* @bus_pl_size_max: [fill] Maximum payload size.
|
||||
*
|
||||
* @bus_setup: [optional fill] Function called by the bus-generic code
|
||||
* [i2400m_setup()] to setup the basic bus-specific communications
|
||||
* to the the device needed to load firmware. See LIFE CYCLE above.
|
||||
*
|
||||
* NOTE: Doesn't need to upload the firmware, as that is taken
|
||||
* care of by the bus-generic code.
|
||||
*
|
||||
* @bus_release: [optional fill] Function called by the bus-generic
|
||||
* code [i2400m_release()] to shutdown the basic bus-specific
|
||||
* communications to the the device needed to load firmware. See
|
||||
* LIFE CYCLE above.
|
||||
*
|
||||
* This function does not need to reset the device, just tear down
|
||||
* all the host resources created to handle communication with
|
||||
* the device.
|
||||
*
|
||||
* @bus_dev_start: [optional fill] Function called by the bus-generic
|
||||
* code [i2400m_dev_start()] to do things needed to start the
|
||||
* device. See LIFE CYCLE above.
|
||||
*
|
||||
* NOTE: Doesn't need to upload the firmware, as that is taken
|
||||
* care of by the bus-generic code.
|
||||
*
|
||||
* @bus_dev_stop: [optional fill] Function called by the bus-generic
|
||||
* code [i2400m_dev_stop()] to do things needed for stopping the
|
||||
* device. See LIFE CYCLE above.
|
||||
*
|
||||
* This function does not need to reset the device, just tear down
|
||||
* all the host resources created to handle communication with
|
||||
* the device.
|
||||
*
|
||||
* @bus_tx_kick: [fill] Function called by the bus-generic code to let
|
||||
* the bus-specific code know that there is data available in the
|
||||
* TX FIFO for transmission to the device.
|
||||
*
|
||||
* This function cannot sleep.
|
||||
*
|
||||
* @bus_reset: [fill] Function called by the bus-generic code to reset
|
||||
* the device in in various ways. Doesn't need to wait for the
|
||||
* reset to finish.
|
||||
*
|
||||
* If warm or cold reset fail, this function is expected to do a
|
||||
* bus-specific reset (eg: USB reset) to get the device to a
|
||||
* working state (even if it implies device disconecction).
|
||||
*
|
||||
* Note the warm reset is used by the firmware uploader to
|
||||
* reinitialize the device.
|
||||
*
|
||||
* IMPORTANT: this is called very early in the device setup
|
||||
* process, so it cannot rely on common infrastructure being laid
|
||||
* out.
|
||||
*
|
||||
* IMPORTANT: don't call reset on RT_BUS with i2400m->init_mutex
|
||||
* held, as the .pre/.post reset handlers will deadlock.
|
||||
*
|
||||
* @bus_bm_retries: [fill] How many times shall a firmware upload /
|
||||
* device initialization be retried? Different models of the same
|
||||
* device might need different values, hence it is set by the
|
||||
* bus-specific driver. Note this value is used in two places,
|
||||
* i2400m_fw_dnload() and __i2400m_dev_start(); they won't become
|
||||
* multiplicative (__i2400m_dev_start() calling N times
|
||||
* i2400m_fw_dnload() and this trying N times to download the
|
||||
* firmware), as if __i2400m_dev_start() only retries if the
|
||||
* firmware crashed while initializing the device (not in a
|
||||
* general case).
|
||||
*
|
||||
* @bus_bm_cmd_send: [fill] Function called to send a boot-mode
|
||||
* command. Flags are defined in 'enum i2400m_bm_cmd_flags'. This
|
||||
* is synchronous and has to return 0 if ok or < 0 errno code in
|
||||
* any error condition.
|
||||
*
|
||||
* @bus_bm_wait_for_ack: [fill] Function called to wait for a
|
||||
* boot-mode notification (that can be a response to a previously
|
||||
* issued command or an asynchronous one). Will read until all the
|
||||
* indicated size is read or timeout. Reading more or less data
|
||||
* than asked for is an error condition. Return 0 if ok, < 0 errno
|
||||
* code on error.
|
||||
*
|
||||
* The caller to this function will check if the response is a
|
||||
* barker that indicates the device going into reset mode.
|
||||
*
|
||||
* @bus_fw_names: [fill] a NULL-terminated array with the names of the
|
||||
* firmware images to try loading. This is made a list so we can
|
||||
* support backward compatibility of firmware releases (eg: if we
|
||||
* can't find the default v1.4, we try v1.3). In general, the name
|
||||
* should be i2400m-fw-X-VERSION.sbcf, where X is the bus name.
|
||||
* The list is tried in order and the first one that loads is
|
||||
* used. The fw loader will set i2400m->fw_name to point to the
|
||||
* active firmware image.
|
||||
*
|
||||
* @bus_bm_mac_addr_impaired: [fill] Set to true if the device's MAC
|
||||
* address provided in boot mode is kind of broken and needs to
|
||||
* be re-read later on.
|
||||
*
|
||||
* @bus_bm_pokes_table: [fill/optional] A table of device addresses
|
||||
* and values that will be poked at device init time to move the
|
||||
* device to the correct state for the type of boot/firmware being
|
||||
* used. This table MUST be terminated with (0x000000,
|
||||
* 0x00000000) or bad things will happen.
|
||||
*
|
||||
*
|
||||
* @wimax_dev: WiMAX generic device for linkage into the kernel WiMAX
|
||||
* stack. Due to the way a net_device is allocated, we need to
|
||||
* force this to be the first field so that we can get from
|
||||
* netdev_priv() the right pointer.
|
||||
*
|
||||
* @updown: the device is up and ready for transmitting control and
|
||||
* data packets. This implies @ready (communication infrastructure
|
||||
* with the device is ready) and the device's firmware has been
|
||||
* loaded and the device initialized.
|
||||
*
|
||||
* Write to it only inside a i2400m->init_mutex protected area
|
||||
* followed with a wmb(); rmb() before accesing (unless locked
|
||||
* inside i2400m->init_mutex). Read access can be loose like that
|
||||
* [just using rmb()] because the paths that use this also do
|
||||
* other error checks later on.
|
||||
*
|
||||
* @ready: Communication infrastructure with the device is ready, data
|
||||
* frames can start to be passed around (this is lighter than
|
||||
* using the WiMAX state for certain hot paths).
|
||||
*
|
||||
* Write to it only inside a i2400m->init_mutex protected area
|
||||
* followed with a wmb(); rmb() before accesing (unless locked
|
||||
* inside i2400m->init_mutex). Read access can be loose like that
|
||||
* [just using rmb()] because the paths that use this also do
|
||||
* other error checks later on.
|
||||
*
|
||||
* @rx_reorder: 1 if RX reordering is enabled; this can only be
|
||||
* set at probe time.
|
||||
*
|
||||
* @state: device's state (as reported by it)
|
||||
*
|
||||
* @state_wq: waitqueue that is woken up whenever the state changes
|
||||
*
|
||||
* @tx_lock: spinlock to protect TX members
|
||||
*
|
||||
* @tx_buf: FIFO buffer for TX; we queue data here
|
||||
*
|
||||
* @tx_in: FIFO index for incoming data. Note this doesn't wrap around
|
||||
* and it is always greater than @tx_out.
|
||||
*
|
||||
* @tx_out: FIFO index for outgoing data
|
||||
*
|
||||
* @tx_msg: current TX message that is active in the FIFO for
|
||||
* appending payloads.
|
||||
*
|
||||
* @tx_sequence: current sequence number for TX messages from the
|
||||
* device to the host.
|
||||
*
|
||||
* @tx_msg_size: size of the current message being transmitted by the
|
||||
* bus-specific code.
|
||||
*
|
||||
* @tx_pl_num: total number of payloads sent
|
||||
*
|
||||
* @tx_pl_max: maximum number of payloads sent in a TX message
|
||||
*
|
||||
* @tx_pl_min: minimum number of payloads sent in a TX message
|
||||
*
|
||||
* @tx_num: number of TX messages sent
|
||||
*
|
||||
* @tx_size_acc: number of bytes in all TX messages sent
|
||||
* (this is different to net_dev's statistics as it also counts
|
||||
* control messages).
|
||||
*
|
||||
* @tx_size_min: smallest TX message sent.
|
||||
*
|
||||
* @tx_size_max: biggest TX message sent.
|
||||
*
|
||||
* @rx_lock: spinlock to protect RX members and rx_roq_refcount.
|
||||
*
|
||||
* @rx_pl_num: total number of payloads received
|
||||
*
|
||||
* @rx_pl_max: maximum number of payloads received in a RX message
|
||||
*
|
||||
* @rx_pl_min: minimum number of payloads received in a RX message
|
||||
*
|
||||
* @rx_num: number of RX messages received
|
||||
*
|
||||
* @rx_size_acc: number of bytes in all RX messages received
|
||||
* (this is different to net_dev's statistics as it also counts
|
||||
* control messages).
|
||||
*
|
||||
* @rx_size_min: smallest RX message received.
|
||||
*
|
||||
* @rx_size_max: buggest RX message received.
|
||||
*
|
||||
* @rx_roq: RX ReOrder queues. (fw >= v1.4) When packets are received
|
||||
* out of order, the device will ask the driver to hold certain
|
||||
* packets until the ones that are received out of order can be
|
||||
* delivered. Then the driver can release them to the host. See
|
||||
* drivers/net/i2400m/rx.c for details.
|
||||
*
|
||||
* @rx_roq_refcount: refcount rx_roq. This refcounts any access to
|
||||
* rx_roq thus preventing rx_roq being destroyed when rx_roq
|
||||
* is being accessed. rx_roq_refcount is protected by rx_lock.
|
||||
*
|
||||
* @rx_reports: reports received from the device that couldn't be
|
||||
* processed because the driver wasn't still ready; when ready,
|
||||
* they are pulled from here and chewed.
|
||||
*
|
||||
* @rx_reports_ws: Work struct used to kick a scan of the RX reports
|
||||
* list and to process each.
|
||||
*
|
||||
* @src_mac_addr: MAC address used to make ethernet packets be coming
|
||||
* from. This is generated at i2400m_setup() time and used during
|
||||
* the life cycle of the instance. See i2400m_fake_eth_header().
|
||||
*
|
||||
* @init_mutex: Mutex used for serializing the device bringup
|
||||
* sequence; this way if the device reboots in the middle, we
|
||||
* don't try to do a bringup again while we are tearing down the
|
||||
* one that failed.
|
||||
*
|
||||
* Can't reuse @msg_mutex because from within the bringup sequence
|
||||
* we need to send messages to the device and thus use @msg_mutex.
|
||||
*
|
||||
* @msg_mutex: mutex used to send control commands to the device (we
|
||||
* only allow one at a time, per host-device interface design).
|
||||
*
|
||||
* @msg_completion: used to wait for an ack to a control command sent
|
||||
* to the device.
|
||||
*
|
||||
* @ack_skb: used to store the actual ack to a control command if the
|
||||
* reception of the command was successful. Otherwise, a ERR_PTR()
|
||||
* errno code that indicates what failed with the ack reception.
|
||||
*
|
||||
* Only valid after @msg_completion is woken up. Only updateable
|
||||
* if @msg_completion is armed. Only touched by
|
||||
* i2400m_msg_to_dev().
|
||||
*
|
||||
* Protected by @rx_lock. In theory the command execution flow is
|
||||
* sequential, but in case the device sends an out-of-phase or
|
||||
* very delayed response, we need to avoid it trampling current
|
||||
* execution.
|
||||
*
|
||||
* @bm_cmd_buf: boot mode command buffer for composing firmware upload
|
||||
* commands.
|
||||
*
|
||||
* USB can't r/w to stack, vmalloc, etc...as well, we end up
|
||||
* having to alloc/free a lot to compose commands, so we use these
|
||||
* for stagging and not having to realloc all the time.
|
||||
*
|
||||
* This assumes the code always runs serialized. Only one thread
|
||||
* can call i2400m_bm_cmd() at the same time.
|
||||
*
|
||||
* @bm_ack_buf: boot mode acknoledge buffer for staging reception of
|
||||
* responses to commands.
|
||||
*
|
||||
* See @bm_cmd_buf.
|
||||
*
|
||||
* @work_queue: work queue for processing device reports. This
|
||||
* workqueue cannot be used for processing TX or RX to the device,
|
||||
* as from it we'll process device reports, which might require
|
||||
* further communication with the device.
|
||||
*
|
||||
* @debugfs_dentry: hookup for debugfs files.
|
||||
* These have to be in a separate directory, a child of
|
||||
* (wimax_dev->debugfs_dentry) so they can be removed when the
|
||||
* module unloads, as we don't keep each dentry.
|
||||
*
|
||||
* @fw_name: name of the firmware image that is currently being used.
|
||||
*
|
||||
* @fw_version: version of the firmware interface, Major.minor,
|
||||
* encoded in the high word and low word (major << 16 | minor).
|
||||
*
|
||||
* @fw_hdrs: NULL terminated array of pointers to the firmware
|
||||
* headers. This is only available during firmware load time.
|
||||
*
|
||||
* @fw_cached: Used to cache firmware when the system goes to
|
||||
* suspend/standby/hibernation (as on resume we can't read it). If
|
||||
* NULL, no firmware was cached, read it. If ~0, you can't read
|
||||
* any firmware files (the system still didn't come out of suspend
|
||||
* and failed to cache one), so abort; otherwise, a valid cached
|
||||
* firmware to be used. Access to this variable is protected by
|
||||
* the spinlock i2400m->rx_lock.
|
||||
*
|
||||
* @barker: barker type that the device uses; this is initialized by
|
||||
* i2400m_is_boot_barker() the first time it is called. Then it
|
||||
* won't change during the life cycle of the device and every time
|
||||
* a boot barker is received, it is just verified for it being the
|
||||
* same.
|
||||
*
|
||||
* @pm_notifier: used to register for PM events
|
||||
*
|
||||
* @bus_reset_retries: counter for the number of bus resets attempted for
|
||||
* this boot. It's not for tracking the number of bus resets during
|
||||
* the whole driver life cycle (from insmod to rmmod) but for the
|
||||
* number of dev_start() executed until dev_start() returns a success
|
||||
* (ie: a good boot means a dev_stop() followed by a successful
|
||||
* dev_start()). dev_reset_handler() increments this counter whenever
|
||||
* it is triggering a bus reset. It checks this counter to decide if a
|
||||
* subsequent bus reset should be retried. dev_reset_handler() retries
|
||||
* the bus reset until dev_start() succeeds or the counter reaches
|
||||
* I2400M_BUS_RESET_RETRIES. The counter is cleared to 0 in
|
||||
* dev_reset_handle() when dev_start() returns a success,
|
||||
* ie: a successul boot is completed.
|
||||
*
|
||||
* @alive: flag to denote if the device *should* be alive. This flag is
|
||||
* everything like @updown (see doc for @updown) except reflecting
|
||||
* the device state *we expect* rather than the actual state as denoted
|
||||
* by @updown. It is set 1 whenever @updown is set 1 in dev_start().
|
||||
* Then the device is expected to be alive all the time
|
||||
* (i2400m->alive remains 1) until the driver is removed. Therefore
|
||||
* all the device reboot events detected can be still handled properly
|
||||
* by either dev_reset_handle() or .pre_reset/.post_reset as long as
|
||||
* the driver presents. It is set 0 along with @updown in dev_stop().
|
||||
*
|
||||
* @error_recovery: flag to denote if we are ready to take an error recovery.
|
||||
* 0 for ready to take an error recovery; 1 for not ready. It is
|
||||
* initialized to 1 while probe() since we don't tend to take any error
|
||||
* recovery during probe(). It is decremented by 1 whenever dev_start()
|
||||
* succeeds to indicate we are ready to take error recovery from now on.
|
||||
* It is checked every time we wanna schedule an error recovery. If an
|
||||
* error recovery is already in place (error_recovery was set 1), we
|
||||
* should not schedule another one until the last one is done.
|
||||
*/
|
||||
struct i2400m {
|
||||
struct wimax_dev wimax_dev; /* FIRST! See doc */
|
||||
|
||||
unsigned updown:1; /* Network device is up or down */
|
||||
unsigned boot_mode:1; /* is the device in boot mode? */
|
||||
unsigned sboot:1; /* signed or unsigned fw boot */
|
||||
unsigned ready:1; /* Device comm infrastructure ready */
|
||||
unsigned rx_reorder:1; /* RX reorder is enabled */
|
||||
u8 trace_msg_from_user; /* echo rx msgs to 'trace' pipe */
|
||||
/* typed u8 so /sys/kernel/debug/u8 can tweak */
|
||||
enum i2400m_system_state state;
|
||||
wait_queue_head_t state_wq; /* Woken up when on state updates */
|
||||
|
||||
size_t bus_tx_block_size;
|
||||
size_t bus_tx_room_min;
|
||||
size_t bus_pl_size_max;
|
||||
unsigned bus_bm_retries;
|
||||
|
||||
int (*bus_setup)(struct i2400m *);
|
||||
int (*bus_dev_start)(struct i2400m *);
|
||||
void (*bus_dev_stop)(struct i2400m *);
|
||||
void (*bus_release)(struct i2400m *);
|
||||
void (*bus_tx_kick)(struct i2400m *);
|
||||
int (*bus_reset)(struct i2400m *, enum i2400m_reset_type);
|
||||
ssize_t (*bus_bm_cmd_send)(struct i2400m *,
|
||||
const struct i2400m_bootrom_header *,
|
||||
size_t, int flags);
|
||||
ssize_t (*bus_bm_wait_for_ack)(struct i2400m *,
|
||||
struct i2400m_bootrom_header *, size_t);
|
||||
const char **bus_fw_names;
|
||||
unsigned bus_bm_mac_addr_impaired:1;
|
||||
const struct i2400m_poke_table *bus_bm_pokes_table;
|
||||
|
||||
spinlock_t tx_lock; /* protect TX state */
|
||||
void *tx_buf;
|
||||
size_t tx_in, tx_out;
|
||||
struct i2400m_msg_hdr *tx_msg;
|
||||
size_t tx_sequence, tx_msg_size;
|
||||
/* TX stats */
|
||||
unsigned tx_pl_num, tx_pl_max, tx_pl_min,
|
||||
tx_num, tx_size_acc, tx_size_min, tx_size_max;
|
||||
|
||||
/* RX stuff */
|
||||
/* protect RX state and rx_roq_refcount */
|
||||
spinlock_t rx_lock;
|
||||
unsigned rx_pl_num, rx_pl_max, rx_pl_min,
|
||||
rx_num, rx_size_acc, rx_size_min, rx_size_max;
|
||||
struct i2400m_roq *rx_roq; /* access is refcounted */
|
||||
struct kref rx_roq_refcount; /* refcount access to rx_roq */
|
||||
u8 src_mac_addr[ETH_HLEN];
|
||||
struct list_head rx_reports; /* under rx_lock! */
|
||||
struct work_struct rx_report_ws;
|
||||
|
||||
struct mutex msg_mutex; /* serialize command execution */
|
||||
struct completion msg_completion;
|
||||
struct sk_buff *ack_skb; /* protected by rx_lock */
|
||||
|
||||
void *bm_ack_buf; /* for receiving acks over USB */
|
||||
void *bm_cmd_buf; /* for issuing commands over USB */
|
||||
|
||||
struct workqueue_struct *work_queue;
|
||||
|
||||
struct mutex init_mutex; /* protect bringup seq */
|
||||
struct i2400m_reset_ctx *reset_ctx; /* protected by init_mutex */
|
||||
|
||||
struct work_struct wake_tx_ws;
|
||||
struct sk_buff *wake_tx_skb;
|
||||
|
||||
struct work_struct reset_ws;
|
||||
const char *reset_reason;
|
||||
|
||||
struct work_struct recovery_ws;
|
||||
|
||||
struct dentry *debugfs_dentry;
|
||||
const char *fw_name; /* name of the current firmware image */
|
||||
unsigned long fw_version; /* version of the firmware interface */
|
||||
const struct i2400m_bcf_hdr **fw_hdrs;
|
||||
struct i2400m_fw *fw_cached; /* protected by rx_lock */
|
||||
struct i2400m_barker_db *barker;
|
||||
|
||||
struct notifier_block pm_notifier;
|
||||
|
||||
/* counting bus reset retries in this boot */
|
||||
atomic_t bus_reset_retries;
|
||||
|
||||
/* if the device is expected to be alive */
|
||||
unsigned alive;
|
||||
|
||||
/* 0 if we are ready for error recovery; 1 if not ready */
|
||||
atomic_t error_recovery;
|
||||
|
||||
};
|
||||
|
||||
|
||||
/*
|
||||
* Bus-generic internal APIs
|
||||
* -------------------------
|
||||
*/
|
||||
|
||||
static inline
|
||||
struct i2400m *wimax_dev_to_i2400m(struct wimax_dev *wimax_dev)
|
||||
{
|
||||
return container_of(wimax_dev, struct i2400m, wimax_dev);
|
||||
}
|
||||
|
||||
static inline
|
||||
struct i2400m *net_dev_to_i2400m(struct net_device *net_dev)
|
||||
{
|
||||
return wimax_dev_to_i2400m(netdev_priv(net_dev));
|
||||
}
|
||||
|
||||
/*
|
||||
* Boot mode support
|
||||
*/
|
||||
|
||||
/**
|
||||
* i2400m_bm_cmd_flags - flags to i2400m_bm_cmd()
|
||||
*
|
||||
* @I2400M_BM_CMD_RAW: send the command block as-is, without doing any
|
||||
* extra processing for adding CRC.
|
||||
*/
|
||||
enum i2400m_bm_cmd_flags {
|
||||
I2400M_BM_CMD_RAW = 1 << 2,
|
||||
};
|
||||
|
||||
/**
|
||||
* i2400m_bri - Boot-ROM indicators
|
||||
*
|
||||
* Flags for i2400m_bootrom_init() and i2400m_dev_bootstrap() [which
|
||||
* are passed from things like i2400m_setup()]. Can be combined with
|
||||
* |.
|
||||
*
|
||||
* @I2400M_BRI_SOFT: The device rebooted already and a reboot
|
||||
* barker received, proceed directly to ack the boot sequence.
|
||||
* @I2400M_BRI_NO_REBOOT: Do not reboot the device and proceed
|
||||
* directly to wait for a reboot barker from the device.
|
||||
* @I2400M_BRI_MAC_REINIT: We need to reinitialize the boot
|
||||
* rom after reading the MAC address. This is quite a dirty hack,
|
||||
* if you ask me -- the device requires the bootrom to be
|
||||
* initialized after reading the MAC address.
|
||||
*/
|
||||
enum i2400m_bri {
|
||||
I2400M_BRI_SOFT = 1 << 1,
|
||||
I2400M_BRI_NO_REBOOT = 1 << 2,
|
||||
I2400M_BRI_MAC_REINIT = 1 << 3,
|
||||
};
|
||||
|
||||
void i2400m_bm_cmd_prepare(struct i2400m_bootrom_header *);
|
||||
int i2400m_dev_bootstrap(struct i2400m *, enum i2400m_bri);
|
||||
int i2400m_read_mac_addr(struct i2400m *);
|
||||
int i2400m_bootrom_init(struct i2400m *, enum i2400m_bri);
|
||||
int i2400m_is_boot_barker(struct i2400m *, const void *, size_t);
|
||||
static inline
|
||||
int i2400m_is_d2h_barker(const void *buf)
|
||||
{
|
||||
const __le32 *barker = buf;
|
||||
return le32_to_cpu(*barker) == I2400M_D2H_MSG_BARKER;
|
||||
}
|
||||
void i2400m_unknown_barker(struct i2400m *, const void *, size_t);
|
||||
|
||||
/* Make/grok boot-rom header commands */
|
||||
|
||||
static inline
|
||||
__le32 i2400m_brh_command(enum i2400m_brh_opcode opcode, unsigned use_checksum,
|
||||
unsigned direct_access)
|
||||
{
|
||||
return cpu_to_le32(
|
||||
I2400M_BRH_SIGNATURE
|
||||
| (direct_access ? I2400M_BRH_DIRECT_ACCESS : 0)
|
||||
| I2400M_BRH_RESPONSE_REQUIRED /* response always required */
|
||||
| (use_checksum ? I2400M_BRH_USE_CHECKSUM : 0)
|
||||
| (opcode & I2400M_BRH_OPCODE_MASK));
|
||||
}
|
||||
|
||||
static inline
|
||||
void i2400m_brh_set_opcode(struct i2400m_bootrom_header *hdr,
|
||||
enum i2400m_brh_opcode opcode)
|
||||
{
|
||||
hdr->command = cpu_to_le32(
|
||||
(le32_to_cpu(hdr->command) & ~I2400M_BRH_OPCODE_MASK)
|
||||
| (opcode & I2400M_BRH_OPCODE_MASK));
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_brh_get_opcode(const struct i2400m_bootrom_header *hdr)
|
||||
{
|
||||
return le32_to_cpu(hdr->command) & I2400M_BRH_OPCODE_MASK;
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_brh_get_response(const struct i2400m_bootrom_header *hdr)
|
||||
{
|
||||
return (le32_to_cpu(hdr->command) & I2400M_BRH_RESPONSE_MASK)
|
||||
>> I2400M_BRH_RESPONSE_SHIFT;
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_brh_get_use_checksum(const struct i2400m_bootrom_header *hdr)
|
||||
{
|
||||
return le32_to_cpu(hdr->command) & I2400M_BRH_USE_CHECKSUM;
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_brh_get_response_required(
|
||||
const struct i2400m_bootrom_header *hdr)
|
||||
{
|
||||
return le32_to_cpu(hdr->command) & I2400M_BRH_RESPONSE_REQUIRED;
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_brh_get_direct_access(const struct i2400m_bootrom_header *hdr)
|
||||
{
|
||||
return le32_to_cpu(hdr->command) & I2400M_BRH_DIRECT_ACCESS;
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_brh_get_signature(const struct i2400m_bootrom_header *hdr)
|
||||
{
|
||||
return (le32_to_cpu(hdr->command) & I2400M_BRH_SIGNATURE_MASK)
|
||||
>> I2400M_BRH_SIGNATURE_SHIFT;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Driver / device setup and internal functions
|
||||
*/
|
||||
void i2400m_init(struct i2400m *);
|
||||
int i2400m_reset(struct i2400m *, enum i2400m_reset_type);
|
||||
void i2400m_netdev_setup(struct net_device *net_dev);
|
||||
int i2400m_sysfs_setup(struct device_driver *);
|
||||
void i2400m_sysfs_release(struct device_driver *);
|
||||
int i2400m_tx_setup(struct i2400m *);
|
||||
void i2400m_wake_tx_work(struct work_struct *);
|
||||
void i2400m_tx_release(struct i2400m *);
|
||||
|
||||
int i2400m_rx_setup(struct i2400m *);
|
||||
void i2400m_rx_release(struct i2400m *);
|
||||
|
||||
void i2400m_fw_cache(struct i2400m *);
|
||||
void i2400m_fw_uncache(struct i2400m *);
|
||||
|
||||
void i2400m_net_rx(struct i2400m *, struct sk_buff *, unsigned, const void *,
|
||||
int);
|
||||
void i2400m_net_erx(struct i2400m *, struct sk_buff *, enum i2400m_cs);
|
||||
void i2400m_net_wake_stop(struct i2400m *);
|
||||
enum i2400m_pt;
|
||||
int i2400m_tx(struct i2400m *, const void *, size_t, enum i2400m_pt);
|
||||
|
||||
#ifdef CONFIG_DEBUG_FS
|
||||
int i2400m_debugfs_add(struct i2400m *);
|
||||
void i2400m_debugfs_rm(struct i2400m *);
|
||||
#else
|
||||
static inline int i2400m_debugfs_add(struct i2400m *i2400m)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
static inline void i2400m_debugfs_rm(struct i2400m *i2400m) {}
|
||||
#endif
|
||||
|
||||
/* Initialize/shutdown the device */
|
||||
int i2400m_dev_initialize(struct i2400m *);
|
||||
void i2400m_dev_shutdown(struct i2400m *);
|
||||
|
||||
extern struct attribute_group i2400m_dev_attr_group;
|
||||
|
||||
|
||||
/* HDI message's payload description handling */
|
||||
|
||||
static inline
|
||||
size_t i2400m_pld_size(const struct i2400m_pld *pld)
|
||||
{
|
||||
return I2400M_PLD_SIZE_MASK & le32_to_cpu(pld->val);
|
||||
}
|
||||
|
||||
static inline
|
||||
enum i2400m_pt i2400m_pld_type(const struct i2400m_pld *pld)
|
||||
{
|
||||
return (I2400M_PLD_TYPE_MASK & le32_to_cpu(pld->val))
|
||||
>> I2400M_PLD_TYPE_SHIFT;
|
||||
}
|
||||
|
||||
static inline
|
||||
void i2400m_pld_set(struct i2400m_pld *pld, size_t size,
|
||||
enum i2400m_pt type)
|
||||
{
|
||||
pld->val = cpu_to_le32(
|
||||
((type << I2400M_PLD_TYPE_SHIFT) & I2400M_PLD_TYPE_MASK)
|
||||
| (size & I2400M_PLD_SIZE_MASK));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* API for the bus-specific drivers
|
||||
* --------------------------------
|
||||
*/
|
||||
|
||||
static inline
|
||||
struct i2400m *i2400m_get(struct i2400m *i2400m)
|
||||
{
|
||||
dev_hold(i2400m->wimax_dev.net_dev);
|
||||
return i2400m;
|
||||
}
|
||||
|
||||
static inline
|
||||
void i2400m_put(struct i2400m *i2400m)
|
||||
{
|
||||
dev_put(i2400m->wimax_dev.net_dev);
|
||||
}
|
||||
|
||||
int i2400m_dev_reset_handle(struct i2400m *, const char *);
|
||||
int i2400m_pre_reset(struct i2400m *);
|
||||
int i2400m_post_reset(struct i2400m *);
|
||||
void i2400m_error_recovery(struct i2400m *);
|
||||
|
||||
/*
|
||||
* _setup()/_release() are called by the probe/disconnect functions of
|
||||
* the bus-specific drivers.
|
||||
*/
|
||||
int i2400m_setup(struct i2400m *, enum i2400m_bri bm_flags);
|
||||
void i2400m_release(struct i2400m *);
|
||||
|
||||
int i2400m_rx(struct i2400m *, struct sk_buff *);
|
||||
struct i2400m_msg_hdr *i2400m_tx_msg_get(struct i2400m *, size_t *);
|
||||
void i2400m_tx_msg_sent(struct i2400m *);
|
||||
|
||||
|
||||
/*
|
||||
* Utility functions
|
||||
*/
|
||||
|
||||
static inline
|
||||
struct device *i2400m_dev(struct i2400m *i2400m)
|
||||
{
|
||||
return i2400m->wimax_dev.net_dev->dev.parent;
|
||||
}
|
||||
|
||||
int i2400m_msg_check_status(const struct i2400m_l3l4_hdr *, char *, size_t);
|
||||
int i2400m_msg_size_check(struct i2400m *, const struct i2400m_l3l4_hdr *,
|
||||
size_t);
|
||||
struct sk_buff *i2400m_msg_to_dev(struct i2400m *, const void *, size_t);
|
||||
void i2400m_msg_to_dev_cancel_wait(struct i2400m *, int);
|
||||
void i2400m_report_hook(struct i2400m *, const struct i2400m_l3l4_hdr *,
|
||||
size_t);
|
||||
void i2400m_report_hook_work(struct work_struct *);
|
||||
int i2400m_cmd_enter_powersave(struct i2400m *);
|
||||
int i2400m_cmd_exit_idle(struct i2400m *);
|
||||
struct sk_buff *i2400m_get_device_info(struct i2400m *);
|
||||
int i2400m_firmware_check(struct i2400m *);
|
||||
int i2400m_set_idle_timeout(struct i2400m *, unsigned);
|
||||
|
||||
static inline
|
||||
struct usb_endpoint_descriptor *usb_get_epd(struct usb_interface *iface, int ep)
|
||||
{
|
||||
return &iface->cur_altsetting->endpoint[ep].desc;
|
||||
}
|
||||
|
||||
int i2400m_op_rfkill_sw_toggle(struct wimax_dev *, enum wimax_rf_state);
|
||||
void i2400m_report_tlv_rf_switches_status(struct i2400m *,
|
||||
const struct i2400m_tlv_rf_switches_status *);
|
||||
|
||||
/*
|
||||
* Helpers for firmware backwards compatibility
|
||||
*
|
||||
* As we aim to support at least the firmware version that was
|
||||
* released with the previous kernel/driver release, some code will be
|
||||
* conditionally executed depending on the firmware version. On each
|
||||
* release, the code to support fw releases past the last two ones
|
||||
* will be purged.
|
||||
*
|
||||
* By making it depend on this macros, it is easier to keep it a tab
|
||||
* on what has to go and what not.
|
||||
*/
|
||||
static inline
|
||||
unsigned i2400m_le_v1_3(struct i2400m *i2400m)
|
||||
{
|
||||
/* running fw is lower or v1.3 */
|
||||
return i2400m->fw_version <= 0x00090001;
|
||||
}
|
||||
|
||||
static inline
|
||||
unsigned i2400m_ge_v1_4(struct i2400m *i2400m)
|
||||
{
|
||||
/* running fw is higher or v1.4 */
|
||||
return i2400m->fw_version >= 0x00090002;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Do a millisecond-sleep for allowing wireshark to dump all the data
|
||||
* packets. Used only for debugging.
|
||||
*/
|
||||
static inline
|
||||
void __i2400m_msleep(unsigned ms)
|
||||
{
|
||||
#if 1
|
||||
#else
|
||||
msleep(ms);
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
/* module initialization helpers */
|
||||
int i2400m_barker_db_init(const char *);
|
||||
void i2400m_barker_db_exit(void);
|
||||
|
||||
|
||||
|
||||
#endif /* #ifndef __I2400M_H__ */
|
638
drivers/net/wimax/i2400m/netdev.c
Normal file
638
drivers/net/wimax/i2400m/netdev.c
Normal file
|
@ -0,0 +1,638 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Glue with the networking stack
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007 Intel Corporation <linux-wimax@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*
|
||||
*
|
||||
* This implements an ethernet device for the i2400m.
|
||||
*
|
||||
* We fake being an ethernet device to simplify the support from user
|
||||
* space and from the other side. The world is (sadly) configured to
|
||||
* take in only Ethernet devices...
|
||||
*
|
||||
* Because of this, when using firmwares <= v1.3, there is an
|
||||
* copy-each-rxed-packet overhead on the RX path. Each IP packet has
|
||||
* to be reallocated to add an ethernet header (as there is no space
|
||||
* in what we get from the device). This is a known drawback and
|
||||
* firmwares >= 1.4 add header space that can be used to insert the
|
||||
* ethernet header without having to reallocate and copy.
|
||||
*
|
||||
* TX error handling is tricky; because we have to FIFO/queue the
|
||||
* buffers for transmission (as the hardware likes it aggregated), we
|
||||
* just give the skb to the TX subsystem and by the time it is
|
||||
* transmitted, we have long forgotten about it. So we just don't care
|
||||
* too much about it.
|
||||
*
|
||||
* Note that when the device is in idle mode with the basestation, we
|
||||
* need to negotiate coming back up online. That involves negotiation
|
||||
* and possible user space interaction. Thus, we defer to a workqueue
|
||||
* to do all that. By default, we only queue a single packet and drop
|
||||
* the rest, as potentially the time to go back from idle to normal is
|
||||
* long.
|
||||
*
|
||||
* ROADMAP
|
||||
*
|
||||
* i2400m_open Called on ifconfig up
|
||||
* i2400m_stop Called on ifconfig down
|
||||
*
|
||||
* i2400m_hard_start_xmit Called by the network stack to send a packet
|
||||
* i2400m_net_wake_tx Wake up device from basestation-IDLE & TX
|
||||
* i2400m_wake_tx_work
|
||||
* i2400m_cmd_exit_idle
|
||||
* i2400m_tx
|
||||
* i2400m_net_tx TX a data frame
|
||||
* i2400m_tx
|
||||
*
|
||||
* i2400m_change_mtu Called on ifconfig mtu XXX
|
||||
*
|
||||
* i2400m_tx_timeout Called when the device times out
|
||||
*
|
||||
* i2400m_net_rx Called by the RX code when a data frame is
|
||||
* available (firmware <= 1.3)
|
||||
* i2400m_net_erx Called by the RX code when a data frame is
|
||||
* available (firmware >= 1.4).
|
||||
* i2400m_netdev_setup Called to setup all the netdev stuff from
|
||||
* alloc_netdev.
|
||||
*/
|
||||
#include <linux/if_arp.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/ethtool.h>
|
||||
#include <linux/export.h>
|
||||
#include "i2400m.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE netdev
|
||||
#include "debug-levels.h"
|
||||
|
||||
enum {
|
||||
/* netdev interface */
|
||||
/* 20 secs? yep, this is the maximum timeout that the device
|
||||
* might take to get out of IDLE / negotiate it with the base
|
||||
* station. We add 1sec for good measure. */
|
||||
I2400M_TX_TIMEOUT = 21 * HZ,
|
||||
/*
|
||||
* Experimentation has determined that, 20 to be a good value
|
||||
* for minimizing the jitter in the throughput.
|
||||
*/
|
||||
I2400M_TX_QLEN = 20,
|
||||
};
|
||||
|
||||
|
||||
static
|
||||
int i2400m_open(struct net_device *net_dev)
|
||||
{
|
||||
int result;
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
|
||||
d_fnstart(3, dev, "(net_dev %p [i2400m %p])\n", net_dev, i2400m);
|
||||
/* Make sure we wait until init is complete... */
|
||||
mutex_lock(&i2400m->init_mutex);
|
||||
if (i2400m->updown)
|
||||
result = 0;
|
||||
else
|
||||
result = -EBUSY;
|
||||
mutex_unlock(&i2400m->init_mutex);
|
||||
d_fnend(3, dev, "(net_dev %p [i2400m %p]) = %d\n",
|
||||
net_dev, i2400m, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int i2400m_stop(struct net_device *net_dev)
|
||||
{
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
|
||||
d_fnstart(3, dev, "(net_dev %p [i2400m %p])\n", net_dev, i2400m);
|
||||
i2400m_net_wake_stop(i2400m);
|
||||
d_fnend(3, dev, "(net_dev %p [i2400m %p]) = 0\n", net_dev, i2400m);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Wake up the device and transmit a held SKB, then restart the net queue
|
||||
*
|
||||
* When the device goes into basestation-idle mode, we need to tell it
|
||||
* to exit that mode; it will negotiate with the base station, user
|
||||
* space may have to intervene to rehandshake crypto and then tell us
|
||||
* when it is ready to transmit the packet we have "queued". Still we
|
||||
* need to give it sometime after it reports being ok.
|
||||
*
|
||||
* On error, there is not much we can do. If the error was on TX, we
|
||||
* still wake the queue up to see if the next packet will be luckier.
|
||||
*
|
||||
* If _cmd_exit_idle() fails...well, it could be many things; most
|
||||
* commonly it is that something else took the device out of IDLE mode
|
||||
* (for example, the base station). In that case we get an -EILSEQ and
|
||||
* we are just going to ignore that one. If the device is back to
|
||||
* connected, then fine -- if it is someother state, the packet will
|
||||
* be dropped anyway.
|
||||
*/
|
||||
void i2400m_wake_tx_work(struct work_struct *ws)
|
||||
{
|
||||
int result;
|
||||
struct i2400m *i2400m = container_of(ws, struct i2400m, wake_tx_ws);
|
||||
struct net_device *net_dev = i2400m->wimax_dev.net_dev;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct sk_buff *skb;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
skb = i2400m->wake_tx_skb;
|
||||
i2400m->wake_tx_skb = NULL;
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
|
||||
d_fnstart(3, dev, "(ws %p i2400m %p skb %p)\n", ws, i2400m, skb);
|
||||
result = -EINVAL;
|
||||
if (skb == NULL) {
|
||||
dev_err(dev, "WAKE&TX: skb disappeared!\n");
|
||||
goto out_put;
|
||||
}
|
||||
/* If we have, somehow, lost the connection after this was
|
||||
* queued, don't do anything; this might be the device got
|
||||
* reset or just disconnected. */
|
||||
if (unlikely(!netif_carrier_ok(net_dev)))
|
||||
goto out_kfree;
|
||||
result = i2400m_cmd_exit_idle(i2400m);
|
||||
if (result == -EILSEQ)
|
||||
result = 0;
|
||||
if (result < 0) {
|
||||
dev_err(dev, "WAKE&TX: device didn't get out of idle: "
|
||||
"%d - resetting\n", result);
|
||||
i2400m_reset(i2400m, I2400M_RT_BUS);
|
||||
goto error;
|
||||
}
|
||||
result = wait_event_timeout(i2400m->state_wq,
|
||||
i2400m->state != I2400M_SS_IDLE,
|
||||
net_dev->watchdog_timeo - HZ/2);
|
||||
if (result == 0)
|
||||
result = -ETIMEDOUT;
|
||||
if (result < 0) {
|
||||
dev_err(dev, "WAKE&TX: error waiting for device to exit IDLE: "
|
||||
"%d - resetting\n", result);
|
||||
i2400m_reset(i2400m, I2400M_RT_BUS);
|
||||
goto error;
|
||||
}
|
||||
msleep(20); /* device still needs some time or it drops it */
|
||||
result = i2400m_tx(i2400m, skb->data, skb->len, I2400M_PT_DATA);
|
||||
error:
|
||||
netif_wake_queue(net_dev);
|
||||
out_kfree:
|
||||
kfree_skb(skb); /* refcount transferred by _hard_start_xmit() */
|
||||
out_put:
|
||||
i2400m_put(i2400m);
|
||||
d_fnend(3, dev, "(ws %p i2400m %p skb %p) = void [%d]\n",
|
||||
ws, i2400m, skb, result);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Prepare the data payload TX header
|
||||
*
|
||||
* The i2400m expects a 4 byte header in front of a data packet.
|
||||
*
|
||||
* Because we pretend to be an ethernet device, this packet comes with
|
||||
* an ethernet header. Pull it and push our header.
|
||||
*/
|
||||
static
|
||||
void i2400m_tx_prep_header(struct sk_buff *skb)
|
||||
{
|
||||
struct i2400m_pl_data_hdr *pl_hdr;
|
||||
skb_pull(skb, ETH_HLEN);
|
||||
pl_hdr = (struct i2400m_pl_data_hdr *) skb_push(skb, sizeof(*pl_hdr));
|
||||
pl_hdr->reserved = 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*
|
||||
* Cleanup resources acquired during i2400m_net_wake_tx()
|
||||
*
|
||||
* This is called by __i2400m_dev_stop and means we have to make sure
|
||||
* the workqueue is flushed from any pending work.
|
||||
*/
|
||||
void i2400m_net_wake_stop(struct i2400m *i2400m)
|
||||
{
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct sk_buff *wake_tx_skb;
|
||||
unsigned long flags;
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p)\n", i2400m);
|
||||
/*
|
||||
* See i2400m_hard_start_xmit(), references are taken there and
|
||||
* here we release them if the packet was still pending.
|
||||
*/
|
||||
cancel_work_sync(&i2400m->wake_tx_ws);
|
||||
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
wake_tx_skb = i2400m->wake_tx_skb;
|
||||
i2400m->wake_tx_skb = NULL;
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
|
||||
if (wake_tx_skb) {
|
||||
i2400m_put(i2400m);
|
||||
kfree_skb(wake_tx_skb);
|
||||
}
|
||||
|
||||
d_fnend(3, dev, "(i2400m %p) = void\n", i2400m);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* TX an skb to an idle device
|
||||
*
|
||||
* When the device is in basestation-idle mode, we need to wake it up
|
||||
* and then TX. So we queue a work_struct for doing so.
|
||||
*
|
||||
* We need to get an extra ref for the skb (so it is not dropped), as
|
||||
* well as be careful not to queue more than one request (won't help
|
||||
* at all). If more than one request comes or there are errors, we
|
||||
* just drop the packets (see i2400m_hard_start_xmit()).
|
||||
*/
|
||||
static
|
||||
int i2400m_net_wake_tx(struct i2400m *i2400m, struct net_device *net_dev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
int result;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
unsigned long flags;
|
||||
|
||||
d_fnstart(3, dev, "(skb %p net_dev %p)\n", skb, net_dev);
|
||||
if (net_ratelimit()) {
|
||||
d_printf(3, dev, "WAKE&NETTX: "
|
||||
"skb %p sending %d bytes to radio\n",
|
||||
skb, skb->len);
|
||||
d_dump(4, dev, skb->data, skb->len);
|
||||
}
|
||||
/* We hold a ref count for i2400m and skb, so when
|
||||
* stopping() the device, we need to cancel that work
|
||||
* and if pending, release those resources. */
|
||||
result = 0;
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
if (!i2400m->wake_tx_skb) {
|
||||
netif_stop_queue(net_dev);
|
||||
i2400m_get(i2400m);
|
||||
i2400m->wake_tx_skb = skb_get(skb); /* transfer ref count */
|
||||
i2400m_tx_prep_header(skb);
|
||||
result = schedule_work(&i2400m->wake_tx_ws);
|
||||
WARN_ON(result == 0);
|
||||
}
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
if (result == 0) {
|
||||
/* Yes, this happens even if we stopped the
|
||||
* queue -- blame the queue disciplines that
|
||||
* queue without looking -- I guess there is a reason
|
||||
* for that. */
|
||||
if (net_ratelimit())
|
||||
d_printf(1, dev, "NETTX: device exiting idle, "
|
||||
"dropping skb %p, queue running %d\n",
|
||||
skb, netif_queue_stopped(net_dev));
|
||||
result = -EBUSY;
|
||||
}
|
||||
d_fnend(3, dev, "(skb %p net_dev %p) = %d\n", skb, net_dev, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Transmit a packet to the base station on behalf of the network stack.
|
||||
*
|
||||
* Returns: 0 if ok, < 0 errno code on error.
|
||||
*
|
||||
* We need to pull the ethernet header and add the hardware header,
|
||||
* which is currently set to all zeroes and reserved.
|
||||
*/
|
||||
static
|
||||
int i2400m_net_tx(struct i2400m *i2400m, struct net_device *net_dev,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
int result;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p net_dev %p skb %p)\n",
|
||||
i2400m, net_dev, skb);
|
||||
/* FIXME: check eth hdr, only IPv4 is routed by the device as of now */
|
||||
net_dev->trans_start = jiffies;
|
||||
i2400m_tx_prep_header(skb);
|
||||
d_printf(3, dev, "NETTX: skb %p sending %d bytes to radio\n",
|
||||
skb, skb->len);
|
||||
d_dump(4, dev, skb->data, skb->len);
|
||||
result = i2400m_tx(i2400m, skb->data, skb->len, I2400M_PT_DATA);
|
||||
d_fnend(3, dev, "(i2400m %p net_dev %p skb %p) = %d\n",
|
||||
i2400m, net_dev, skb, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Transmit a packet to the base station on behalf of the network stack
|
||||
*
|
||||
*
|
||||
* Returns: NETDEV_TX_OK (always, even in case of error)
|
||||
*
|
||||
* In case of error, we just drop it. Reasons:
|
||||
*
|
||||
* - we add a hw header to each skb, and if the network stack
|
||||
* retries, we have no way to know if that skb has it or not.
|
||||
*
|
||||
* - network protocols have their own drop-recovery mechanisms
|
||||
*
|
||||
* - there is not much else we can do
|
||||
*
|
||||
* If the device is idle, we need to wake it up; that is an operation
|
||||
* that will sleep. See i2400m_net_wake_tx() for details.
|
||||
*/
|
||||
static
|
||||
netdev_tx_t i2400m_hard_start_xmit(struct sk_buff *skb,
|
||||
struct net_device *net_dev)
|
||||
{
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
int result = -1;
|
||||
|
||||
d_fnstart(3, dev, "(skb %p net_dev %p)\n", skb, net_dev);
|
||||
|
||||
if (skb_cow_head(skb, 0))
|
||||
goto drop;
|
||||
|
||||
if (i2400m->state == I2400M_SS_IDLE)
|
||||
result = i2400m_net_wake_tx(i2400m, net_dev, skb);
|
||||
else
|
||||
result = i2400m_net_tx(i2400m, net_dev, skb);
|
||||
if (result < 0) {
|
||||
drop:
|
||||
net_dev->stats.tx_dropped++;
|
||||
} else {
|
||||
net_dev->stats.tx_packets++;
|
||||
net_dev->stats.tx_bytes += skb->len;
|
||||
}
|
||||
dev_kfree_skb(skb);
|
||||
d_fnend(3, dev, "(skb %p net_dev %p) = %d\n", skb, net_dev, result);
|
||||
return NETDEV_TX_OK;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int i2400m_change_mtu(struct net_device *net_dev, int new_mtu)
|
||||
{
|
||||
int result;
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
|
||||
if (new_mtu >= I2400M_MAX_MTU) {
|
||||
dev_err(dev, "Cannot change MTU to %d (max is %d)\n",
|
||||
new_mtu, I2400M_MAX_MTU);
|
||||
result = -EINVAL;
|
||||
} else {
|
||||
net_dev->mtu = new_mtu;
|
||||
result = 0;
|
||||
}
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void i2400m_tx_timeout(struct net_device *net_dev)
|
||||
{
|
||||
/*
|
||||
* We might want to kick the device
|
||||
*
|
||||
* There is not much we can do though, as the device requires
|
||||
* that we send the data aggregated. By the time we receive
|
||||
* this, there might be data pending to be sent or not...
|
||||
*/
|
||||
net_dev->stats.tx_errors++;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Create a fake ethernet header
|
||||
*
|
||||
* For emulating an ethernet device, every received IP header has to
|
||||
* be prefixed with an ethernet header. Fake it with the given
|
||||
* protocol.
|
||||
*/
|
||||
static
|
||||
void i2400m_rx_fake_eth_header(struct net_device *net_dev,
|
||||
void *_eth_hdr, __be16 protocol)
|
||||
{
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct ethhdr *eth_hdr = _eth_hdr;
|
||||
|
||||
memcpy(eth_hdr->h_dest, net_dev->dev_addr, sizeof(eth_hdr->h_dest));
|
||||
memcpy(eth_hdr->h_source, i2400m->src_mac_addr,
|
||||
sizeof(eth_hdr->h_source));
|
||||
eth_hdr->h_proto = protocol;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* i2400m_net_rx - pass a network packet to the stack
|
||||
*
|
||||
* @i2400m: device instance
|
||||
* @skb_rx: the skb where the buffer pointed to by @buf is
|
||||
* @i: 1 if payload is the only one
|
||||
* @buf: pointer to the buffer containing the data
|
||||
* @len: buffer's length
|
||||
*
|
||||
* This is only used now for the v1.3 firmware. It will be deprecated
|
||||
* in >= 2.6.31.
|
||||
*
|
||||
* Note that due to firmware limitations, we don't have space to add
|
||||
* an ethernet header, so we need to copy each packet. Firmware
|
||||
* versions >= v1.4 fix this [see i2400m_net_erx()].
|
||||
*
|
||||
* We just clone the skb and set it up so that it's skb->data pointer
|
||||
* points to "buf" and it's length.
|
||||
*
|
||||
* Note that if the payload is the last (or the only one) in a
|
||||
* multi-payload message, we don't clone the SKB but just reuse it.
|
||||
*
|
||||
* This function is normally run from a thread context. However, we
|
||||
* still use netif_rx() instead of netif_receive_skb() as was
|
||||
* recommended in the mailing list. Reason is in some stress tests
|
||||
* when sending/receiving a lot of data we seem to hit a softlock in
|
||||
* the kernel's TCP implementation [aroudn tcp_delay_timer()]. Using
|
||||
* netif_rx() took care of the issue.
|
||||
*
|
||||
* This is, of course, still open to do more research on why running
|
||||
* with netif_receive_skb() hits this softlock. FIXME.
|
||||
*
|
||||
* FIXME: currently we don't do any efforts at distinguishing if what
|
||||
* we got was an IPv4 or IPv6 header, to setup the protocol field
|
||||
* correctly.
|
||||
*/
|
||||
void i2400m_net_rx(struct i2400m *i2400m, struct sk_buff *skb_rx,
|
||||
unsigned i, const void *buf, int buf_len)
|
||||
{
|
||||
struct net_device *net_dev = i2400m->wimax_dev.net_dev;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct sk_buff *skb;
|
||||
|
||||
d_fnstart(2, dev, "(i2400m %p buf %p buf_len %d)\n",
|
||||
i2400m, buf, buf_len);
|
||||
if (i) {
|
||||
skb = skb_get(skb_rx);
|
||||
d_printf(2, dev, "RX: reusing first payload skb %p\n", skb);
|
||||
skb_pull(skb, buf - (void *) skb->data);
|
||||
skb_trim(skb, (void *) skb_end_pointer(skb) - buf);
|
||||
} else {
|
||||
/* Yes, this is bad -- a lot of overhead -- see
|
||||
* comments at the top of the file */
|
||||
skb = __netdev_alloc_skb(net_dev, buf_len, GFP_KERNEL);
|
||||
if (skb == NULL) {
|
||||
dev_err(dev, "NETRX: no memory to realloc skb\n");
|
||||
net_dev->stats.rx_dropped++;
|
||||
goto error_skb_realloc;
|
||||
}
|
||||
memcpy(skb_put(skb, buf_len), buf, buf_len);
|
||||
}
|
||||
i2400m_rx_fake_eth_header(i2400m->wimax_dev.net_dev,
|
||||
skb->data - ETH_HLEN,
|
||||
cpu_to_be16(ETH_P_IP));
|
||||
skb_set_mac_header(skb, -ETH_HLEN);
|
||||
skb->dev = i2400m->wimax_dev.net_dev;
|
||||
skb->protocol = htons(ETH_P_IP);
|
||||
net_dev->stats.rx_packets++;
|
||||
net_dev->stats.rx_bytes += buf_len;
|
||||
d_printf(3, dev, "NETRX: receiving %d bytes to network stack\n",
|
||||
buf_len);
|
||||
d_dump(4, dev, buf, buf_len);
|
||||
netif_rx_ni(skb); /* see notes in function header */
|
||||
error_skb_realloc:
|
||||
d_fnend(2, dev, "(i2400m %p buf %p buf_len %d) = void\n",
|
||||
i2400m, buf, buf_len);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* i2400m_net_erx - pass a network packet to the stack (extended version)
|
||||
*
|
||||
* @i2400m: device descriptor
|
||||
* @skb: the skb where the packet is - the skb should be set to point
|
||||
* at the IP packet; this function will add ethernet headers if
|
||||
* needed.
|
||||
* @cs: packet type
|
||||
*
|
||||
* This is only used now for firmware >= v1.4. Note it is quite
|
||||
* similar to i2400m_net_rx() (used only for v1.3 firmware).
|
||||
*
|
||||
* This function is normally run from a thread context. However, we
|
||||
* still use netif_rx() instead of netif_receive_skb() as was
|
||||
* recommended in the mailing list. Reason is in some stress tests
|
||||
* when sending/receiving a lot of data we seem to hit a softlock in
|
||||
* the kernel's TCP implementation [aroudn tcp_delay_timer()]. Using
|
||||
* netif_rx() took care of the issue.
|
||||
*
|
||||
* This is, of course, still open to do more research on why running
|
||||
* with netif_receive_skb() hits this softlock. FIXME.
|
||||
*/
|
||||
void i2400m_net_erx(struct i2400m *i2400m, struct sk_buff *skb,
|
||||
enum i2400m_cs cs)
|
||||
{
|
||||
struct net_device *net_dev = i2400m->wimax_dev.net_dev;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
int protocol;
|
||||
|
||||
d_fnstart(2, dev, "(i2400m %p skb %p [%u] cs %d)\n",
|
||||
i2400m, skb, skb->len, cs);
|
||||
switch(cs) {
|
||||
case I2400M_CS_IPV4_0:
|
||||
case I2400M_CS_IPV4:
|
||||
protocol = ETH_P_IP;
|
||||
i2400m_rx_fake_eth_header(i2400m->wimax_dev.net_dev,
|
||||
skb->data - ETH_HLEN,
|
||||
cpu_to_be16(ETH_P_IP));
|
||||
skb_set_mac_header(skb, -ETH_HLEN);
|
||||
skb->dev = i2400m->wimax_dev.net_dev;
|
||||
skb->protocol = htons(ETH_P_IP);
|
||||
net_dev->stats.rx_packets++;
|
||||
net_dev->stats.rx_bytes += skb->len;
|
||||
break;
|
||||
default:
|
||||
dev_err(dev, "ERX: BUG? CS type %u unsupported\n", cs);
|
||||
goto error;
|
||||
|
||||
}
|
||||
d_printf(3, dev, "ERX: receiving %d bytes to the network stack\n",
|
||||
skb->len);
|
||||
d_dump(4, dev, skb->data, skb->len);
|
||||
netif_rx_ni(skb); /* see notes in function header */
|
||||
error:
|
||||
d_fnend(2, dev, "(i2400m %p skb %p [%u] cs %d) = void\n",
|
||||
i2400m, skb, skb->len, cs);
|
||||
}
|
||||
|
||||
static const struct net_device_ops i2400m_netdev_ops = {
|
||||
.ndo_open = i2400m_open,
|
||||
.ndo_stop = i2400m_stop,
|
||||
.ndo_start_xmit = i2400m_hard_start_xmit,
|
||||
.ndo_tx_timeout = i2400m_tx_timeout,
|
||||
.ndo_change_mtu = i2400m_change_mtu,
|
||||
};
|
||||
|
||||
static void i2400m_get_drvinfo(struct net_device *net_dev,
|
||||
struct ethtool_drvinfo *info)
|
||||
{
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
|
||||
strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
|
||||
strlcpy(info->fw_version, i2400m->fw_name ? : "",
|
||||
sizeof(info->fw_version));
|
||||
if (net_dev->dev.parent)
|
||||
strlcpy(info->bus_info, dev_name(net_dev->dev.parent),
|
||||
sizeof(info->bus_info));
|
||||
}
|
||||
|
||||
static const struct ethtool_ops i2400m_ethtool_ops = {
|
||||
.get_drvinfo = i2400m_get_drvinfo,
|
||||
.get_link = ethtool_op_get_link,
|
||||
};
|
||||
|
||||
/**
|
||||
* i2400m_netdev_setup - Setup setup @net_dev's i2400m private data
|
||||
*
|
||||
* Called by alloc_netdev()
|
||||
*/
|
||||
void i2400m_netdev_setup(struct net_device *net_dev)
|
||||
{
|
||||
d_fnstart(3, NULL, "(net_dev %p)\n", net_dev);
|
||||
ether_setup(net_dev);
|
||||
net_dev->mtu = I2400M_MAX_MTU;
|
||||
net_dev->tx_queue_len = I2400M_TX_QLEN;
|
||||
net_dev->features =
|
||||
NETIF_F_VLAN_CHALLENGED
|
||||
| NETIF_F_HIGHDMA;
|
||||
net_dev->flags =
|
||||
IFF_NOARP /* i2400m is apure IP device */
|
||||
& (~IFF_BROADCAST /* i2400m is P2P */
|
||||
& ~IFF_MULTICAST);
|
||||
net_dev->watchdog_timeo = I2400M_TX_TIMEOUT;
|
||||
net_dev->netdev_ops = &i2400m_netdev_ops;
|
||||
net_dev->ethtool_ops = &i2400m_ethtool_ops;
|
||||
d_fnend(3, NULL, "(net_dev %p) = void\n", net_dev);
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(i2400m_netdev_setup);
|
||||
|
210
drivers/net/wimax/i2400m/op-rfkill.c
Normal file
210
drivers/net/wimax/i2400m/op-rfkill.c
Normal file
|
@ -0,0 +1,210 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Implement backend for the WiMAX stack rfkill support
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*
|
||||
*
|
||||
* The WiMAX kernel stack integrates into RF-Kill and keeps the
|
||||
* switches's status. We just need to:
|
||||
*
|
||||
* - report changes in the HW RF Kill switch [with
|
||||
* wimax_rfkill_{sw,hw}_report(), which happens when we detect those
|
||||
* indications coming through hardware reports]. We also do it on
|
||||
* initialization to let the stack know the initial HW state.
|
||||
*
|
||||
* - implement indications from the stack to change the SW RF Kill
|
||||
* switch (coming from sysfs, the wimax stack or user space).
|
||||
*/
|
||||
#include "i2400m.h"
|
||||
#include <linux/wimax/i2400m.h>
|
||||
#include <linux/slab.h>
|
||||
|
||||
|
||||
|
||||
#define D_SUBMODULE rfkill
|
||||
#include "debug-levels.h"
|
||||
|
||||
/*
|
||||
* Return true if the i2400m radio is in the requested wimax_rf_state state
|
||||
*
|
||||
*/
|
||||
static
|
||||
int i2400m_radio_is(struct i2400m *i2400m, enum wimax_rf_state state)
|
||||
{
|
||||
if (state == WIMAX_RF_OFF)
|
||||
return i2400m->state == I2400M_SS_RF_OFF
|
||||
|| i2400m->state == I2400M_SS_RF_SHUTDOWN;
|
||||
else if (state == WIMAX_RF_ON)
|
||||
/* state == WIMAX_RF_ON */
|
||||
return i2400m->state != I2400M_SS_RF_OFF
|
||||
&& i2400m->state != I2400M_SS_RF_SHUTDOWN;
|
||||
else {
|
||||
BUG();
|
||||
return -EINVAL; /* shut gcc warnings on certain arches */
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* WiMAX stack operation: implement SW RFKill toggling
|
||||
*
|
||||
* @wimax_dev: device descriptor
|
||||
* @skb: skb where the message has been received; skb->data is
|
||||
* expected to point to the message payload.
|
||||
* @genl_info: passed by the generic netlink layer
|
||||
*
|
||||
* Generic Netlink will call this function when a message is sent from
|
||||
* userspace to change the software RF-Kill switch status.
|
||||
*
|
||||
* This function will set the device's software RF-Kill switch state to
|
||||
* match what is requested.
|
||||
*
|
||||
* NOTE: the i2400m has a strict state machine; we can only set the
|
||||
* RF-Kill switch when it is on, the HW RF-Kill is on and the
|
||||
* device is initialized. So we ignore errors steaming from not
|
||||
* being in the right state (-EILSEQ).
|
||||
*/
|
||||
int i2400m_op_rfkill_sw_toggle(struct wimax_dev *wimax_dev,
|
||||
enum wimax_rf_state state)
|
||||
{
|
||||
int result;
|
||||
struct i2400m *i2400m = wimax_dev_to_i2400m(wimax_dev);
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct sk_buff *ack_skb;
|
||||
struct {
|
||||
struct i2400m_l3l4_hdr hdr;
|
||||
struct i2400m_tlv_rf_operation sw_rf;
|
||||
} __packed *cmd;
|
||||
char strerr[32];
|
||||
|
||||
d_fnstart(4, dev, "(wimax_dev %p state %d)\n", wimax_dev, state);
|
||||
|
||||
result = -ENOMEM;
|
||||
cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
|
||||
if (cmd == NULL)
|
||||
goto error_alloc;
|
||||
cmd->hdr.type = cpu_to_le16(I2400M_MT_CMD_RF_CONTROL);
|
||||
cmd->hdr.length = sizeof(cmd->sw_rf);
|
||||
cmd->hdr.version = cpu_to_le16(I2400M_L3L4_VERSION);
|
||||
cmd->sw_rf.hdr.type = cpu_to_le16(I2400M_TLV_RF_OPERATION);
|
||||
cmd->sw_rf.hdr.length = cpu_to_le16(sizeof(cmd->sw_rf.status));
|
||||
switch (state) {
|
||||
case WIMAX_RF_OFF: /* RFKILL ON, radio OFF */
|
||||
cmd->sw_rf.status = cpu_to_le32(2);
|
||||
break;
|
||||
case WIMAX_RF_ON: /* RFKILL OFF, radio ON */
|
||||
cmd->sw_rf.status = cpu_to_le32(1);
|
||||
break;
|
||||
default:
|
||||
BUG();
|
||||
}
|
||||
|
||||
ack_skb = i2400m_msg_to_dev(i2400m, cmd, sizeof(*cmd));
|
||||
result = PTR_ERR(ack_skb);
|
||||
if (IS_ERR(ack_skb)) {
|
||||
dev_err(dev, "Failed to issue 'RF Control' command: %d\n",
|
||||
result);
|
||||
goto error_msg_to_dev;
|
||||
}
|
||||
result = i2400m_msg_check_status(wimax_msg_data(ack_skb),
|
||||
strerr, sizeof(strerr));
|
||||
if (result < 0) {
|
||||
dev_err(dev, "'RF Control' (0x%04x) command failed: %d - %s\n",
|
||||
I2400M_MT_CMD_RF_CONTROL, result, strerr);
|
||||
goto error_cmd;
|
||||
}
|
||||
|
||||
/* Now we wait for the state to change to RADIO_OFF or RADIO_ON */
|
||||
result = wait_event_timeout(
|
||||
i2400m->state_wq, i2400m_radio_is(i2400m, state),
|
||||
5 * HZ);
|
||||
if (result == 0)
|
||||
result = -ETIMEDOUT;
|
||||
if (result < 0)
|
||||
dev_err(dev, "Error waiting for device to toggle RF state: "
|
||||
"%d\n", result);
|
||||
result = 0;
|
||||
error_cmd:
|
||||
kfree_skb(ack_skb);
|
||||
error_msg_to_dev:
|
||||
error_alloc:
|
||||
d_fnend(4, dev, "(wimax_dev %p state %d) = %d\n",
|
||||
wimax_dev, state, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Inform the WiMAX stack of changes in the RF Kill switches reported
|
||||
* by the device
|
||||
*
|
||||
* @i2400m: device descriptor
|
||||
* @rfss: TLV for RF Switches status; already validated
|
||||
*
|
||||
* NOTE: the reports on RF switch status cannot be trusted
|
||||
* or used until the device is in a state of RADIO_OFF
|
||||
* or greater.
|
||||
*/
|
||||
void i2400m_report_tlv_rf_switches_status(
|
||||
struct i2400m *i2400m,
|
||||
const struct i2400m_tlv_rf_switches_status *rfss)
|
||||
{
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
enum i2400m_rf_switch_status hw, sw;
|
||||
enum wimax_st wimax_state;
|
||||
|
||||
sw = le32_to_cpu(rfss->sw_rf_switch);
|
||||
hw = le32_to_cpu(rfss->hw_rf_switch);
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p rfss %p [hw %u sw %u])\n",
|
||||
i2400m, rfss, hw, sw);
|
||||
/* We only process rw switch evens when the device has been
|
||||
* fully initialized */
|
||||
wimax_state = wimax_state_get(&i2400m->wimax_dev);
|
||||
if (wimax_state < WIMAX_ST_RADIO_OFF) {
|
||||
d_printf(3, dev, "ignoring RF switches report, state %u\n",
|
||||
wimax_state);
|
||||
goto out;
|
||||
}
|
||||
switch (sw) {
|
||||
case I2400M_RF_SWITCH_ON: /* RF Kill disabled (radio on) */
|
||||
wimax_report_rfkill_sw(&i2400m->wimax_dev, WIMAX_RF_ON);
|
||||
break;
|
||||
case I2400M_RF_SWITCH_OFF: /* RF Kill enabled (radio off) */
|
||||
wimax_report_rfkill_sw(&i2400m->wimax_dev, WIMAX_RF_OFF);
|
||||
break;
|
||||
default:
|
||||
dev_err(dev, "HW BUG? Unknown RF SW state 0x%x\n", sw);
|
||||
}
|
||||
|
||||
switch (hw) {
|
||||
case I2400M_RF_SWITCH_ON: /* RF Kill disabled (radio on) */
|
||||
wimax_report_rfkill_hw(&i2400m->wimax_dev, WIMAX_RF_ON);
|
||||
break;
|
||||
case I2400M_RF_SWITCH_OFF: /* RF Kill enabled (radio off) */
|
||||
wimax_report_rfkill_hw(&i2400m->wimax_dev, WIMAX_RF_OFF);
|
||||
break;
|
||||
default:
|
||||
dev_err(dev, "HW BUG? Unknown RF HW state 0x%x\n", hw);
|
||||
}
|
||||
out:
|
||||
d_fnend(3, dev, "(i2400m %p rfss %p [hw %u sw %u]) = void\n",
|
||||
i2400m, rfss, hw, sw);
|
||||
}
|
1396
drivers/net/wimax/i2400m/rx.c
Normal file
1396
drivers/net/wimax/i2400m/rx.c
Normal file
File diff suppressed because it is too large
Load diff
80
drivers/net/wimax/i2400m/sysfs.c
Normal file
80
drivers/net/wimax/i2400m/sysfs.c
Normal file
|
@ -0,0 +1,80 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Sysfs interfaces to show driver and device information
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007 Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*/
|
||||
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/etherdevice.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/device.h>
|
||||
#include "i2400m.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE sysfs
|
||||
#include "debug-levels.h"
|
||||
|
||||
|
||||
/*
|
||||
* Set the idle timeout (msecs)
|
||||
*
|
||||
* FIXME: eventually this should be a common WiMAX stack method, but
|
||||
* would like to wait to see how other devices manage it.
|
||||
*/
|
||||
static
|
||||
ssize_t i2400m_idle_timeout_store(struct device *dev,
|
||||
struct device_attribute *attr,
|
||||
const char *buf, size_t size)
|
||||
{
|
||||
ssize_t result;
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(to_net_dev(dev));
|
||||
unsigned val;
|
||||
|
||||
result = -EINVAL;
|
||||
if (sscanf(buf, "%u\n", &val) != 1)
|
||||
goto error_no_unsigned;
|
||||
if (val != 0 && (val < 100 || val > 300000 || val % 100 != 0)) {
|
||||
dev_err(dev, "idle_timeout: %u: invalid msecs specification; "
|
||||
"valid values are 0, 100-300000 in 100 increments\n",
|
||||
val);
|
||||
goto error_bad_value;
|
||||
}
|
||||
result = i2400m_set_idle_timeout(i2400m, val);
|
||||
if (result >= 0)
|
||||
result = size;
|
||||
error_no_unsigned:
|
||||
error_bad_value:
|
||||
return result;
|
||||
}
|
||||
|
||||
static
|
||||
DEVICE_ATTR(i2400m_idle_timeout, S_IWUSR,
|
||||
NULL, i2400m_idle_timeout_store);
|
||||
|
||||
static
|
||||
struct attribute *i2400m_dev_attrs[] = {
|
||||
&dev_attr_i2400m_idle_timeout.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
struct attribute_group i2400m_dev_attr_group = {
|
||||
.name = NULL, /* we want them in the same directory */
|
||||
.attrs = i2400m_dev_attrs,
|
||||
};
|
1013
drivers/net/wimax/i2400m/tx.c
Normal file
1013
drivers/net/wimax/i2400m/tx.c
Normal file
File diff suppressed because it is too large
Load diff
42
drivers/net/wimax/i2400m/usb-debug-levels.h
Normal file
42
drivers/net/wimax/i2400m/usb-debug-levels.h
Normal file
|
@ -0,0 +1,42 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Debug levels control file for the i2400m-usb module
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*/
|
||||
#ifndef __debug_levels__h__
|
||||
#define __debug_levels__h__
|
||||
|
||||
/* Maximum compile and run time debug level for all submodules */
|
||||
#define D_MODULENAME i2400m_usb
|
||||
#define D_MASTER CONFIG_WIMAX_I2400M_DEBUG_LEVEL
|
||||
|
||||
#include <linux/wimax/debug.h>
|
||||
|
||||
/* List of all the enabled modules */
|
||||
enum d_module {
|
||||
D_SUBMODULE_DECLARE(usb),
|
||||
D_SUBMODULE_DECLARE(fw),
|
||||
D_SUBMODULE_DECLARE(notif),
|
||||
D_SUBMODULE_DECLARE(rx),
|
||||
D_SUBMODULE_DECLARE(tx),
|
||||
};
|
||||
|
||||
|
||||
#endif /* #ifndef __debug_levels__h__ */
|
364
drivers/net/wimax/i2400m/usb-fw.c
Normal file
364
drivers/net/wimax/i2400m/usb-fw.c
Normal file
|
@ -0,0 +1,364 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Firmware uploader's USB specifics
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* * Neither the name of Intel Corporation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||||
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||||
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
*
|
||||
* Intel Corporation <linux-wimax@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* - Initial implementation
|
||||
*
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* - bus generic/specific split
|
||||
*
|
||||
* THE PROCEDURE
|
||||
*
|
||||
* See fw.c for the generic description of this procedure.
|
||||
*
|
||||
* This file implements only the USB specifics. It boils down to how
|
||||
* to send a command and waiting for an acknowledgement from the
|
||||
* device.
|
||||
*
|
||||
* This code (and process) is single threaded. It assumes it is the
|
||||
* only thread poking around (guaranteed by fw.c).
|
||||
*
|
||||
* COMMAND EXECUTION
|
||||
*
|
||||
* A write URB is posted with the buffer to the bulk output endpoint.
|
||||
*
|
||||
* ACK RECEPTION
|
||||
*
|
||||
* We just post a URB to the notification endpoint and wait for
|
||||
* data. We repeat until we get all the data we expect (as indicated
|
||||
* by the call from the bus generic code).
|
||||
*
|
||||
* The data is not read from the bulk in endpoint for boot mode.
|
||||
*
|
||||
* ROADMAP
|
||||
*
|
||||
* i2400mu_bus_bm_cmd_send
|
||||
* i2400m_bm_cmd_prepare...
|
||||
* i2400mu_tx_bulk_out
|
||||
*
|
||||
* i2400mu_bus_bm_wait_for_ack
|
||||
* i2400m_notif_submit
|
||||
*/
|
||||
#include <linux/usb.h>
|
||||
#include <linux/gfp.h>
|
||||
#include "i2400m-usb.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE fw
|
||||
#include "usb-debug-levels.h"
|
||||
|
||||
|
||||
/*
|
||||
* Synchronous write to the device
|
||||
*
|
||||
* Takes care of updating EDC counts and thus, handle device errors.
|
||||
*/
|
||||
static
|
||||
ssize_t i2400mu_tx_bulk_out(struct i2400mu *i2400mu, void *buf, size_t buf_size)
|
||||
{
|
||||
int result;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
int len;
|
||||
struct usb_endpoint_descriptor *epd;
|
||||
int pipe, do_autopm = 1;
|
||||
|
||||
result = usb_autopm_get_interface(i2400mu->usb_iface);
|
||||
if (result < 0) {
|
||||
dev_err(dev, "BM-CMD: can't get autopm: %d\n", result);
|
||||
do_autopm = 0;
|
||||
}
|
||||
epd = usb_get_epd(i2400mu->usb_iface, i2400mu->endpoint_cfg.bulk_out);
|
||||
pipe = usb_sndbulkpipe(i2400mu->usb_dev, epd->bEndpointAddress);
|
||||
retry:
|
||||
result = usb_bulk_msg(i2400mu->usb_dev, pipe, buf, buf_size, &len, 200);
|
||||
switch (result) {
|
||||
case 0:
|
||||
if (len != buf_size) {
|
||||
dev_err(dev, "BM-CMD: short write (%u B vs %zu "
|
||||
"expected)\n", len, buf_size);
|
||||
result = -EIO;
|
||||
break;
|
||||
}
|
||||
result = len;
|
||||
break;
|
||||
case -EPIPE:
|
||||
/*
|
||||
* Stall -- maybe the device is choking with our
|
||||
* requests. Clear it and give it some time. If they
|
||||
* happen to often, it might be another symptom, so we
|
||||
* reset.
|
||||
*
|
||||
* No error handling for usb_clear_halt(0; if it
|
||||
* works, the retry works; if it fails, this switch
|
||||
* does the error handling for us.
|
||||
*/
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
10 * EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "BM-CMD: too many stalls in "
|
||||
"URB; resetting device\n");
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
/* fallthrough */
|
||||
} else {
|
||||
usb_clear_halt(i2400mu->usb_dev, pipe);
|
||||
msleep(10); /* give the device some time */
|
||||
goto retry;
|
||||
}
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* just ignore it */
|
||||
case -ESHUTDOWN: /* and exit */
|
||||
case -ECONNRESET:
|
||||
result = -ESHUTDOWN;
|
||||
break;
|
||||
case -ETIMEDOUT: /* bah... */
|
||||
break;
|
||||
default: /* any other? */
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "BM-CMD: maximum errors in "
|
||||
"URB exceeded; resetting device\n");
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
result = -ENODEV;
|
||||
break;
|
||||
}
|
||||
dev_err(dev, "BM-CMD: URB error %d, retrying\n",
|
||||
result);
|
||||
goto retry;
|
||||
}
|
||||
if (do_autopm)
|
||||
usb_autopm_put_interface(i2400mu->usb_iface);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Send a boot-mode command over the bulk-out pipe
|
||||
*
|
||||
* Command can be a raw command, which requires no preparation (and
|
||||
* which might not even be following the command format). Checks that
|
||||
* the right amount of data was transferred.
|
||||
*
|
||||
* To satisfy USB requirements (no onstack, vmalloc or in data segment
|
||||
* buffers), we copy the command to i2400m->bm_cmd_buf and send it from
|
||||
* there.
|
||||
*
|
||||
* @flags: pass thru from i2400m_bm_cmd()
|
||||
* @return: cmd_size if ok, < 0 errno code on error.
|
||||
*/
|
||||
ssize_t i2400mu_bus_bm_cmd_send(struct i2400m *i2400m,
|
||||
const struct i2400m_bootrom_header *_cmd,
|
||||
size_t cmd_size, int flags)
|
||||
{
|
||||
ssize_t result;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
int opcode = _cmd == NULL ? -1 : i2400m_brh_get_opcode(_cmd);
|
||||
struct i2400m_bootrom_header *cmd;
|
||||
size_t cmd_size_a = ALIGN(cmd_size, 16); /* USB restriction */
|
||||
|
||||
d_fnstart(8, dev, "(i2400m %p cmd %p size %zu)\n",
|
||||
i2400m, _cmd, cmd_size);
|
||||
result = -E2BIG;
|
||||
if (cmd_size > I2400M_BM_CMD_BUF_SIZE)
|
||||
goto error_too_big;
|
||||
if (_cmd != i2400m->bm_cmd_buf)
|
||||
memmove(i2400m->bm_cmd_buf, _cmd, cmd_size);
|
||||
cmd = i2400m->bm_cmd_buf;
|
||||
if (cmd_size_a > cmd_size) /* Zero pad space */
|
||||
memset(i2400m->bm_cmd_buf + cmd_size, 0, cmd_size_a - cmd_size);
|
||||
if ((flags & I2400M_BM_CMD_RAW) == 0) {
|
||||
if (WARN_ON(i2400m_brh_get_response_required(cmd) == 0))
|
||||
dev_warn(dev, "SW BUG: response_required == 0\n");
|
||||
i2400m_bm_cmd_prepare(cmd);
|
||||
}
|
||||
result = i2400mu_tx_bulk_out(i2400mu, i2400m->bm_cmd_buf, cmd_size);
|
||||
if (result < 0) {
|
||||
dev_err(dev, "boot-mode cmd %d: cannot send: %zd\n",
|
||||
opcode, result);
|
||||
goto error_cmd_send;
|
||||
}
|
||||
if (result != cmd_size) { /* all was transferred? */
|
||||
dev_err(dev, "boot-mode cmd %d: incomplete transfer "
|
||||
"(%zd vs %zu submitted)\n", opcode, result, cmd_size);
|
||||
result = -EIO;
|
||||
goto error_cmd_size;
|
||||
}
|
||||
error_cmd_size:
|
||||
error_cmd_send:
|
||||
error_too_big:
|
||||
d_fnend(8, dev, "(i2400m %p cmd %p size %zu) = %zd\n",
|
||||
i2400m, _cmd, cmd_size, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void __i2400mu_bm_notif_cb(struct urb *urb)
|
||||
{
|
||||
complete(urb->context);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* submit a read to the notification endpoint
|
||||
*
|
||||
* @i2400m: device descriptor
|
||||
* @urb: urb to use
|
||||
* @completion: completion varible to complete when done
|
||||
*
|
||||
* Data is always read to i2400m->bm_ack_buf
|
||||
*/
|
||||
static
|
||||
int i2400mu_notif_submit(struct i2400mu *i2400mu, struct urb *urb,
|
||||
struct completion *completion)
|
||||
{
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct usb_endpoint_descriptor *epd;
|
||||
int pipe;
|
||||
|
||||
epd = usb_get_epd(i2400mu->usb_iface,
|
||||
i2400mu->endpoint_cfg.notification);
|
||||
pipe = usb_rcvintpipe(i2400mu->usb_dev, epd->bEndpointAddress);
|
||||
usb_fill_int_urb(urb, i2400mu->usb_dev, pipe,
|
||||
i2400m->bm_ack_buf, I2400M_BM_ACK_BUF_SIZE,
|
||||
__i2400mu_bm_notif_cb, completion,
|
||||
epd->bInterval);
|
||||
return usb_submit_urb(urb, GFP_KERNEL);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Read an ack from the notification endpoint
|
||||
*
|
||||
* @i2400m:
|
||||
* @_ack: pointer to where to store the read data
|
||||
* @ack_size: how many bytes we should read
|
||||
*
|
||||
* Returns: < 0 errno code on error; otherwise, amount of received bytes.
|
||||
*
|
||||
* Submits a notification read, appends the read data to the given ack
|
||||
* buffer and then repeats (until @ack_size bytes have been
|
||||
* received).
|
||||
*/
|
||||
ssize_t i2400mu_bus_bm_wait_for_ack(struct i2400m *i2400m,
|
||||
struct i2400m_bootrom_header *_ack,
|
||||
size_t ack_size)
|
||||
{
|
||||
ssize_t result = -ENOMEM;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
struct urb notif_urb;
|
||||
void *ack = _ack;
|
||||
size_t offset, len;
|
||||
long val;
|
||||
int do_autopm = 1;
|
||||
DECLARE_COMPLETION_ONSTACK(notif_completion);
|
||||
|
||||
d_fnstart(8, dev, "(i2400m %p ack %p size %zu)\n",
|
||||
i2400m, ack, ack_size);
|
||||
BUG_ON(_ack == i2400m->bm_ack_buf);
|
||||
result = usb_autopm_get_interface(i2400mu->usb_iface);
|
||||
if (result < 0) {
|
||||
dev_err(dev, "BM-ACK: can't get autopm: %d\n", (int) result);
|
||||
do_autopm = 0;
|
||||
}
|
||||
usb_init_urb(¬if_urb); /* ready notifications */
|
||||
usb_get_urb(¬if_urb);
|
||||
offset = 0;
|
||||
while (offset < ack_size) {
|
||||
init_completion(¬if_completion);
|
||||
result = i2400mu_notif_submit(i2400mu, ¬if_urb,
|
||||
¬if_completion);
|
||||
if (result < 0)
|
||||
goto error_notif_urb_submit;
|
||||
val = wait_for_completion_interruptible_timeout(
|
||||
¬if_completion, HZ);
|
||||
if (val == 0) {
|
||||
result = -ETIMEDOUT;
|
||||
usb_kill_urb(¬if_urb); /* Timedout */
|
||||
goto error_notif_wait;
|
||||
}
|
||||
if (val == -ERESTARTSYS) {
|
||||
result = -EINTR; /* Interrupted */
|
||||
usb_kill_urb(¬if_urb);
|
||||
goto error_notif_wait;
|
||||
}
|
||||
result = notif_urb.status; /* How was the ack? */
|
||||
switch (result) {
|
||||
case 0:
|
||||
break;
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* just ignore it */
|
||||
case -ESHUTDOWN: /* and exit */
|
||||
case -ECONNRESET:
|
||||
result = -ESHUTDOWN;
|
||||
goto error_dev_gone;
|
||||
default: /* any other? */
|
||||
usb_kill_urb(¬if_urb); /* Timedout */
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME))
|
||||
goto error_exceeded;
|
||||
dev_err(dev, "BM-ACK: URB error %d, "
|
||||
"retrying\n", notif_urb.status);
|
||||
continue; /* retry */
|
||||
}
|
||||
if (notif_urb.actual_length == 0) {
|
||||
d_printf(6, dev, "ZLP received, retrying\n");
|
||||
continue;
|
||||
}
|
||||
/* Got data, append it to the buffer */
|
||||
len = min(ack_size - offset, (size_t) notif_urb.actual_length);
|
||||
memcpy(ack + offset, i2400m->bm_ack_buf, len);
|
||||
offset += len;
|
||||
}
|
||||
result = offset;
|
||||
error_notif_urb_submit:
|
||||
error_notif_wait:
|
||||
error_dev_gone:
|
||||
out:
|
||||
if (do_autopm)
|
||||
usb_autopm_put_interface(i2400mu->usb_iface);
|
||||
d_fnend(8, dev, "(i2400m %p ack %p size %zu) = %ld\n",
|
||||
i2400m, ack, ack_size, (long) result);
|
||||
return result;
|
||||
|
||||
error_exceeded:
|
||||
dev_err(dev, "bm: maximum errors in notification URB exceeded; "
|
||||
"resetting device\n");
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
goto out;
|
||||
}
|
259
drivers/net/wimax/i2400m/usb-notif.c
Normal file
259
drivers/net/wimax/i2400m/usb-notif.c
Normal file
|
@ -0,0 +1,259 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m over USB
|
||||
* Notification handling
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* * Neither the name of Intel Corporation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||||
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||||
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
*
|
||||
* Intel Corporation <linux-wimax@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* - Initial implementation
|
||||
*
|
||||
*
|
||||
* The notification endpoint is active when the device is not in boot
|
||||
* mode; in here we just read and get notifications; based on those,
|
||||
* we act to either reinitialize the device after a reboot or to
|
||||
* submit a RX request.
|
||||
*
|
||||
* ROADMAP
|
||||
*
|
||||
* i2400mu_usb_notification_setup()
|
||||
*
|
||||
* i2400mu_usb_notification_release()
|
||||
*
|
||||
* i2400mu_usb_notification_cb() Called when a URB is ready
|
||||
* i2400mu_notif_grok()
|
||||
* i2400m_is_boot_barker()
|
||||
* i2400m_dev_reset_handle()
|
||||
* i2400mu_rx_kick()
|
||||
*/
|
||||
#include <linux/usb.h>
|
||||
#include <linux/slab.h>
|
||||
#include "i2400m-usb.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE notif
|
||||
#include "usb-debug-levels.h"
|
||||
|
||||
|
||||
static const
|
||||
__le32 i2400m_ZERO_BARKER[4] = { 0, 0, 0, 0 };
|
||||
|
||||
|
||||
/*
|
||||
* Process a received notification
|
||||
*
|
||||
* In normal operation mode, we can only receive two types of payloads
|
||||
* on the notification endpoint:
|
||||
*
|
||||
* - a reboot barker, we do a bootstrap (the device has reseted).
|
||||
*
|
||||
* - a block of zeroes: there is pending data in the IN endpoint
|
||||
*/
|
||||
static
|
||||
int i2400mu_notification_grok(struct i2400mu *i2400mu, const void *buf,
|
||||
size_t buf_len)
|
||||
{
|
||||
int ret;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
|
||||
d_fnstart(4, dev, "(i2400m %p buf %p buf_len %zu)\n",
|
||||
i2400mu, buf, buf_len);
|
||||
ret = -EIO;
|
||||
if (buf_len < sizeof(i2400m_ZERO_BARKER))
|
||||
/* Not a bug, just ignore */
|
||||
goto error_bad_size;
|
||||
ret = 0;
|
||||
if (!memcmp(i2400m_ZERO_BARKER, buf, sizeof(i2400m_ZERO_BARKER))) {
|
||||
i2400mu_rx_kick(i2400mu);
|
||||
goto out;
|
||||
}
|
||||
ret = i2400m_is_boot_barker(i2400m, buf, buf_len);
|
||||
if (unlikely(ret >= 0))
|
||||
ret = i2400m_dev_reset_handle(i2400m, "device rebooted");
|
||||
else /* Unknown or unexpected data in the notif message */
|
||||
i2400m_unknown_barker(i2400m, buf, buf_len);
|
||||
error_bad_size:
|
||||
out:
|
||||
d_fnend(4, dev, "(i2400m %p buf %p buf_len %zu) = %d\n",
|
||||
i2400mu, buf, buf_len, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* URB callback for the notification endpoint
|
||||
*
|
||||
* @urb: the urb received from the notification endpoint
|
||||
*
|
||||
* This function will just process the USB side of the transaction,
|
||||
* checking everything is fine, pass the processing to
|
||||
* i2400m_notification_grok() and resubmit the URB.
|
||||
*/
|
||||
static
|
||||
void i2400mu_notification_cb(struct urb *urb)
|
||||
{
|
||||
int ret;
|
||||
struct i2400mu *i2400mu = urb->context;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
d_fnstart(4, dev, "(urb %p status %d actual_length %d)\n",
|
||||
urb, urb->status, urb->actual_length);
|
||||
ret = urb->status;
|
||||
switch (ret) {
|
||||
case 0:
|
||||
ret = i2400mu_notification_grok(i2400mu, urb->transfer_buffer,
|
||||
urb->actual_length);
|
||||
if (ret == -EIO && edc_inc(&i2400mu->urb_edc, EDC_MAX_ERRORS,
|
||||
EDC_ERROR_TIMEFRAME))
|
||||
goto error_exceeded;
|
||||
if (ret == -ENOMEM) /* uff...power cycle? shutdown? */
|
||||
goto error_exceeded;
|
||||
break;
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* ditto */
|
||||
case -ESHUTDOWN: /* URB killed */
|
||||
case -ECONNRESET: /* disconnection */
|
||||
goto out; /* Notify around */
|
||||
default: /* Some error? */
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME))
|
||||
goto error_exceeded;
|
||||
dev_err(dev, "notification: URB error %d, retrying\n",
|
||||
urb->status);
|
||||
}
|
||||
usb_mark_last_busy(i2400mu->usb_dev);
|
||||
ret = usb_submit_urb(i2400mu->notif_urb, GFP_ATOMIC);
|
||||
switch (ret) {
|
||||
case 0:
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* ditto */
|
||||
case -ESHUTDOWN: /* URB killed */
|
||||
case -ECONNRESET: /* disconnection */
|
||||
break; /* just ignore */
|
||||
default: /* Some error? */
|
||||
dev_err(dev, "notification: cannot submit URB: %d\n", ret);
|
||||
goto error_submit;
|
||||
}
|
||||
d_fnend(4, dev, "(urb %p status %d actual_length %d) = void\n",
|
||||
urb, urb->status, urb->actual_length);
|
||||
return;
|
||||
|
||||
error_exceeded:
|
||||
dev_err(dev, "maximum errors in notification URB exceeded; "
|
||||
"resetting device\n");
|
||||
error_submit:
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
out:
|
||||
d_fnend(4, dev, "(urb %p status %d actual_length %d) = void\n",
|
||||
urb, urb->status, urb->actual_length);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* setup the notification endpoint
|
||||
*
|
||||
* @i2400m: device descriptor
|
||||
*
|
||||
* This procedure prepares the notification urb and handler for receiving
|
||||
* unsolicited barkers from the device.
|
||||
*/
|
||||
int i2400mu_notification_setup(struct i2400mu *i2400mu)
|
||||
{
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
int usb_pipe, ret = 0;
|
||||
struct usb_endpoint_descriptor *epd;
|
||||
char *buf;
|
||||
|
||||
d_fnstart(4, dev, "(i2400m %p)\n", i2400mu);
|
||||
buf = kmalloc(I2400MU_MAX_NOTIFICATION_LEN, GFP_KERNEL | GFP_DMA);
|
||||
if (buf == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto error_buf_alloc;
|
||||
}
|
||||
|
||||
i2400mu->notif_urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||
if (!i2400mu->notif_urb) {
|
||||
ret = -ENOMEM;
|
||||
dev_err(dev, "notification: cannot allocate URB\n");
|
||||
goto error_alloc_urb;
|
||||
}
|
||||
epd = usb_get_epd(i2400mu->usb_iface,
|
||||
i2400mu->endpoint_cfg.notification);
|
||||
usb_pipe = usb_rcvintpipe(i2400mu->usb_dev, epd->bEndpointAddress);
|
||||
usb_fill_int_urb(i2400mu->notif_urb, i2400mu->usb_dev, usb_pipe,
|
||||
buf, I2400MU_MAX_NOTIFICATION_LEN,
|
||||
i2400mu_notification_cb, i2400mu, epd->bInterval);
|
||||
ret = usb_submit_urb(i2400mu->notif_urb, GFP_KERNEL);
|
||||
if (ret != 0) {
|
||||
dev_err(dev, "notification: cannot submit URB: %d\n", ret);
|
||||
goto error_submit;
|
||||
}
|
||||
d_fnend(4, dev, "(i2400m %p) = %d\n", i2400mu, ret);
|
||||
return ret;
|
||||
|
||||
error_submit:
|
||||
usb_free_urb(i2400mu->notif_urb);
|
||||
error_alloc_urb:
|
||||
kfree(buf);
|
||||
error_buf_alloc:
|
||||
d_fnend(4, dev, "(i2400m %p) = %d\n", i2400mu, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Tear down of the notification mechanism
|
||||
*
|
||||
* @i2400m: device descriptor
|
||||
*
|
||||
* Kill the interrupt endpoint urb, free any allocated resources.
|
||||
*
|
||||
* We need to check if we have done it before as for example,
|
||||
* _suspend() call this; if after a suspend() we get a _disconnect()
|
||||
* (as the case is when hibernating), nothing bad happens.
|
||||
*/
|
||||
void i2400mu_notification_release(struct i2400mu *i2400mu)
|
||||
{
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
if (i2400mu->notif_urb != NULL) {
|
||||
usb_kill_urb(i2400mu->notif_urb);
|
||||
kfree(i2400mu->notif_urb->transfer_buffer);
|
||||
usb_free_urb(i2400mu->notif_urb);
|
||||
i2400mu->notif_urb = NULL;
|
||||
}
|
||||
d_fnend(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
}
|
465
drivers/net/wimax/i2400m/usb-rx.c
Normal file
465
drivers/net/wimax/i2400m/usb-rx.c
Normal file
|
@ -0,0 +1,465 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* USB RX handling
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* * Neither the name of Intel Corporation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||||
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||||
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
*
|
||||
* Intel Corporation <linux-wimax@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* - Initial implementation
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* - Use skb_clone(), break up processing in chunks
|
||||
* - Split transport/device specific
|
||||
* - Make buffer size dynamic to exert less memory pressure
|
||||
*
|
||||
*
|
||||
* This handles the RX path on USB.
|
||||
*
|
||||
* When a notification is received that says 'there is RX data ready',
|
||||
* we call i2400mu_rx_kick(); that wakes up the RX kthread, which
|
||||
* reads a buffer from USB and passes it to i2400m_rx() in the generic
|
||||
* handling code. The RX buffer has an specific format that is
|
||||
* described in rx.c.
|
||||
*
|
||||
* We use a kernel thread in a loop because:
|
||||
*
|
||||
* - we want to be able to call the USB power management get/put
|
||||
* functions (blocking) before each transaction.
|
||||
*
|
||||
* - We might get a lot of notifications and we don't want to submit
|
||||
* a zillion reads; by serializing, we are throttling.
|
||||
*
|
||||
* - RX data processing can get heavy enough so that it is not
|
||||
* appropriate for doing it in the USB callback; thus we run it in a
|
||||
* process context.
|
||||
*
|
||||
* We provide a read buffer of an arbitrary size (short of a page); if
|
||||
* the callback reports -EOVERFLOW, it means it was too small, so we
|
||||
* just double the size and retry (being careful to append, as
|
||||
* sometimes the device provided some data). Every now and then we
|
||||
* check if the average packet size is smaller than the current packet
|
||||
* size and if so, we halve it. At the end, the size of the
|
||||
* preallocated buffer should be following the average received
|
||||
* transaction size, adapting dynamically to it.
|
||||
*
|
||||
* ROADMAP
|
||||
*
|
||||
* i2400mu_rx_kick() Called from notif.c when we get a
|
||||
* 'data ready' notification
|
||||
* i2400mu_rxd() Kernel RX daemon
|
||||
* i2400mu_rx() Receive USB data
|
||||
* i2400m_rx() Send data to generic i2400m RX handling
|
||||
*
|
||||
* i2400mu_rx_setup() called from i2400mu_bus_dev_start()
|
||||
*
|
||||
* i2400mu_rx_release() called from i2400mu_bus_dev_stop()
|
||||
*/
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/usb.h>
|
||||
#include "i2400m-usb.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE rx
|
||||
#include "usb-debug-levels.h"
|
||||
|
||||
/*
|
||||
* Dynamic RX size
|
||||
*
|
||||
* We can't let the rx_size be a multiple of 512 bytes (the RX
|
||||
* endpoint's max packet size). On some USB host controllers (we
|
||||
* haven't been able to fully characterize which), if the device is
|
||||
* about to send (for example) X bytes and we only post a buffer to
|
||||
* receive n*512, it will fail to mark that as babble (so that
|
||||
* i2400mu_rx() [case -EOVERFLOW] can resize the buffer and get the
|
||||
* rest).
|
||||
*
|
||||
* So on growing or shrinking, if it is a multiple of the
|
||||
* maxpacketsize, we remove some (instead of incresing some, so in a
|
||||
* buddy allocator we try to waste less space).
|
||||
*
|
||||
* Note we also need a hook for this on i2400mu_rx() -- when we do the
|
||||
* first read, we are sure we won't hit this spot because
|
||||
* i240mm->rx_size has been set properly. However, if we have to
|
||||
* double because of -EOVERFLOW, when we launch the read to get the
|
||||
* rest of the data, we *have* to make sure that also is not a
|
||||
* multiple of the max_pkt_size.
|
||||
*/
|
||||
|
||||
static
|
||||
size_t i2400mu_rx_size_grow(struct i2400mu *i2400mu)
|
||||
{
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
size_t rx_size;
|
||||
const size_t max_pkt_size = 512;
|
||||
|
||||
rx_size = 2 * i2400mu->rx_size;
|
||||
if (rx_size % max_pkt_size == 0) {
|
||||
rx_size -= 8;
|
||||
d_printf(1, dev,
|
||||
"RX: expected size grew to %zu [adjusted -8] "
|
||||
"from %zu\n",
|
||||
rx_size, i2400mu->rx_size);
|
||||
} else
|
||||
d_printf(1, dev,
|
||||
"RX: expected size grew to %zu from %zu\n",
|
||||
rx_size, i2400mu->rx_size);
|
||||
return rx_size;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void i2400mu_rx_size_maybe_shrink(struct i2400mu *i2400mu)
|
||||
{
|
||||
const size_t max_pkt_size = 512;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
if (unlikely(i2400mu->rx_size_cnt >= 100
|
||||
&& i2400mu->rx_size_auto_shrink)) {
|
||||
size_t avg_rx_size =
|
||||
i2400mu->rx_size_acc / i2400mu->rx_size_cnt;
|
||||
size_t new_rx_size = i2400mu->rx_size / 2;
|
||||
if (avg_rx_size < new_rx_size) {
|
||||
if (new_rx_size % max_pkt_size == 0) {
|
||||
new_rx_size -= 8;
|
||||
d_printf(1, dev,
|
||||
"RX: expected size shrank to %zu "
|
||||
"[adjusted -8] from %zu\n",
|
||||
new_rx_size, i2400mu->rx_size);
|
||||
} else
|
||||
d_printf(1, dev,
|
||||
"RX: expected size shrank to %zu "
|
||||
"from %zu\n",
|
||||
new_rx_size, i2400mu->rx_size);
|
||||
i2400mu->rx_size = new_rx_size;
|
||||
i2400mu->rx_size_cnt = 0;
|
||||
i2400mu->rx_size_acc = i2400mu->rx_size;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Receive a message with payloads from the USB bus into an skb
|
||||
*
|
||||
* @i2400mu: USB device descriptor
|
||||
* @rx_skb: skb where to place the received message
|
||||
*
|
||||
* Deals with all the USB-specifics of receiving, dynamically
|
||||
* increasing the buffer size if so needed. Returns the payload in the
|
||||
* skb, ready to process. On a zero-length packet, we retry.
|
||||
*
|
||||
* On soft USB errors, we retry (until they become too frequent and
|
||||
* then are promoted to hard); on hard USB errors, we reset the
|
||||
* device. On other errors (skb realloacation, we just drop it and
|
||||
* hope for the next invocation to solve it).
|
||||
*
|
||||
* Returns: pointer to the skb if ok, ERR_PTR on error.
|
||||
* NOTE: this function might realloc the skb (if it is too small),
|
||||
* so always update with the one returned.
|
||||
* ERR_PTR() is < 0 on error.
|
||||
* Will return NULL if it cannot reallocate -- this can be
|
||||
* considered a transient retryable error.
|
||||
*/
|
||||
static
|
||||
struct sk_buff *i2400mu_rx(struct i2400mu *i2400mu, struct sk_buff *rx_skb)
|
||||
{
|
||||
int result = 0;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
int usb_pipe, read_size, rx_size, do_autopm;
|
||||
struct usb_endpoint_descriptor *epd;
|
||||
const size_t max_pkt_size = 512;
|
||||
|
||||
d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
do_autopm = atomic_read(&i2400mu->do_autopm);
|
||||
result = do_autopm ?
|
||||
usb_autopm_get_interface(i2400mu->usb_iface) : 0;
|
||||
if (result < 0) {
|
||||
dev_err(dev, "RX: can't get autopm: %d\n", result);
|
||||
do_autopm = 0;
|
||||
}
|
||||
epd = usb_get_epd(i2400mu->usb_iface, i2400mu->endpoint_cfg.bulk_in);
|
||||
usb_pipe = usb_rcvbulkpipe(i2400mu->usb_dev, epd->bEndpointAddress);
|
||||
retry:
|
||||
rx_size = skb_end_pointer(rx_skb) - rx_skb->data - rx_skb->len;
|
||||
if (unlikely(rx_size % max_pkt_size == 0)) {
|
||||
rx_size -= 8;
|
||||
d_printf(1, dev, "RX: rx_size adapted to %d [-8]\n", rx_size);
|
||||
}
|
||||
result = usb_bulk_msg(
|
||||
i2400mu->usb_dev, usb_pipe, rx_skb->data + rx_skb->len,
|
||||
rx_size, &read_size, 200);
|
||||
usb_mark_last_busy(i2400mu->usb_dev);
|
||||
switch (result) {
|
||||
case 0:
|
||||
if (read_size == 0)
|
||||
goto retry; /* ZLP, just resubmit */
|
||||
skb_put(rx_skb, read_size);
|
||||
break;
|
||||
case -EPIPE:
|
||||
/*
|
||||
* Stall -- maybe the device is choking with our
|
||||
* requests. Clear it and give it some time. If they
|
||||
* happen to often, it might be another symptom, so we
|
||||
* reset.
|
||||
*
|
||||
* No error handling for usb_clear_halt(0; if it
|
||||
* works, the retry works; if it fails, this switch
|
||||
* does the error handling for us.
|
||||
*/
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
10 * EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "BM-CMD: too many stalls in "
|
||||
"URB; resetting device\n");
|
||||
goto do_reset;
|
||||
}
|
||||
usb_clear_halt(i2400mu->usb_dev, usb_pipe);
|
||||
msleep(10); /* give the device some time */
|
||||
goto retry;
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* just ignore it */
|
||||
case -ESHUTDOWN:
|
||||
case -ECONNRESET:
|
||||
break;
|
||||
case -EOVERFLOW: { /* too small, reallocate */
|
||||
struct sk_buff *new_skb;
|
||||
rx_size = i2400mu_rx_size_grow(i2400mu);
|
||||
if (rx_size <= (1 << 16)) /* cap it */
|
||||
i2400mu->rx_size = rx_size;
|
||||
else if (printk_ratelimit()) {
|
||||
dev_err(dev, "BUG? rx_size up to %d\n", rx_size);
|
||||
result = -EINVAL;
|
||||
goto out;
|
||||
}
|
||||
skb_put(rx_skb, read_size);
|
||||
new_skb = skb_copy_expand(rx_skb, 0, rx_size - rx_skb->len,
|
||||
GFP_KERNEL);
|
||||
if (new_skb == NULL) {
|
||||
if (printk_ratelimit())
|
||||
dev_err(dev, "RX: Can't reallocate skb to %d; "
|
||||
"RX dropped\n", rx_size);
|
||||
kfree_skb(rx_skb);
|
||||
rx_skb = NULL;
|
||||
goto out; /* drop it...*/
|
||||
}
|
||||
kfree_skb(rx_skb);
|
||||
rx_skb = new_skb;
|
||||
i2400mu->rx_size_cnt = 0;
|
||||
i2400mu->rx_size_acc = i2400mu->rx_size;
|
||||
d_printf(1, dev, "RX: size changed to %d, received %d, "
|
||||
"copied %d, capacity %ld\n",
|
||||
rx_size, read_size, rx_skb->len,
|
||||
(long) skb_end_offset(new_skb));
|
||||
goto retry;
|
||||
}
|
||||
/* In most cases, it happens due to the hardware scheduling a
|
||||
* read when there was no data - unfortunately, we have no way
|
||||
* to tell this timeout from a USB timeout. So we just ignore
|
||||
* it. */
|
||||
case -ETIMEDOUT:
|
||||
dev_err(dev, "RX: timeout: %d\n", result);
|
||||
result = 0;
|
||||
break;
|
||||
default: /* Any error */
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME))
|
||||
goto error_reset;
|
||||
dev_err(dev, "RX: error receiving URB: %d, retrying\n", result);
|
||||
goto retry;
|
||||
}
|
||||
out:
|
||||
if (do_autopm)
|
||||
usb_autopm_put_interface(i2400mu->usb_iface);
|
||||
d_fnend(4, dev, "(i2400mu %p) = %p\n", i2400mu, rx_skb);
|
||||
return rx_skb;
|
||||
|
||||
error_reset:
|
||||
dev_err(dev, "RX: maximum errors in URB exceeded; "
|
||||
"resetting device\n");
|
||||
do_reset:
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
rx_skb = ERR_PTR(result);
|
||||
goto out;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Kernel thread for USB reception of data
|
||||
*
|
||||
* This thread waits for a kick; once kicked, it will allocate an skb
|
||||
* and receive a single message to it from USB (using
|
||||
* i2400mu_rx()). Once received, it is passed to the generic i2400m RX
|
||||
* code for processing.
|
||||
*
|
||||
* When done processing, it runs some dirty statistics to verify if
|
||||
* the last 100 messages received were smaller than half of the
|
||||
* current RX buffer size. In that case, the RX buffer size is
|
||||
* halved. This will helps lowering the pressure on the memory
|
||||
* allocator.
|
||||
*
|
||||
* Hard errors force the thread to exit.
|
||||
*/
|
||||
static
|
||||
int i2400mu_rxd(void *_i2400mu)
|
||||
{
|
||||
int result = 0;
|
||||
struct i2400mu *i2400mu = _i2400mu;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
struct net_device *net_dev = i2400m->wimax_dev.net_dev;
|
||||
size_t pending;
|
||||
int rx_size;
|
||||
struct sk_buff *rx_skb;
|
||||
unsigned long flags;
|
||||
|
||||
d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
spin_lock_irqsave(&i2400m->rx_lock, flags);
|
||||
BUG_ON(i2400mu->rx_kthread != NULL);
|
||||
i2400mu->rx_kthread = current;
|
||||
spin_unlock_irqrestore(&i2400m->rx_lock, flags);
|
||||
while (1) {
|
||||
d_printf(2, dev, "RX: waiting for messages\n");
|
||||
pending = 0;
|
||||
wait_event_interruptible(
|
||||
i2400mu->rx_wq,
|
||||
(kthread_should_stop() /* check this first! */
|
||||
|| (pending = atomic_read(&i2400mu->rx_pending_count)))
|
||||
);
|
||||
if (kthread_should_stop())
|
||||
break;
|
||||
if (pending == 0)
|
||||
continue;
|
||||
rx_size = i2400mu->rx_size;
|
||||
d_printf(2, dev, "RX: reading up to %d bytes\n", rx_size);
|
||||
rx_skb = __netdev_alloc_skb(net_dev, rx_size, GFP_KERNEL);
|
||||
if (rx_skb == NULL) {
|
||||
dev_err(dev, "RX: can't allocate skb [%d bytes]\n",
|
||||
rx_size);
|
||||
msleep(50); /* give it some time? */
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Receive the message with the payloads */
|
||||
rx_skb = i2400mu_rx(i2400mu, rx_skb);
|
||||
result = PTR_ERR(rx_skb);
|
||||
if (IS_ERR(rx_skb))
|
||||
goto out;
|
||||
atomic_dec(&i2400mu->rx_pending_count);
|
||||
if (rx_skb == NULL || rx_skb->len == 0) {
|
||||
/* some "ignorable" condition */
|
||||
kfree_skb(rx_skb);
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Deliver the message to the generic i2400m code */
|
||||
i2400mu->rx_size_cnt++;
|
||||
i2400mu->rx_size_acc += rx_skb->len;
|
||||
result = i2400m_rx(i2400m, rx_skb);
|
||||
if (result == -EIO
|
||||
&& edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
goto error_reset;
|
||||
}
|
||||
|
||||
/* Maybe adjust RX buffer size */
|
||||
i2400mu_rx_size_maybe_shrink(i2400mu);
|
||||
}
|
||||
result = 0;
|
||||
out:
|
||||
spin_lock_irqsave(&i2400m->rx_lock, flags);
|
||||
i2400mu->rx_kthread = NULL;
|
||||
spin_unlock_irqrestore(&i2400m->rx_lock, flags);
|
||||
d_fnend(4, dev, "(i2400mu %p) = %d\n", i2400mu, result);
|
||||
return result;
|
||||
|
||||
error_reset:
|
||||
dev_err(dev, "RX: maximum errors in received buffer exceeded; "
|
||||
"resetting device\n");
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
goto out;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Start reading from the device
|
||||
*
|
||||
* @i2400m: device instance
|
||||
*
|
||||
* Notify the RX thread that there is data pending.
|
||||
*/
|
||||
void i2400mu_rx_kick(struct i2400mu *i2400mu)
|
||||
{
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
d_fnstart(3, dev, "(i2400mu %p)\n", i2400m);
|
||||
atomic_inc(&i2400mu->rx_pending_count);
|
||||
wake_up_all(&i2400mu->rx_wq);
|
||||
d_fnend(3, dev, "(i2400m %p) = void\n", i2400m);
|
||||
}
|
||||
|
||||
|
||||
int i2400mu_rx_setup(struct i2400mu *i2400mu)
|
||||
{
|
||||
int result = 0;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
struct wimax_dev *wimax_dev = &i2400m->wimax_dev;
|
||||
struct task_struct *kthread;
|
||||
|
||||
kthread = kthread_run(i2400mu_rxd, i2400mu, "%s-rx",
|
||||
wimax_dev->name);
|
||||
/* the kthread function sets i2400mu->rx_thread */
|
||||
if (IS_ERR(kthread)) {
|
||||
result = PTR_ERR(kthread);
|
||||
dev_err(dev, "RX: cannot start thread: %d\n", result);
|
||||
}
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
void i2400mu_rx_release(struct i2400mu *i2400mu)
|
||||
{
|
||||
unsigned long flags;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct task_struct *kthread;
|
||||
|
||||
spin_lock_irqsave(&i2400m->rx_lock, flags);
|
||||
kthread = i2400mu->rx_kthread;
|
||||
i2400mu->rx_kthread = NULL;
|
||||
spin_unlock_irqrestore(&i2400m->rx_lock, flags);
|
||||
if (kthread)
|
||||
kthread_stop(kthread);
|
||||
else
|
||||
d_printf(1, dev, "RX: kthread had already exited\n");
|
||||
}
|
||||
|
273
drivers/net/wimax/i2400m/usb-tx.c
Normal file
273
drivers/net/wimax/i2400m/usb-tx.c
Normal file
|
@ -0,0 +1,273 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* USB specific TX handling
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* * Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* * Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in
|
||||
* the documentation and/or other materials provided with the
|
||||
* distribution.
|
||||
* * Neither the name of Intel Corporation nor the names of its
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||||
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||||
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||||
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*
|
||||
*
|
||||
* Intel Corporation <linux-wimax@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
* - Initial implementation
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* - Split transport/device specific
|
||||
*
|
||||
*
|
||||
* Takes the TX messages in the i2400m's driver TX FIFO and sends them
|
||||
* to the device until there are no more.
|
||||
*
|
||||
* If we fail sending the message, we just drop it. There isn't much
|
||||
* we can do at this point. We could also retry, but the USB stack has
|
||||
* already retried and still failed, so there is not much of a
|
||||
* point. As well, most of the traffic is network, which has recovery
|
||||
* methods for dropped packets.
|
||||
*
|
||||
* For sending we just obtain a FIFO buffer to send, send it to the
|
||||
* USB bulk out, tell the TX FIFO code we have sent it; query for
|
||||
* another one, etc... until done.
|
||||
*
|
||||
* We use a thread so we can call usb_autopm_enable() and
|
||||
* usb_autopm_disable() for each transaction; this way when the device
|
||||
* goes idle, it will suspend. It also has less overhead than a
|
||||
* dedicated workqueue, as it is being used for a single task.
|
||||
*
|
||||
* ROADMAP
|
||||
*
|
||||
* i2400mu_tx_setup()
|
||||
* i2400mu_tx_release()
|
||||
*
|
||||
* i2400mu_bus_tx_kick() - Called by the tx.c code when there
|
||||
* is new data in the FIFO.
|
||||
* i2400mu_txd()
|
||||
* i2400m_tx_msg_get()
|
||||
* i2400m_tx_msg_sent()
|
||||
*/
|
||||
#include "i2400m-usb.h"
|
||||
|
||||
|
||||
#define D_SUBMODULE tx
|
||||
#include "usb-debug-levels.h"
|
||||
|
||||
|
||||
/*
|
||||
* Get the next TX message in the TX FIFO and send it to the device
|
||||
*
|
||||
* Note that any iteration consumes a message to be sent, no matter if
|
||||
* it succeeds or fails (we have no real way to retry or complain).
|
||||
*
|
||||
* Return: 0 if ok, < 0 errno code on hard error.
|
||||
*/
|
||||
static
|
||||
int i2400mu_tx(struct i2400mu *i2400mu, struct i2400m_msg_hdr *tx_msg,
|
||||
size_t tx_msg_size)
|
||||
{
|
||||
int result = 0;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
int usb_pipe, sent_size, do_autopm;
|
||||
struct usb_endpoint_descriptor *epd;
|
||||
|
||||
d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
do_autopm = atomic_read(&i2400mu->do_autopm);
|
||||
result = do_autopm ?
|
||||
usb_autopm_get_interface(i2400mu->usb_iface) : 0;
|
||||
if (result < 0) {
|
||||
dev_err(dev, "TX: can't get autopm: %d\n", result);
|
||||
do_autopm = 0;
|
||||
}
|
||||
epd = usb_get_epd(i2400mu->usb_iface, i2400mu->endpoint_cfg.bulk_out);
|
||||
usb_pipe = usb_sndbulkpipe(i2400mu->usb_dev, epd->bEndpointAddress);
|
||||
retry:
|
||||
result = usb_bulk_msg(i2400mu->usb_dev, usb_pipe,
|
||||
tx_msg, tx_msg_size, &sent_size, 200);
|
||||
usb_mark_last_busy(i2400mu->usb_dev);
|
||||
switch (result) {
|
||||
case 0:
|
||||
if (sent_size != tx_msg_size) { /* Too short? drop it */
|
||||
dev_err(dev, "TX: short write (%d B vs %zu "
|
||||
"expected)\n", sent_size, tx_msg_size);
|
||||
result = -EIO;
|
||||
}
|
||||
break;
|
||||
case -EPIPE:
|
||||
/*
|
||||
* Stall -- maybe the device is choking with our
|
||||
* requests. Clear it and give it some time. If they
|
||||
* happen to often, it might be another symptom, so we
|
||||
* reset.
|
||||
*
|
||||
* No error handling for usb_clear_halt(0; if it
|
||||
* works, the retry works; if it fails, this switch
|
||||
* does the error handling for us.
|
||||
*/
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
10 * EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "BM-CMD: too many stalls in "
|
||||
"URB; resetting device\n");
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
/* fallthrough */
|
||||
} else {
|
||||
usb_clear_halt(i2400mu->usb_dev, usb_pipe);
|
||||
msleep(10); /* give the device some time */
|
||||
goto retry;
|
||||
}
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* just ignore it */
|
||||
case -ESHUTDOWN: /* and exit */
|
||||
case -ECONNRESET:
|
||||
result = -ESHUTDOWN;
|
||||
break;
|
||||
default: /* Some error? */
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "TX: maximum errors in URB "
|
||||
"exceeded; resetting device\n");
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
} else {
|
||||
dev_err(dev, "TX: cannot send URB; retrying. "
|
||||
"tx_msg @%zu %zu B [%d sent]: %d\n",
|
||||
(void *) tx_msg - i2400m->tx_buf,
|
||||
tx_msg_size, sent_size, result);
|
||||
goto retry;
|
||||
}
|
||||
}
|
||||
if (do_autopm)
|
||||
usb_autopm_put_interface(i2400mu->usb_iface);
|
||||
d_fnend(4, dev, "(i2400mu %p) = result\n", i2400mu);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Get the next TX message in the TX FIFO and send it to the device
|
||||
*
|
||||
* Note we exit the loop if i2400mu_tx() fails; that function only
|
||||
* fails on hard error (failing to tx a buffer not being one of them,
|
||||
* see its doc).
|
||||
*
|
||||
* Return: 0
|
||||
*/
|
||||
static
|
||||
int i2400mu_txd(void *_i2400mu)
|
||||
{
|
||||
struct i2400mu *i2400mu = _i2400mu;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
struct i2400m_msg_hdr *tx_msg;
|
||||
size_t tx_msg_size;
|
||||
unsigned long flags;
|
||||
|
||||
d_fnstart(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
BUG_ON(i2400mu->tx_kthread != NULL);
|
||||
i2400mu->tx_kthread = current;
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
|
||||
while (1) {
|
||||
d_printf(2, dev, "TX: waiting for messages\n");
|
||||
tx_msg = NULL;
|
||||
wait_event_interruptible(
|
||||
i2400mu->tx_wq,
|
||||
(kthread_should_stop() /* check this first! */
|
||||
|| (tx_msg = i2400m_tx_msg_get(i2400m, &tx_msg_size)))
|
||||
);
|
||||
if (kthread_should_stop())
|
||||
break;
|
||||
WARN_ON(tx_msg == NULL); /* should not happen...*/
|
||||
d_printf(2, dev, "TX: submitting %zu bytes\n", tx_msg_size);
|
||||
d_dump(5, dev, tx_msg, tx_msg_size);
|
||||
/* Yeah, we ignore errors ... not much we can do */
|
||||
i2400mu_tx(i2400mu, tx_msg, tx_msg_size);
|
||||
i2400m_tx_msg_sent(i2400m); /* ack it, advance the FIFO */
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
i2400mu->tx_kthread = NULL;
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
|
||||
d_fnend(4, dev, "(i2400mu %p)\n", i2400mu);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* i2400m TX engine notifies us that there is data in the FIFO ready
|
||||
* for TX
|
||||
*
|
||||
* If there is a URB in flight, don't do anything; when it finishes,
|
||||
* it will see there is data in the FIFO and send it. Else, just
|
||||
* submit a write.
|
||||
*/
|
||||
void i2400mu_bus_tx_kick(struct i2400m *i2400m)
|
||||
{
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p) = void\n", i2400m);
|
||||
wake_up_all(&i2400mu->tx_wq);
|
||||
d_fnend(3, dev, "(i2400m %p) = void\n", i2400m);
|
||||
}
|
||||
|
||||
|
||||
int i2400mu_tx_setup(struct i2400mu *i2400mu)
|
||||
{
|
||||
int result = 0;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
struct wimax_dev *wimax_dev = &i2400m->wimax_dev;
|
||||
struct task_struct *kthread;
|
||||
|
||||
kthread = kthread_run(i2400mu_txd, i2400mu, "%s-tx",
|
||||
wimax_dev->name);
|
||||
/* the kthread function sets i2400mu->tx_thread */
|
||||
if (IS_ERR(kthread)) {
|
||||
result = PTR_ERR(kthread);
|
||||
dev_err(dev, "TX: cannot start thread: %d\n", result);
|
||||
}
|
||||
return result;
|
||||
}
|
||||
|
||||
void i2400mu_tx_release(struct i2400mu *i2400mu)
|
||||
{
|
||||
unsigned long flags;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
struct task_struct *kthread;
|
||||
|
||||
spin_lock_irqsave(&i2400m->tx_lock, flags);
|
||||
kthread = i2400mu->tx_kthread;
|
||||
i2400mu->tx_kthread = NULL;
|
||||
spin_unlock_irqrestore(&i2400m->tx_lock, flags);
|
||||
if (kthread)
|
||||
kthread_stop(kthread);
|
||||
else
|
||||
d_printf(1, dev, "TX: kthread had already exited\n");
|
||||
}
|
817
drivers/net/wimax/i2400m/usb.c
Normal file
817
drivers/net/wimax/i2400m/usb.c
Normal file
|
@ -0,0 +1,817 @@
|
|||
/*
|
||||
* Intel Wireless WiMAX Connection 2400m
|
||||
* Linux driver model glue for USB device, reset & fw upload
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com>
|
||||
* Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
|
||||
* Yanir Lubetkin <yanirx.lubetkin@intel.com>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* 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; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
||||
* 02110-1301, USA.
|
||||
*
|
||||
*
|
||||
* See i2400m-usb.h for a general description of this driver.
|
||||
*
|
||||
* This file implements driver model glue, and hook ups for the
|
||||
* generic driver to implement the bus-specific functions (device
|
||||
* communication setup/tear down, firmware upload and resetting).
|
||||
*
|
||||
* ROADMAP
|
||||
*
|
||||
* i2400mu_probe()
|
||||
* alloc_netdev()...
|
||||
* i2400mu_netdev_setup()
|
||||
* i2400mu_init()
|
||||
* i2400m_netdev_setup()
|
||||
* i2400m_setup()...
|
||||
*
|
||||
* i2400mu_disconnect
|
||||
* i2400m_release()
|
||||
* free_netdev()
|
||||
*
|
||||
* i2400mu_suspend()
|
||||
* i2400m_cmd_enter_powersave()
|
||||
* i2400mu_notification_release()
|
||||
*
|
||||
* i2400mu_resume()
|
||||
* i2400mu_notification_setup()
|
||||
*
|
||||
* i2400mu_bus_dev_start() Called by i2400m_dev_start() [who is
|
||||
* i2400mu_tx_setup() called by i2400m_setup()]
|
||||
* i2400mu_rx_setup()
|
||||
* i2400mu_notification_setup()
|
||||
*
|
||||
* i2400mu_bus_dev_stop() Called by i2400m_dev_stop() [who is
|
||||
* i2400mu_notification_release() called by i2400m_release()]
|
||||
* i2400mu_rx_release()
|
||||
* i2400mu_tx_release()
|
||||
*
|
||||
* i2400mu_bus_reset() Called by i2400m_reset
|
||||
* __i2400mu_reset()
|
||||
* __i2400mu_send_barker()
|
||||
* usb_reset_device()
|
||||
*/
|
||||
#include "i2400m-usb.h"
|
||||
#include <linux/wimax/i2400m.h>
|
||||
#include <linux/debugfs.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/module.h>
|
||||
|
||||
|
||||
#define D_SUBMODULE usb
|
||||
#include "usb-debug-levels.h"
|
||||
|
||||
static char i2400mu_debug_params[128];
|
||||
module_param_string(debug, i2400mu_debug_params, sizeof(i2400mu_debug_params),
|
||||
0644);
|
||||
MODULE_PARM_DESC(debug,
|
||||
"String of space-separated NAME:VALUE pairs, where NAMEs "
|
||||
"are the different debug submodules and VALUE are the "
|
||||
"initial debug value to set.");
|
||||
|
||||
/* Our firmware file name */
|
||||
static const char *i2400mu_bus_fw_names_5x50[] = {
|
||||
#define I2400MU_FW_FILE_NAME_v1_5 "i2400m-fw-usb-1.5.sbcf"
|
||||
I2400MU_FW_FILE_NAME_v1_5,
|
||||
#define I2400MU_FW_FILE_NAME_v1_4 "i2400m-fw-usb-1.4.sbcf"
|
||||
I2400MU_FW_FILE_NAME_v1_4,
|
||||
NULL,
|
||||
};
|
||||
|
||||
|
||||
static const char *i2400mu_bus_fw_names_6050[] = {
|
||||
#define I6050U_FW_FILE_NAME_v1_5 "i6050-fw-usb-1.5.sbcf"
|
||||
I6050U_FW_FILE_NAME_v1_5,
|
||||
NULL,
|
||||
};
|
||||
|
||||
|
||||
static
|
||||
int i2400mu_bus_dev_start(struct i2400m *i2400m)
|
||||
{
|
||||
int result;
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p)\n", i2400m);
|
||||
result = i2400mu_tx_setup(i2400mu);
|
||||
if (result < 0)
|
||||
goto error_usb_tx_setup;
|
||||
result = i2400mu_rx_setup(i2400mu);
|
||||
if (result < 0)
|
||||
goto error_usb_rx_setup;
|
||||
result = i2400mu_notification_setup(i2400mu);
|
||||
if (result < 0)
|
||||
goto error_notif_setup;
|
||||
d_fnend(3, dev, "(i2400m %p) = %d\n", i2400m, result);
|
||||
return result;
|
||||
|
||||
error_notif_setup:
|
||||
i2400mu_rx_release(i2400mu);
|
||||
error_usb_rx_setup:
|
||||
i2400mu_tx_release(i2400mu);
|
||||
error_usb_tx_setup:
|
||||
d_fnend(3, dev, "(i2400m %p) = void\n", i2400m);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void i2400mu_bus_dev_stop(struct i2400m *i2400m)
|
||||
{
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p)\n", i2400m);
|
||||
i2400mu_notification_release(i2400mu);
|
||||
i2400mu_rx_release(i2400mu);
|
||||
i2400mu_tx_release(i2400mu);
|
||||
d_fnend(3, dev, "(i2400m %p) = void\n", i2400m);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Sends a barker buffer to the device
|
||||
*
|
||||
* This helper will allocate a kmalloced buffer and use it to transmit
|
||||
* (then free it). Reason for this is that other arches cannot use
|
||||
* stack/vmalloc/text areas for DMA transfers.
|
||||
*
|
||||
* Error recovery here is simpler: anything is considered a hard error
|
||||
* and will move the reset code to use a last-resort bus-based reset.
|
||||
*/
|
||||
static
|
||||
int __i2400mu_send_barker(struct i2400mu *i2400mu,
|
||||
const __le32 *barker,
|
||||
size_t barker_size,
|
||||
unsigned endpoint)
|
||||
{
|
||||
struct usb_endpoint_descriptor *epd = NULL;
|
||||
int pipe, actual_len, ret;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
void *buffer;
|
||||
int do_autopm = 1;
|
||||
|
||||
ret = usb_autopm_get_interface(i2400mu->usb_iface);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "RESET: can't get autopm: %d\n", ret);
|
||||
do_autopm = 0;
|
||||
}
|
||||
ret = -ENOMEM;
|
||||
buffer = kmalloc(barker_size, GFP_KERNEL);
|
||||
if (buffer == NULL)
|
||||
goto error_kzalloc;
|
||||
epd = usb_get_epd(i2400mu->usb_iface, endpoint);
|
||||
pipe = usb_sndbulkpipe(i2400mu->usb_dev, epd->bEndpointAddress);
|
||||
memcpy(buffer, barker, barker_size);
|
||||
retry:
|
||||
ret = usb_bulk_msg(i2400mu->usb_dev, pipe, buffer, barker_size,
|
||||
&actual_len, 200);
|
||||
switch (ret) {
|
||||
case 0:
|
||||
if (actual_len != barker_size) { /* Too short? drop it */
|
||||
dev_err(dev, "E: %s: short write (%d B vs %zu "
|
||||
"expected)\n",
|
||||
__func__, actual_len, barker_size);
|
||||
ret = -EIO;
|
||||
}
|
||||
break;
|
||||
case -EPIPE:
|
||||
/*
|
||||
* Stall -- maybe the device is choking with our
|
||||
* requests. Clear it and give it some time. If they
|
||||
* happen to often, it might be another symptom, so we
|
||||
* reset.
|
||||
*
|
||||
* No error handling for usb_clear_halt(0; if it
|
||||
* works, the retry works; if it fails, this switch
|
||||
* does the error handling for us.
|
||||
*/
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
10 * EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "E: %s: too many stalls in "
|
||||
"URB; resetting device\n", __func__);
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
/* fallthrough */
|
||||
} else {
|
||||
usb_clear_halt(i2400mu->usb_dev, pipe);
|
||||
msleep(10); /* give the device some time */
|
||||
goto retry;
|
||||
}
|
||||
case -EINVAL: /* while removing driver */
|
||||
case -ENODEV: /* dev disconnect ... */
|
||||
case -ENOENT: /* just ignore it */
|
||||
case -ESHUTDOWN: /* and exit */
|
||||
case -ECONNRESET:
|
||||
ret = -ESHUTDOWN;
|
||||
break;
|
||||
default: /* Some error? */
|
||||
if (edc_inc(&i2400mu->urb_edc,
|
||||
EDC_MAX_ERRORS, EDC_ERROR_TIMEFRAME)) {
|
||||
dev_err(dev, "E: %s: maximum errors in URB "
|
||||
"exceeded; resetting device\n",
|
||||
__func__);
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
} else {
|
||||
dev_warn(dev, "W: %s: cannot send URB: %d\n",
|
||||
__func__, ret);
|
||||
goto retry;
|
||||
}
|
||||
}
|
||||
kfree(buffer);
|
||||
error_kzalloc:
|
||||
if (do_autopm)
|
||||
usb_autopm_put_interface(i2400mu->usb_iface);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Reset a device at different levels (warm, cold or bus)
|
||||
*
|
||||
* @i2400m: device descriptor
|
||||
* @reset_type: soft, warm or bus reset (I2400M_RT_WARM/SOFT/BUS)
|
||||
*
|
||||
* Warm and cold resets get a USB reset if they fail.
|
||||
*
|
||||
* Warm reset:
|
||||
*
|
||||
* The device will be fully reset internally, but won't be
|
||||
* disconnected from the USB bus (so no reenumeration will
|
||||
* happen). Firmware upload will be necessary.
|
||||
*
|
||||
* The device will send a reboot barker in the notification endpoint
|
||||
* that will trigger the driver to reinitialize the state
|
||||
* automatically from notif.c:i2400m_notification_grok() into
|
||||
* i2400m_dev_bootstrap_delayed().
|
||||
*
|
||||
* Cold and bus (USB) reset:
|
||||
*
|
||||
* The device will be fully reset internally, disconnected from the
|
||||
* USB bus an a reenumeration will happen. Firmware upload will be
|
||||
* necessary. Thus, we don't do any locking or struct
|
||||
* reinitialization, as we are going to be fully disconnected and
|
||||
* reenumerated.
|
||||
*
|
||||
* Note we need to return -ENODEV if a warm reset was requested and we
|
||||
* had to resort to a bus reset. See i2400m_op_reset(), wimax_reset()
|
||||
* and wimax_dev->op_reset.
|
||||
*
|
||||
* WARNING: no driver state saved/fixed
|
||||
*/
|
||||
static
|
||||
int i2400mu_bus_reset(struct i2400m *i2400m, enum i2400m_reset_type rt)
|
||||
{
|
||||
int result;
|
||||
struct i2400mu *i2400mu =
|
||||
container_of(i2400m, struct i2400mu, i2400m);
|
||||
struct device *dev = i2400m_dev(i2400m);
|
||||
static const __le32 i2400m_WARM_BOOT_BARKER[4] = {
|
||||
cpu_to_le32(I2400M_WARM_RESET_BARKER),
|
||||
cpu_to_le32(I2400M_WARM_RESET_BARKER),
|
||||
cpu_to_le32(I2400M_WARM_RESET_BARKER),
|
||||
cpu_to_le32(I2400M_WARM_RESET_BARKER),
|
||||
};
|
||||
static const __le32 i2400m_COLD_BOOT_BARKER[4] = {
|
||||
cpu_to_le32(I2400M_COLD_RESET_BARKER),
|
||||
cpu_to_le32(I2400M_COLD_RESET_BARKER),
|
||||
cpu_to_le32(I2400M_COLD_RESET_BARKER),
|
||||
cpu_to_le32(I2400M_COLD_RESET_BARKER),
|
||||
};
|
||||
|
||||
d_fnstart(3, dev, "(i2400m %p rt %u)\n", i2400m, rt);
|
||||
if (rt == I2400M_RT_WARM)
|
||||
result = __i2400mu_send_barker(
|
||||
i2400mu, i2400m_WARM_BOOT_BARKER,
|
||||
sizeof(i2400m_WARM_BOOT_BARKER),
|
||||
i2400mu->endpoint_cfg.bulk_out);
|
||||
else if (rt == I2400M_RT_COLD)
|
||||
result = __i2400mu_send_barker(
|
||||
i2400mu, i2400m_COLD_BOOT_BARKER,
|
||||
sizeof(i2400m_COLD_BOOT_BARKER),
|
||||
i2400mu->endpoint_cfg.reset_cold);
|
||||
else if (rt == I2400M_RT_BUS) {
|
||||
result = usb_reset_device(i2400mu->usb_dev);
|
||||
switch (result) {
|
||||
case 0:
|
||||
case -EINVAL: /* device is gone */
|
||||
case -ENODEV:
|
||||
case -ENOENT:
|
||||
case -ESHUTDOWN:
|
||||
result = 0;
|
||||
break; /* We assume the device is disconnected */
|
||||
default:
|
||||
dev_err(dev, "USB reset failed (%d), giving up!\n",
|
||||
result);
|
||||
}
|
||||
} else {
|
||||
result = -EINVAL; /* shut gcc up in certain arches */
|
||||
BUG();
|
||||
}
|
||||
if (result < 0
|
||||
&& result != -EINVAL /* device is gone */
|
||||
&& rt != I2400M_RT_BUS) {
|
||||
/*
|
||||
* Things failed -- resort to lower level reset, that
|
||||
* we queue in another context; the reason for this is
|
||||
* that the pre and post reset functionality requires
|
||||
* the i2400m->init_mutex; RT_WARM and RT_COLD can
|
||||
* come from areas where i2400m->init_mutex is taken.
|
||||
*/
|
||||
dev_err(dev, "%s reset failed (%d); trying USB reset\n",
|
||||
rt == I2400M_RT_WARM ? "warm" : "cold", result);
|
||||
usb_queue_reset_device(i2400mu->usb_iface);
|
||||
result = -ENODEV;
|
||||
}
|
||||
d_fnend(3, dev, "(i2400m %p rt %u) = %d\n", i2400m, rt, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
static void i2400mu_get_drvinfo(struct net_device *net_dev,
|
||||
struct ethtool_drvinfo *info)
|
||||
{
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
struct usb_device *udev = i2400mu->usb_dev;
|
||||
|
||||
strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
|
||||
strlcpy(info->fw_version, i2400m->fw_name ? : "",
|
||||
sizeof(info->fw_version));
|
||||
usb_make_path(udev, info->bus_info, sizeof(info->bus_info));
|
||||
}
|
||||
|
||||
static const struct ethtool_ops i2400mu_ethtool_ops = {
|
||||
.get_drvinfo = i2400mu_get_drvinfo,
|
||||
.get_link = ethtool_op_get_link,
|
||||
};
|
||||
|
||||
static
|
||||
void i2400mu_netdev_setup(struct net_device *net_dev)
|
||||
{
|
||||
struct i2400m *i2400m = net_dev_to_i2400m(net_dev);
|
||||
struct i2400mu *i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
i2400mu_init(i2400mu);
|
||||
i2400m_netdev_setup(net_dev);
|
||||
net_dev->ethtool_ops = &i2400mu_ethtool_ops;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Debug levels control; see debug.h
|
||||
*/
|
||||
struct d_level D_LEVEL[] = {
|
||||
D_SUBMODULE_DEFINE(usb),
|
||||
D_SUBMODULE_DEFINE(fw),
|
||||
D_SUBMODULE_DEFINE(notif),
|
||||
D_SUBMODULE_DEFINE(rx),
|
||||
D_SUBMODULE_DEFINE(tx),
|
||||
};
|
||||
size_t D_LEVEL_SIZE = ARRAY_SIZE(D_LEVEL);
|
||||
|
||||
|
||||
#define __debugfs_register(prefix, name, parent) \
|
||||
do { \
|
||||
result = d_level_register_debugfs(prefix, name, parent); \
|
||||
if (result < 0) \
|
||||
goto error; \
|
||||
} while (0)
|
||||
|
||||
|
||||
static
|
||||
int i2400mu_debugfs_add(struct i2400mu *i2400mu)
|
||||
{
|
||||
int result;
|
||||
struct device *dev = &i2400mu->usb_iface->dev;
|
||||
struct dentry *dentry = i2400mu->i2400m.wimax_dev.debugfs_dentry;
|
||||
struct dentry *fd;
|
||||
|
||||
dentry = debugfs_create_dir("i2400m-usb", dentry);
|
||||
result = PTR_ERR(dentry);
|
||||
if (IS_ERR(dentry)) {
|
||||
if (result == -ENODEV)
|
||||
result = 0; /* No debugfs support */
|
||||
goto error;
|
||||
}
|
||||
i2400mu->debugfs_dentry = dentry;
|
||||
__debugfs_register("dl_", usb, dentry);
|
||||
__debugfs_register("dl_", fw, dentry);
|
||||
__debugfs_register("dl_", notif, dentry);
|
||||
__debugfs_register("dl_", rx, dentry);
|
||||
__debugfs_register("dl_", tx, dentry);
|
||||
|
||||
/* Don't touch these if you don't know what you are doing */
|
||||
fd = debugfs_create_u8("rx_size_auto_shrink", 0600, dentry,
|
||||
&i2400mu->rx_size_auto_shrink);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"rx_size_auto_shrink: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
fd = debugfs_create_size_t("rx_size", 0600, dentry,
|
||||
&i2400mu->rx_size);
|
||||
result = PTR_ERR(fd);
|
||||
if (IS_ERR(fd) && result != -ENODEV) {
|
||||
dev_err(dev, "Can't create debugfs entry "
|
||||
"rx_size: %d\n", result);
|
||||
goto error;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
debugfs_remove_recursive(i2400mu->debugfs_dentry);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
static struct device_type i2400mu_type = {
|
||||
.name = "wimax",
|
||||
};
|
||||
|
||||
/*
|
||||
* Probe a i2400m interface and register it
|
||||
*
|
||||
* @iface: USB interface to link to
|
||||
* @id: USB class/subclass/protocol id
|
||||
* @returns: 0 if ok, < 0 errno code on error.
|
||||
*
|
||||
* Alloc a net device, initialize the bus-specific details and then
|
||||
* calls the bus-generic initialization routine. That will register
|
||||
* the wimax and netdev devices, upload the firmware [using
|
||||
* _bus_bm_*()], call _bus_dev_start() to finalize the setup of the
|
||||
* communication with the device and then will start to talk to it to
|
||||
* finnish setting it up.
|
||||
*/
|
||||
static
|
||||
int i2400mu_probe(struct usb_interface *iface,
|
||||
const struct usb_device_id *id)
|
||||
{
|
||||
int result;
|
||||
struct net_device *net_dev;
|
||||
struct device *dev = &iface->dev;
|
||||
struct i2400m *i2400m;
|
||||
struct i2400mu *i2400mu;
|
||||
struct usb_device *usb_dev = interface_to_usbdev(iface);
|
||||
|
||||
if (usb_dev->speed != USB_SPEED_HIGH)
|
||||
dev_err(dev, "device not connected as high speed\n");
|
||||
|
||||
/* Allocate instance [calls i2400m_netdev_setup() on it]. */
|
||||
result = -ENOMEM;
|
||||
net_dev = alloc_netdev(sizeof(*i2400mu), "wmx%d", NET_NAME_UNKNOWN,
|
||||
i2400mu_netdev_setup);
|
||||
if (net_dev == NULL) {
|
||||
dev_err(dev, "no memory for network device instance\n");
|
||||
goto error_alloc_netdev;
|
||||
}
|
||||
SET_NETDEV_DEV(net_dev, dev);
|
||||
SET_NETDEV_DEVTYPE(net_dev, &i2400mu_type);
|
||||
i2400m = net_dev_to_i2400m(net_dev);
|
||||
i2400mu = container_of(i2400m, struct i2400mu, i2400m);
|
||||
i2400m->wimax_dev.net_dev = net_dev;
|
||||
i2400mu->usb_dev = usb_get_dev(usb_dev);
|
||||
i2400mu->usb_iface = iface;
|
||||
usb_set_intfdata(iface, i2400mu);
|
||||
|
||||
i2400m->bus_tx_block_size = I2400MU_BLK_SIZE;
|
||||
/*
|
||||
* Room required in the Tx queue for USB message to accommodate
|
||||
* a smallest payload while allocating header space is 16 bytes.
|
||||
* Adding this room for the new tx message increases the
|
||||
* possibilities of including any payload with size <= 16 bytes.
|
||||
*/
|
||||
i2400m->bus_tx_room_min = I2400MU_BLK_SIZE;
|
||||
i2400m->bus_pl_size_max = I2400MU_PL_SIZE_MAX;
|
||||
i2400m->bus_setup = NULL;
|
||||
i2400m->bus_dev_start = i2400mu_bus_dev_start;
|
||||
i2400m->bus_dev_stop = i2400mu_bus_dev_stop;
|
||||
i2400m->bus_release = NULL;
|
||||
i2400m->bus_tx_kick = i2400mu_bus_tx_kick;
|
||||
i2400m->bus_reset = i2400mu_bus_reset;
|
||||
i2400m->bus_bm_retries = I2400M_USB_BOOT_RETRIES;
|
||||
i2400m->bus_bm_cmd_send = i2400mu_bus_bm_cmd_send;
|
||||
i2400m->bus_bm_wait_for_ack = i2400mu_bus_bm_wait_for_ack;
|
||||
i2400m->bus_bm_mac_addr_impaired = 0;
|
||||
|
||||
switch (id->idProduct) {
|
||||
case USB_DEVICE_ID_I6050:
|
||||
case USB_DEVICE_ID_I6050_2:
|
||||
case USB_DEVICE_ID_I6150:
|
||||
case USB_DEVICE_ID_I6150_2:
|
||||
case USB_DEVICE_ID_I6150_3:
|
||||
case USB_DEVICE_ID_I6250:
|
||||
i2400mu->i6050 = 1;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
if (i2400mu->i6050) {
|
||||
i2400m->bus_fw_names = i2400mu_bus_fw_names_6050;
|
||||
i2400mu->endpoint_cfg.bulk_out = 0;
|
||||
i2400mu->endpoint_cfg.notification = 3;
|
||||
i2400mu->endpoint_cfg.reset_cold = 2;
|
||||
i2400mu->endpoint_cfg.bulk_in = 1;
|
||||
} else {
|
||||
i2400m->bus_fw_names = i2400mu_bus_fw_names_5x50;
|
||||
i2400mu->endpoint_cfg.bulk_out = 0;
|
||||
i2400mu->endpoint_cfg.notification = 1;
|
||||
i2400mu->endpoint_cfg.reset_cold = 2;
|
||||
i2400mu->endpoint_cfg.bulk_in = 3;
|
||||
}
|
||||
#ifdef CONFIG_PM
|
||||
iface->needs_remote_wakeup = 1; /* autosuspend (15s delay) */
|
||||
device_init_wakeup(dev, 1);
|
||||
pm_runtime_set_autosuspend_delay(&usb_dev->dev, 15000);
|
||||
usb_enable_autosuspend(usb_dev);
|
||||
#endif
|
||||
|
||||
result = i2400m_setup(i2400m, I2400M_BRI_MAC_REINIT);
|
||||
if (result < 0) {
|
||||
dev_err(dev, "cannot setup device: %d\n", result);
|
||||
goto error_setup;
|
||||
}
|
||||
result = i2400mu_debugfs_add(i2400mu);
|
||||
if (result < 0) {
|
||||
dev_err(dev, "Can't register i2400mu's debugfs: %d\n", result);
|
||||
goto error_debugfs_add;
|
||||
}
|
||||
return 0;
|
||||
|
||||
error_debugfs_add:
|
||||
i2400m_release(i2400m);
|
||||
error_setup:
|
||||
usb_set_intfdata(iface, NULL);
|
||||
usb_put_dev(i2400mu->usb_dev);
|
||||
free_netdev(net_dev);
|
||||
error_alloc_netdev:
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Disconect a i2400m from the system.
|
||||
*
|
||||
* i2400m_stop() has been called before, so al the rx and tx contexts
|
||||
* have been taken down already. Make sure the queue is stopped,
|
||||
* unregister netdev and i2400m, free and kill.
|
||||
*/
|
||||
static
|
||||
void i2400mu_disconnect(struct usb_interface *iface)
|
||||
{
|
||||
struct i2400mu *i2400mu = usb_get_intfdata(iface);
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
struct net_device *net_dev = i2400m->wimax_dev.net_dev;
|
||||
struct device *dev = &iface->dev;
|
||||
|
||||
d_fnstart(3, dev, "(iface %p i2400m %p)\n", iface, i2400m);
|
||||
|
||||
debugfs_remove_recursive(i2400mu->debugfs_dentry);
|
||||
i2400m_release(i2400m);
|
||||
usb_set_intfdata(iface, NULL);
|
||||
usb_put_dev(i2400mu->usb_dev);
|
||||
free_netdev(net_dev);
|
||||
d_fnend(3, dev, "(iface %p i2400m %p) = void\n", iface, i2400m);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Get the device ready for USB port or system standby and hibernation
|
||||
*
|
||||
* USB port and system standby are handled the same.
|
||||
*
|
||||
* When the system hibernates, the USB device is powered down and then
|
||||
* up, so we don't really have to do much here, as it will be seen as
|
||||
* a reconnect. Still for simplicity we consider this case the same as
|
||||
* suspend, so that the device has a chance to do notify the base
|
||||
* station (if connected).
|
||||
*
|
||||
* So at the end, the three cases require common handling.
|
||||
*
|
||||
* If at the time of this call the device's firmware is not loaded,
|
||||
* nothing has to be done. Note we can be "loose" about not reading
|
||||
* i2400m->updown under i2400m->init_mutex. If it happens to change
|
||||
* inmediately, other parts of the call flow will fail and effectively
|
||||
* catch it.
|
||||
*
|
||||
* If the firmware is loaded, we need to:
|
||||
*
|
||||
* - tell the device to go into host interface power save mode, wait
|
||||
* for it to ack
|
||||
*
|
||||
* This is quite more interesting than it is; we need to execute a
|
||||
* command, but this time, we don't want the code in usb-{tx,rx}.c
|
||||
* to call the usb_autopm_get/put_interface() barriers as it'd
|
||||
* deadlock, so we need to decrement i2400mu->do_autopm, that acts
|
||||
* as a poor man's semaphore. Ugly, but it works.
|
||||
*
|
||||
* As well, the device might refuse going to sleep for whichever
|
||||
* reason. In this case we just fail. For system suspend/hibernate,
|
||||
* we *can't* fail. We check PMSG_IS_AUTO to see if the
|
||||
* suspend call comes from the USB stack or from the system and act
|
||||
* in consequence.
|
||||
*
|
||||
* - stop the notification endpoint polling
|
||||
*/
|
||||
static
|
||||
int i2400mu_suspend(struct usb_interface *iface, pm_message_t pm_msg)
|
||||
{
|
||||
int result = 0;
|
||||
struct device *dev = &iface->dev;
|
||||
struct i2400mu *i2400mu = usb_get_intfdata(iface);
|
||||
unsigned is_autosuspend = 0;
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
if (PMSG_IS_AUTO(pm_msg))
|
||||
is_autosuspend = 1;
|
||||
#endif
|
||||
|
||||
d_fnstart(3, dev, "(iface %p pm_msg %u)\n", iface, pm_msg.event);
|
||||
rmb(); /* see i2400m->updown's documentation */
|
||||
if (i2400m->updown == 0)
|
||||
goto no_firmware;
|
||||
if (i2400m->state == I2400M_SS_DATA_PATH_CONNECTED && is_autosuspend) {
|
||||
/* ugh -- the device is connected and this suspend
|
||||
* request is an autosuspend one (not a system standby
|
||||
* / hibernate).
|
||||
*
|
||||
* The only way the device can go to standby is if the
|
||||
* link with the base station is in IDLE mode; that
|
||||
* were the case, we'd be in status
|
||||
* I2400M_SS_CONNECTED_IDLE. But we are not.
|
||||
*
|
||||
* If we *tell* him to go power save now, it'll reset
|
||||
* as a precautionary measure, so if this is an
|
||||
* autosuspend thing, say no and it'll come back
|
||||
* later, when the link is IDLE
|
||||
*/
|
||||
result = -EBADF;
|
||||
d_printf(1, dev, "fw up, link up, not-idle, autosuspend: "
|
||||
"not entering powersave\n");
|
||||
goto error_not_now;
|
||||
}
|
||||
d_printf(1, dev, "fw up: entering powersave\n");
|
||||
atomic_dec(&i2400mu->do_autopm);
|
||||
result = i2400m_cmd_enter_powersave(i2400m);
|
||||
atomic_inc(&i2400mu->do_autopm);
|
||||
if (result < 0 && !is_autosuspend) {
|
||||
/* System suspend, can't fail */
|
||||
dev_err(dev, "failed to suspend, will reset on resume\n");
|
||||
result = 0;
|
||||
}
|
||||
if (result < 0)
|
||||
goto error_enter_powersave;
|
||||
i2400mu_notification_release(i2400mu);
|
||||
d_printf(1, dev, "powersave requested\n");
|
||||
error_enter_powersave:
|
||||
error_not_now:
|
||||
no_firmware:
|
||||
d_fnend(3, dev, "(iface %p pm_msg %u) = %d\n",
|
||||
iface, pm_msg.event, result);
|
||||
return result;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int i2400mu_resume(struct usb_interface *iface)
|
||||
{
|
||||
int ret = 0;
|
||||
struct device *dev = &iface->dev;
|
||||
struct i2400mu *i2400mu = usb_get_intfdata(iface);
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
|
||||
d_fnstart(3, dev, "(iface %p)\n", iface);
|
||||
rmb(); /* see i2400m->updown's documentation */
|
||||
if (i2400m->updown == 0) {
|
||||
d_printf(1, dev, "fw was down, no resume needed\n");
|
||||
goto out;
|
||||
}
|
||||
d_printf(1, dev, "fw was up, resuming\n");
|
||||
i2400mu_notification_setup(i2400mu);
|
||||
/* USB has flow control, so we don't need to give it time to
|
||||
* come back; otherwise, we'd use something like a get-state
|
||||
* command... */
|
||||
out:
|
||||
d_fnend(3, dev, "(iface %p) = %d\n", iface, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int i2400mu_reset_resume(struct usb_interface *iface)
|
||||
{
|
||||
int result;
|
||||
struct device *dev = &iface->dev;
|
||||
struct i2400mu *i2400mu = usb_get_intfdata(iface);
|
||||
struct i2400m *i2400m = &i2400mu->i2400m;
|
||||
|
||||
d_fnstart(3, dev, "(iface %p)\n", iface);
|
||||
result = i2400m_dev_reset_handle(i2400m, "device reset on resume");
|
||||
d_fnend(3, dev, "(iface %p) = %d\n", iface, result);
|
||||
return result < 0 ? result : 0;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Another driver or user space is triggering a reset on the device
|
||||
* which contains the interface passed as an argument. Cease IO and
|
||||
* save any device state you need to restore.
|
||||
*
|
||||
* If you need to allocate memory here, use GFP_NOIO or GFP_ATOMIC, if
|
||||
* you are in atomic context.
|
||||
*/
|
||||
static
|
||||
int i2400mu_pre_reset(struct usb_interface *iface)
|
||||
{
|
||||
struct i2400mu *i2400mu = usb_get_intfdata(iface);
|
||||
return i2400m_pre_reset(&i2400mu->i2400m);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* The reset has completed. Restore any saved device state and begin
|
||||
* using the device again.
|
||||
*
|
||||
* If you need to allocate memory here, use GFP_NOIO or GFP_ATOMIC, if
|
||||
* you are in atomic context.
|
||||
*/
|
||||
static
|
||||
int i2400mu_post_reset(struct usb_interface *iface)
|
||||
{
|
||||
struct i2400mu *i2400mu = usb_get_intfdata(iface);
|
||||
return i2400m_post_reset(&i2400mu->i2400m);
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
struct usb_device_id i2400mu_id_table[] = {
|
||||
{ USB_DEVICE(0x8086, USB_DEVICE_ID_I6050) },
|
||||
{ USB_DEVICE(0x8086, USB_DEVICE_ID_I6050_2) },
|
||||
{ USB_DEVICE(0x8087, USB_DEVICE_ID_I6150) },
|
||||
{ USB_DEVICE(0x8087, USB_DEVICE_ID_I6150_2) },
|
||||
{ USB_DEVICE(0x8087, USB_DEVICE_ID_I6150_3) },
|
||||
{ USB_DEVICE(0x8086, USB_DEVICE_ID_I6250) },
|
||||
{ USB_DEVICE(0x8086, 0x0181) },
|
||||
{ USB_DEVICE(0x8086, 0x1403) },
|
||||
{ USB_DEVICE(0x8086, 0x1405) },
|
||||
{ USB_DEVICE(0x8086, 0x0180) },
|
||||
{ USB_DEVICE(0x8086, 0x0182) },
|
||||
{ USB_DEVICE(0x8086, 0x1406) },
|
||||
{ USB_DEVICE(0x8086, 0x1403) },
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(usb, i2400mu_id_table);
|
||||
|
||||
|
||||
static
|
||||
struct usb_driver i2400mu_driver = {
|
||||
.name = KBUILD_MODNAME,
|
||||
.suspend = i2400mu_suspend,
|
||||
.resume = i2400mu_resume,
|
||||
.reset_resume = i2400mu_reset_resume,
|
||||
.probe = i2400mu_probe,
|
||||
.disconnect = i2400mu_disconnect,
|
||||
.pre_reset = i2400mu_pre_reset,
|
||||
.post_reset = i2400mu_post_reset,
|
||||
.id_table = i2400mu_id_table,
|
||||
.supports_autosuspend = 1,
|
||||
};
|
||||
|
||||
static
|
||||
int __init i2400mu_driver_init(void)
|
||||
{
|
||||
d_parse_params(D_LEVEL, D_LEVEL_SIZE, i2400mu_debug_params,
|
||||
"i2400m_usb.debug");
|
||||
return usb_register(&i2400mu_driver);
|
||||
}
|
||||
module_init(i2400mu_driver_init);
|
||||
|
||||
|
||||
static
|
||||
void __exit i2400mu_driver_exit(void)
|
||||
{
|
||||
usb_deregister(&i2400mu_driver);
|
||||
}
|
||||
module_exit(i2400mu_driver_exit);
|
||||
|
||||
MODULE_AUTHOR("Intel Corporation <linux-wimax@intel.com>");
|
||||
MODULE_DESCRIPTION("Driver for USB based Intel Wireless WiMAX Connection 2400M "
|
||||
"(5x50 & 6050)");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_FIRMWARE(I2400MU_FW_FILE_NAME_v1_5);
|
||||
MODULE_FIRMWARE(I6050U_FW_FILE_NAME_v1_5);
|
Loading…
Add table
Add a link
Reference in a new issue