mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-27 03:20:56 +07:00
dfa31fef5d
usb_wait_anchor_empty_timeout's @timeout wants milliseconds and not jiffies. Signed-off-by: Christian Lamparter <chunkeey@googlemail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
1152 lines
24 KiB
C
1152 lines
24 KiB
C
/*
|
|
* Atheros CARL9170 driver
|
|
*
|
|
* USB - frontend
|
|
*
|
|
* Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
|
|
* Copyright 2009, 2010, Christian Lamparter <chunkeey@googlemail.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; see the file COPYING. If not, see
|
|
* http://www.gnu.org/licenses/.
|
|
*
|
|
* This file incorporates work covered by the following copyright and
|
|
* permission notice:
|
|
* Copyright (c) 2007-2008 Atheros Communications, Inc.
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/usb.h>
|
|
#include <linux/firmware.h>
|
|
#include <linux/etherdevice.h>
|
|
#include <linux/device.h>
|
|
#include <net/mac80211.h>
|
|
#include "carl9170.h"
|
|
#include "cmd.h"
|
|
#include "hw.h"
|
|
#include "fwcmd.h"
|
|
|
|
MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>");
|
|
MODULE_AUTHOR("Christian Lamparter <chunkeey@googlemail.com>");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("Atheros AR9170 802.11n USB wireless");
|
|
MODULE_FIRMWARE(CARL9170FW_NAME);
|
|
MODULE_ALIAS("ar9170usb");
|
|
MODULE_ALIAS("arusb_lnx");
|
|
|
|
/*
|
|
* Note:
|
|
*
|
|
* Always update our wiki's device list (located at:
|
|
* http://wireless.kernel.org/en/users/Drivers/ar9170/devices ),
|
|
* whenever you add a new device.
|
|
*/
|
|
static struct usb_device_id carl9170_usb_ids[] = {
|
|
/* Atheros 9170 */
|
|
{ USB_DEVICE(0x0cf3, 0x9170) },
|
|
/* Atheros TG121N */
|
|
{ USB_DEVICE(0x0cf3, 0x1001) },
|
|
/* TP-Link TL-WN821N v2 */
|
|
{ USB_DEVICE(0x0cf3, 0x1002), .driver_info = CARL9170_WPS_BUTTON |
|
|
CARL9170_ONE_LED },
|
|
/* 3Com Dual Band 802.11n USB Adapter */
|
|
{ USB_DEVICE(0x0cf3, 0x1010) },
|
|
/* H3C Dual Band 802.11n USB Adapter */
|
|
{ USB_DEVICE(0x0cf3, 0x1011) },
|
|
/* Cace Airpcap NX */
|
|
{ USB_DEVICE(0xcace, 0x0300) },
|
|
/* D-Link DWA 160 A1 */
|
|
{ USB_DEVICE(0x07d1, 0x3c10) },
|
|
/* D-Link DWA 160 A2 */
|
|
{ USB_DEVICE(0x07d1, 0x3a09) },
|
|
/* D-Link DWA 130 D */
|
|
{ USB_DEVICE(0x07d1, 0x3a0f) },
|
|
/* Netgear WNA1000 */
|
|
{ USB_DEVICE(0x0846, 0x9040) },
|
|
/* Netgear WNDA3100 (v1) */
|
|
{ USB_DEVICE(0x0846, 0x9010) },
|
|
/* Netgear WN111 v2 */
|
|
{ USB_DEVICE(0x0846, 0x9001), .driver_info = CARL9170_ONE_LED },
|
|
/* Zydas ZD1221 */
|
|
{ USB_DEVICE(0x0ace, 0x1221) },
|
|
/* Proxim ORiNOCO 802.11n USB */
|
|
{ USB_DEVICE(0x1435, 0x0804) },
|
|
/* WNC Generic 11n USB Dongle */
|
|
{ USB_DEVICE(0x1435, 0x0326) },
|
|
/* ZyXEL NWD271N */
|
|
{ USB_DEVICE(0x0586, 0x3417) },
|
|
/* Z-Com UB81 BG */
|
|
{ USB_DEVICE(0x0cde, 0x0023) },
|
|
/* Z-Com UB82 ABG */
|
|
{ USB_DEVICE(0x0cde, 0x0026) },
|
|
/* Sphairon Homelink 1202 */
|
|
{ USB_DEVICE(0x0cde, 0x0027) },
|
|
/* Arcadyan WN7512 */
|
|
{ USB_DEVICE(0x083a, 0xf522) },
|
|
/* Planex GWUS300 */
|
|
{ USB_DEVICE(0x2019, 0x5304) },
|
|
/* IO-Data WNGDNUS2 */
|
|
{ USB_DEVICE(0x04bb, 0x093f) },
|
|
/* NEC WL300NU-G */
|
|
{ USB_DEVICE(0x0409, 0x0249) },
|
|
/* AVM FRITZ!WLAN USB Stick N */
|
|
{ USB_DEVICE(0x057c, 0x8401) },
|
|
/* AVM FRITZ!WLAN USB Stick N 2.4 */
|
|
{ USB_DEVICE(0x057c, 0x8402) },
|
|
/* Qwest/Actiontec 802AIN Wireless N USB Network Adapter */
|
|
{ USB_DEVICE(0x1668, 0x1200) },
|
|
|
|
/* terminate */
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(usb, carl9170_usb_ids);
|
|
|
|
static void carl9170_usb_submit_data_urb(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb;
|
|
int err;
|
|
|
|
if (atomic_inc_return(&ar->tx_anch_urbs) > AR9170_NUM_TX_URBS)
|
|
goto err_acc;
|
|
|
|
urb = usb_get_from_anchor(&ar->tx_wait);
|
|
if (!urb)
|
|
goto err_acc;
|
|
|
|
usb_anchor_urb(urb, &ar->tx_anch);
|
|
|
|
err = usb_submit_urb(urb, GFP_ATOMIC);
|
|
if (unlikely(err)) {
|
|
if (net_ratelimit()) {
|
|
dev_err(&ar->udev->dev, "tx submit failed (%d)\n",
|
|
urb->status);
|
|
}
|
|
|
|
usb_unanchor_urb(urb);
|
|
usb_anchor_urb(urb, &ar->tx_err);
|
|
}
|
|
|
|
usb_free_urb(urb);
|
|
|
|
if (likely(err == 0))
|
|
return;
|
|
|
|
err_acc:
|
|
atomic_dec(&ar->tx_anch_urbs);
|
|
}
|
|
|
|
static void carl9170_usb_tx_data_complete(struct urb *urb)
|
|
{
|
|
struct ar9170 *ar = (struct ar9170 *)
|
|
usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0));
|
|
|
|
if (WARN_ON_ONCE(!ar)) {
|
|
dev_kfree_skb_irq(urb->context);
|
|
return;
|
|
}
|
|
|
|
atomic_dec(&ar->tx_anch_urbs);
|
|
|
|
switch (urb->status) {
|
|
/* everything is fine */
|
|
case 0:
|
|
carl9170_tx_callback(ar, (void *)urb->context);
|
|
break;
|
|
|
|
/* disconnect */
|
|
case -ENOENT:
|
|
case -ECONNRESET:
|
|
case -ENODEV:
|
|
case -ESHUTDOWN:
|
|
/*
|
|
* Defer the frame clean-up to the tasklet worker.
|
|
* This is necessary, because carl9170_tx_drop
|
|
* does not work in an irqsave context.
|
|
*/
|
|
usb_anchor_urb(urb, &ar->tx_err);
|
|
return;
|
|
|
|
/* a random transmission error has occurred? */
|
|
default:
|
|
if (net_ratelimit()) {
|
|
dev_err(&ar->udev->dev, "tx failed (%d)\n",
|
|
urb->status);
|
|
}
|
|
|
|
usb_anchor_urb(urb, &ar->tx_err);
|
|
break;
|
|
}
|
|
|
|
if (likely(IS_STARTED(ar)))
|
|
carl9170_usb_submit_data_urb(ar);
|
|
}
|
|
|
|
static int carl9170_usb_submit_cmd_urb(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb;
|
|
int err;
|
|
|
|
if (atomic_inc_return(&ar->tx_cmd_urbs) != 1) {
|
|
atomic_dec(&ar->tx_cmd_urbs);
|
|
return 0;
|
|
}
|
|
|
|
urb = usb_get_from_anchor(&ar->tx_cmd);
|
|
if (!urb) {
|
|
atomic_dec(&ar->tx_cmd_urbs);
|
|
return 0;
|
|
}
|
|
|
|
usb_anchor_urb(urb, &ar->tx_anch);
|
|
err = usb_submit_urb(urb, GFP_ATOMIC);
|
|
if (unlikely(err)) {
|
|
usb_unanchor_urb(urb);
|
|
atomic_dec(&ar->tx_cmd_urbs);
|
|
}
|
|
usb_free_urb(urb);
|
|
|
|
return err;
|
|
}
|
|
|
|
static void carl9170_usb_cmd_complete(struct urb *urb)
|
|
{
|
|
struct ar9170 *ar = urb->context;
|
|
int err = 0;
|
|
|
|
if (WARN_ON_ONCE(!ar))
|
|
return;
|
|
|
|
atomic_dec(&ar->tx_cmd_urbs);
|
|
|
|
switch (urb->status) {
|
|
/* everything is fine */
|
|
case 0:
|
|
break;
|
|
|
|
/* disconnect */
|
|
case -ENOENT:
|
|
case -ECONNRESET:
|
|
case -ENODEV:
|
|
case -ESHUTDOWN:
|
|
return;
|
|
|
|
default:
|
|
err = urb->status;
|
|
break;
|
|
}
|
|
|
|
if (!IS_INITIALIZED(ar))
|
|
return;
|
|
|
|
if (err)
|
|
dev_err(&ar->udev->dev, "submit cmd cb failed (%d).\n", err);
|
|
|
|
err = carl9170_usb_submit_cmd_urb(ar);
|
|
if (err)
|
|
dev_err(&ar->udev->dev, "submit cmd failed (%d).\n", err);
|
|
}
|
|
|
|
static void carl9170_usb_rx_irq_complete(struct urb *urb)
|
|
{
|
|
struct ar9170 *ar = urb->context;
|
|
|
|
if (WARN_ON_ONCE(!ar))
|
|
return;
|
|
|
|
switch (urb->status) {
|
|
/* everything is fine */
|
|
case 0:
|
|
break;
|
|
|
|
/* disconnect */
|
|
case -ENOENT:
|
|
case -ECONNRESET:
|
|
case -ENODEV:
|
|
case -ESHUTDOWN:
|
|
return;
|
|
|
|
default:
|
|
goto resubmit;
|
|
}
|
|
|
|
carl9170_handle_command_response(ar, urb->transfer_buffer,
|
|
urb->actual_length);
|
|
|
|
resubmit:
|
|
usb_anchor_urb(urb, &ar->rx_anch);
|
|
if (unlikely(usb_submit_urb(urb, GFP_ATOMIC)))
|
|
usb_unanchor_urb(urb);
|
|
}
|
|
|
|
static int carl9170_usb_submit_rx_urb(struct ar9170 *ar, gfp_t gfp)
|
|
{
|
|
struct urb *urb;
|
|
int err = 0, runs = 0;
|
|
|
|
while ((atomic_read(&ar->rx_anch_urbs) < AR9170_NUM_RX_URBS) &&
|
|
(runs++ < AR9170_NUM_RX_URBS)) {
|
|
err = -ENOSPC;
|
|
urb = usb_get_from_anchor(&ar->rx_pool);
|
|
if (urb) {
|
|
usb_anchor_urb(urb, &ar->rx_anch);
|
|
err = usb_submit_urb(urb, gfp);
|
|
if (unlikely(err)) {
|
|
usb_unanchor_urb(urb);
|
|
usb_anchor_urb(urb, &ar->rx_pool);
|
|
} else {
|
|
atomic_dec(&ar->rx_pool_urbs);
|
|
atomic_inc(&ar->rx_anch_urbs);
|
|
}
|
|
usb_free_urb(urb);
|
|
}
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static void carl9170_usb_rx_work(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb;
|
|
int i;
|
|
|
|
for (i = 0; i < AR9170_NUM_RX_URBS_POOL; i++) {
|
|
urb = usb_get_from_anchor(&ar->rx_work);
|
|
if (!urb)
|
|
break;
|
|
|
|
atomic_dec(&ar->rx_work_urbs);
|
|
if (IS_INITIALIZED(ar)) {
|
|
carl9170_rx(ar, urb->transfer_buffer,
|
|
urb->actual_length);
|
|
}
|
|
|
|
usb_anchor_urb(urb, &ar->rx_pool);
|
|
atomic_inc(&ar->rx_pool_urbs);
|
|
|
|
usb_free_urb(urb);
|
|
|
|
carl9170_usb_submit_rx_urb(ar, GFP_ATOMIC);
|
|
}
|
|
}
|
|
|
|
void carl9170_usb_handle_tx_err(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb;
|
|
|
|
while ((urb = usb_get_from_anchor(&ar->tx_err))) {
|
|
struct sk_buff *skb = (void *)urb->context;
|
|
|
|
carl9170_tx_drop(ar, skb);
|
|
carl9170_tx_callback(ar, skb);
|
|
usb_free_urb(urb);
|
|
}
|
|
}
|
|
|
|
static void carl9170_usb_tasklet(unsigned long data)
|
|
{
|
|
struct ar9170 *ar = (struct ar9170 *) data;
|
|
|
|
if (!IS_INITIALIZED(ar))
|
|
return;
|
|
|
|
carl9170_usb_rx_work(ar);
|
|
|
|
/*
|
|
* Strictly speaking: The tx scheduler is not part of the USB system.
|
|
* But the rx worker returns frames back to the mac80211-stack and
|
|
* this is the _perfect_ place to generate the next transmissions.
|
|
*/
|
|
if (IS_STARTED(ar))
|
|
carl9170_tx_scheduler(ar);
|
|
}
|
|
|
|
static void carl9170_usb_rx_complete(struct urb *urb)
|
|
{
|
|
struct ar9170 *ar = (struct ar9170 *)urb->context;
|
|
int err;
|
|
|
|
if (WARN_ON_ONCE(!ar))
|
|
return;
|
|
|
|
atomic_dec(&ar->rx_anch_urbs);
|
|
|
|
switch (urb->status) {
|
|
case 0:
|
|
/* rx path */
|
|
usb_anchor_urb(urb, &ar->rx_work);
|
|
atomic_inc(&ar->rx_work_urbs);
|
|
break;
|
|
|
|
case -ENOENT:
|
|
case -ECONNRESET:
|
|
case -ENODEV:
|
|
case -ESHUTDOWN:
|
|
/* handle disconnect events*/
|
|
return;
|
|
|
|
default:
|
|
/* handle all other errors */
|
|
usb_anchor_urb(urb, &ar->rx_pool);
|
|
atomic_inc(&ar->rx_pool_urbs);
|
|
break;
|
|
}
|
|
|
|
err = carl9170_usb_submit_rx_urb(ar, GFP_ATOMIC);
|
|
if (unlikely(err)) {
|
|
/*
|
|
* usb_submit_rx_urb reported a problem.
|
|
* In case this is due to a rx buffer shortage,
|
|
* elevate the tasklet worker priority to
|
|
* the highest available level.
|
|
*/
|
|
tasklet_hi_schedule(&ar->usb_tasklet);
|
|
|
|
if (atomic_read(&ar->rx_anch_urbs) == 0) {
|
|
/*
|
|
* The system is too slow to cope with
|
|
* the enormous workload. We have simply
|
|
* run out of active rx urbs and this
|
|
* unfortunatly leads to an unpredictable
|
|
* device.
|
|
*/
|
|
|
|
carl9170_restart(ar, CARL9170_RR_SLOW_SYSTEM);
|
|
}
|
|
} else {
|
|
/*
|
|
* Using anything less than _high_ priority absolutely
|
|
* kills the rx performance my UP-System...
|
|
*/
|
|
tasklet_hi_schedule(&ar->usb_tasklet);
|
|
}
|
|
}
|
|
|
|
static struct urb *carl9170_usb_alloc_rx_urb(struct ar9170 *ar, gfp_t gfp)
|
|
{
|
|
struct urb *urb;
|
|
void *buf;
|
|
|
|
buf = kmalloc(ar->fw.rx_size, gfp);
|
|
if (!buf)
|
|
return NULL;
|
|
|
|
urb = usb_alloc_urb(0, gfp);
|
|
if (!urb) {
|
|
kfree(buf);
|
|
return NULL;
|
|
}
|
|
|
|
usb_fill_bulk_urb(urb, ar->udev, usb_rcvbulkpipe(ar->udev,
|
|
AR9170_USB_EP_RX), buf, ar->fw.rx_size,
|
|
carl9170_usb_rx_complete, ar);
|
|
|
|
urb->transfer_flags |= URB_FREE_BUFFER;
|
|
|
|
return urb;
|
|
}
|
|
|
|
static int carl9170_usb_send_rx_irq_urb(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb = NULL;
|
|
void *ibuf;
|
|
int err = -ENOMEM;
|
|
|
|
urb = usb_alloc_urb(0, GFP_KERNEL);
|
|
if (!urb)
|
|
goto out;
|
|
|
|
ibuf = kmalloc(AR9170_USB_EP_CTRL_MAX, GFP_KERNEL);
|
|
if (!ibuf)
|
|
goto out;
|
|
|
|
usb_fill_int_urb(urb, ar->udev, usb_rcvintpipe(ar->udev,
|
|
AR9170_USB_EP_IRQ), ibuf, AR9170_USB_EP_CTRL_MAX,
|
|
carl9170_usb_rx_irq_complete, ar, 1);
|
|
|
|
urb->transfer_flags |= URB_FREE_BUFFER;
|
|
|
|
usb_anchor_urb(urb, &ar->rx_anch);
|
|
err = usb_submit_urb(urb, GFP_KERNEL);
|
|
if (err)
|
|
usb_unanchor_urb(urb);
|
|
|
|
out:
|
|
usb_free_urb(urb);
|
|
return err;
|
|
}
|
|
|
|
static int carl9170_usb_init_rx_bulk_urbs(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb;
|
|
int i, err = -EINVAL;
|
|
|
|
/*
|
|
* The driver actively maintains a second shadow
|
|
* pool for inactive, but fully-prepared rx urbs.
|
|
*
|
|
* The pool should help the driver to master huge
|
|
* workload spikes without running the risk of
|
|
* undersupplying the hardware or wasting time by
|
|
* processing rx data (streams) inside the urb
|
|
* completion (hardirq context).
|
|
*/
|
|
for (i = 0; i < AR9170_NUM_RX_URBS_POOL; i++) {
|
|
urb = carl9170_usb_alloc_rx_urb(ar, GFP_KERNEL);
|
|
if (!urb) {
|
|
err = -ENOMEM;
|
|
goto err_out;
|
|
}
|
|
|
|
usb_anchor_urb(urb, &ar->rx_pool);
|
|
atomic_inc(&ar->rx_pool_urbs);
|
|
usb_free_urb(urb);
|
|
}
|
|
|
|
err = carl9170_usb_submit_rx_urb(ar, GFP_KERNEL);
|
|
if (err)
|
|
goto err_out;
|
|
|
|
/* the device now waiting for the firmware. */
|
|
carl9170_set_state_when(ar, CARL9170_STOPPED, CARL9170_IDLE);
|
|
return 0;
|
|
|
|
err_out:
|
|
|
|
usb_scuttle_anchored_urbs(&ar->rx_pool);
|
|
usb_scuttle_anchored_urbs(&ar->rx_work);
|
|
usb_kill_anchored_urbs(&ar->rx_anch);
|
|
return err;
|
|
}
|
|
|
|
static int carl9170_usb_flush(struct ar9170 *ar)
|
|
{
|
|
struct urb *urb;
|
|
int ret, err = 0;
|
|
|
|
while ((urb = usb_get_from_anchor(&ar->tx_wait))) {
|
|
struct sk_buff *skb = (void *)urb->context;
|
|
carl9170_tx_drop(ar, skb);
|
|
carl9170_tx_callback(ar, skb);
|
|
usb_free_urb(urb);
|
|
}
|
|
|
|
ret = usb_wait_anchor_empty_timeout(&ar->tx_cmd, 1000);
|
|
if (ret == 0)
|
|
err = -ETIMEDOUT;
|
|
|
|
/* lets wait a while until the tx - queues are dried out */
|
|
ret = usb_wait_anchor_empty_timeout(&ar->tx_anch, 1000);
|
|
if (ret == 0)
|
|
err = -ETIMEDOUT;
|
|
|
|
usb_kill_anchored_urbs(&ar->tx_anch);
|
|
carl9170_usb_handle_tx_err(ar);
|
|
|
|
return err;
|
|
}
|
|
|
|
static void carl9170_usb_cancel_urbs(struct ar9170 *ar)
|
|
{
|
|
int err;
|
|
|
|
carl9170_set_state(ar, CARL9170_UNKNOWN_STATE);
|
|
|
|
err = carl9170_usb_flush(ar);
|
|
if (err)
|
|
dev_err(&ar->udev->dev, "stuck tx urbs!\n");
|
|
|
|
usb_poison_anchored_urbs(&ar->tx_anch);
|
|
carl9170_usb_handle_tx_err(ar);
|
|
usb_poison_anchored_urbs(&ar->rx_anch);
|
|
|
|
tasklet_kill(&ar->usb_tasklet);
|
|
|
|
usb_scuttle_anchored_urbs(&ar->rx_work);
|
|
usb_scuttle_anchored_urbs(&ar->rx_pool);
|
|
usb_scuttle_anchored_urbs(&ar->tx_cmd);
|
|
}
|
|
|
|
int __carl9170_exec_cmd(struct ar9170 *ar, struct carl9170_cmd *cmd,
|
|
const bool free_buf)
|
|
{
|
|
struct urb *urb;
|
|
int err = 0;
|
|
|
|
if (!IS_INITIALIZED(ar)) {
|
|
err = -EPERM;
|
|
goto err_free;
|
|
}
|
|
|
|
if (WARN_ON(cmd->hdr.len > CARL9170_MAX_CMD_LEN - 4)) {
|
|
err = -EINVAL;
|
|
goto err_free;
|
|
}
|
|
|
|
urb = usb_alloc_urb(0, GFP_ATOMIC);
|
|
if (!urb) {
|
|
err = -ENOMEM;
|
|
goto err_free;
|
|
}
|
|
|
|
usb_fill_int_urb(urb, ar->udev, usb_sndintpipe(ar->udev,
|
|
AR9170_USB_EP_CMD), cmd, cmd->hdr.len + 4,
|
|
carl9170_usb_cmd_complete, ar, 1);
|
|
|
|
if (free_buf)
|
|
urb->transfer_flags |= URB_FREE_BUFFER;
|
|
|
|
usb_anchor_urb(urb, &ar->tx_cmd);
|
|
usb_free_urb(urb);
|
|
|
|
return carl9170_usb_submit_cmd_urb(ar);
|
|
|
|
err_free:
|
|
if (free_buf)
|
|
kfree(cmd);
|
|
|
|
return err;
|
|
}
|
|
|
|
int carl9170_exec_cmd(struct ar9170 *ar, const enum carl9170_cmd_oids cmd,
|
|
unsigned int plen, void *payload, unsigned int outlen, void *out)
|
|
{
|
|
int err = -ENOMEM;
|
|
|
|
if (!IS_ACCEPTING_CMD(ar))
|
|
return -EIO;
|
|
|
|
if (!(cmd & CARL9170_CMD_ASYNC_FLAG))
|
|
might_sleep();
|
|
|
|
ar->cmd.hdr.len = plen;
|
|
ar->cmd.hdr.cmd = cmd;
|
|
/* writing multiple regs fills this buffer already */
|
|
if (plen && payload != (u8 *)(ar->cmd.data))
|
|
memcpy(ar->cmd.data, payload, plen);
|
|
|
|
spin_lock_bh(&ar->cmd_lock);
|
|
ar->readbuf = (u8 *)out;
|
|
ar->readlen = outlen;
|
|
spin_unlock_bh(&ar->cmd_lock);
|
|
|
|
err = __carl9170_exec_cmd(ar, &ar->cmd, false);
|
|
|
|
if (!(cmd & CARL9170_CMD_ASYNC_FLAG)) {
|
|
err = wait_for_completion_timeout(&ar->cmd_wait, HZ);
|
|
if (err == 0) {
|
|
err = -ETIMEDOUT;
|
|
goto err_unbuf;
|
|
}
|
|
|
|
if (ar->readlen != outlen) {
|
|
err = -EMSGSIZE;
|
|
goto err_unbuf;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_unbuf:
|
|
/* Maybe the device was removed in the moment we were waiting? */
|
|
if (IS_STARTED(ar)) {
|
|
dev_err(&ar->udev->dev, "no command feedback "
|
|
"received (%d).\n", err);
|
|
|
|
/* provide some maybe useful debug information */
|
|
print_hex_dump_bytes("carl9170 cmd: ", DUMP_PREFIX_NONE,
|
|
&ar->cmd, plen + 4);
|
|
|
|
carl9170_restart(ar, CARL9170_RR_COMMAND_TIMEOUT);
|
|
}
|
|
|
|
/* invalidate to avoid completing the next command prematurely */
|
|
spin_lock_bh(&ar->cmd_lock);
|
|
ar->readbuf = NULL;
|
|
ar->readlen = 0;
|
|
spin_unlock_bh(&ar->cmd_lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
void carl9170_usb_tx(struct ar9170 *ar, struct sk_buff *skb)
|
|
{
|
|
struct urb *urb;
|
|
struct ar9170_stream *tx_stream;
|
|
void *data;
|
|
unsigned int len;
|
|
|
|
if (!IS_STARTED(ar))
|
|
goto err_drop;
|
|
|
|
urb = usb_alloc_urb(0, GFP_ATOMIC);
|
|
if (!urb)
|
|
goto err_drop;
|
|
|
|
if (ar->fw.tx_stream) {
|
|
tx_stream = (void *) (skb->data - sizeof(*tx_stream));
|
|
|
|
len = skb->len + sizeof(*tx_stream);
|
|
tx_stream->length = cpu_to_le16(len);
|
|
tx_stream->tag = cpu_to_le16(AR9170_TX_STREAM_TAG);
|
|
data = tx_stream;
|
|
} else {
|
|
data = skb->data;
|
|
len = skb->len;
|
|
}
|
|
|
|
usb_fill_bulk_urb(urb, ar->udev, usb_sndbulkpipe(ar->udev,
|
|
AR9170_USB_EP_TX), data, len,
|
|
carl9170_usb_tx_data_complete, skb);
|
|
|
|
urb->transfer_flags |= URB_ZERO_PACKET;
|
|
|
|
usb_anchor_urb(urb, &ar->tx_wait);
|
|
|
|
usb_free_urb(urb);
|
|
|
|
carl9170_usb_submit_data_urb(ar);
|
|
return;
|
|
|
|
err_drop:
|
|
carl9170_tx_drop(ar, skb);
|
|
carl9170_tx_callback(ar, skb);
|
|
}
|
|
|
|
static void carl9170_release_firmware(struct ar9170 *ar)
|
|
{
|
|
if (ar->fw.fw) {
|
|
release_firmware(ar->fw.fw);
|
|
memset(&ar->fw, 0, sizeof(ar->fw));
|
|
}
|
|
}
|
|
|
|
void carl9170_usb_stop(struct ar9170 *ar)
|
|
{
|
|
int ret;
|
|
|
|
carl9170_set_state_when(ar, CARL9170_IDLE, CARL9170_STOPPED);
|
|
|
|
ret = carl9170_usb_flush(ar);
|
|
if (ret)
|
|
dev_err(&ar->udev->dev, "kill pending tx urbs.\n");
|
|
|
|
usb_poison_anchored_urbs(&ar->tx_anch);
|
|
carl9170_usb_handle_tx_err(ar);
|
|
|
|
/* kill any pending command */
|
|
spin_lock_bh(&ar->cmd_lock);
|
|
ar->readlen = 0;
|
|
spin_unlock_bh(&ar->cmd_lock);
|
|
complete_all(&ar->cmd_wait);
|
|
|
|
/* This is required to prevent an early completion on _start */
|
|
INIT_COMPLETION(ar->cmd_wait);
|
|
|
|
/*
|
|
* Note:
|
|
* So far we freed all tx urbs, but we won't dare to touch any rx urbs.
|
|
* Else we would end up with a unresponsive device...
|
|
*/
|
|
}
|
|
|
|
int carl9170_usb_open(struct ar9170 *ar)
|
|
{
|
|
usb_unpoison_anchored_urbs(&ar->tx_anch);
|
|
|
|
carl9170_set_state_when(ar, CARL9170_STOPPED, CARL9170_IDLE);
|
|
return 0;
|
|
}
|
|
|
|
static int carl9170_usb_load_firmware(struct ar9170 *ar)
|
|
{
|
|
const u8 *data;
|
|
u8 *buf;
|
|
unsigned int transfer;
|
|
size_t len;
|
|
u32 addr;
|
|
int err = 0;
|
|
|
|
buf = kmalloc(4096, GFP_KERNEL);
|
|
if (!buf) {
|
|
err = -ENOMEM;
|
|
goto err_out;
|
|
}
|
|
|
|
data = ar->fw.fw->data;
|
|
len = ar->fw.fw->size;
|
|
addr = ar->fw.address;
|
|
|
|
/* this removes the miniboot image */
|
|
data += ar->fw.offset;
|
|
len -= ar->fw.offset;
|
|
|
|
while (len) {
|
|
transfer = min_t(unsigned int, len, 4096u);
|
|
memcpy(buf, data, transfer);
|
|
|
|
err = usb_control_msg(ar->udev, usb_sndctrlpipe(ar->udev, 0),
|
|
0x30 /* FW DL */, 0x40 | USB_DIR_OUT,
|
|
addr >> 8, 0, buf, transfer, 100);
|
|
|
|
if (err < 0) {
|
|
kfree(buf);
|
|
goto err_out;
|
|
}
|
|
|
|
len -= transfer;
|
|
data += transfer;
|
|
addr += transfer;
|
|
}
|
|
kfree(buf);
|
|
|
|
err = usb_control_msg(ar->udev, usb_sndctrlpipe(ar->udev, 0),
|
|
0x31 /* FW DL COMPLETE */,
|
|
0x40 | USB_DIR_OUT, 0, 0, NULL, 0, 200);
|
|
|
|
if (wait_for_completion_timeout(&ar->fw_boot_wait, HZ) == 0) {
|
|
err = -ETIMEDOUT;
|
|
goto err_out;
|
|
}
|
|
|
|
err = carl9170_echo_test(ar, 0x4a110123);
|
|
if (err)
|
|
goto err_out;
|
|
|
|
/* firmware restarts cmd counter */
|
|
ar->cmd_seq = -1;
|
|
|
|
return 0;
|
|
|
|
err_out:
|
|
dev_err(&ar->udev->dev, "firmware upload failed (%d).\n", err);
|
|
return err;
|
|
}
|
|
|
|
int carl9170_usb_restart(struct ar9170 *ar)
|
|
{
|
|
int err = 0;
|
|
|
|
if (ar->intf->condition != USB_INTERFACE_BOUND)
|
|
return 0;
|
|
|
|
/* Disable command response sequence counter. */
|
|
ar->cmd_seq = -2;
|
|
|
|
err = carl9170_reboot(ar);
|
|
|
|
carl9170_usb_stop(ar);
|
|
|
|
if (err)
|
|
goto err_out;
|
|
|
|
tasklet_schedule(&ar->usb_tasklet);
|
|
|
|
/* The reboot procedure can take quite a while to complete. */
|
|
msleep(1100);
|
|
|
|
err = carl9170_usb_open(ar);
|
|
if (err)
|
|
goto err_out;
|
|
|
|
err = carl9170_usb_load_firmware(ar);
|
|
if (err)
|
|
goto err_out;
|
|
|
|
return 0;
|
|
|
|
err_out:
|
|
carl9170_usb_cancel_urbs(ar);
|
|
return err;
|
|
}
|
|
|
|
void carl9170_usb_reset(struct ar9170 *ar)
|
|
{
|
|
/*
|
|
* This is the last resort to get the device going again
|
|
* without any *user replugging action*.
|
|
*
|
|
* But there is a catch: usb_reset really is like a physical
|
|
* *reconnect*. The mac80211 state will be lost in the process.
|
|
* Therefore a userspace application, which is monitoring
|
|
* the link must step in.
|
|
*/
|
|
carl9170_usb_cancel_urbs(ar);
|
|
|
|
carl9170_usb_stop(ar);
|
|
|
|
usb_queue_reset_device(ar->intf);
|
|
}
|
|
|
|
static int carl9170_usb_init_device(struct ar9170 *ar)
|
|
{
|
|
int err;
|
|
|
|
err = carl9170_usb_send_rx_irq_urb(ar);
|
|
if (err)
|
|
goto err_out;
|
|
|
|
err = carl9170_usb_init_rx_bulk_urbs(ar);
|
|
if (err)
|
|
goto err_unrx;
|
|
|
|
mutex_lock(&ar->mutex);
|
|
err = carl9170_usb_load_firmware(ar);
|
|
mutex_unlock(&ar->mutex);
|
|
if (err)
|
|
goto err_unrx;
|
|
|
|
return 0;
|
|
|
|
err_unrx:
|
|
carl9170_usb_cancel_urbs(ar);
|
|
|
|
err_out:
|
|
return err;
|
|
}
|
|
|
|
static void carl9170_usb_firmware_failed(struct ar9170 *ar)
|
|
{
|
|
struct device *parent = ar->udev->dev.parent;
|
|
struct usb_device *udev;
|
|
|
|
/*
|
|
* Store a copy of the usb_device pointer locally.
|
|
* This is because device_release_driver initiates
|
|
* carl9170_usb_disconnect, which in turn frees our
|
|
* driver context (ar).
|
|
*/
|
|
udev = ar->udev;
|
|
|
|
complete(&ar->fw_load_wait);
|
|
|
|
/* unbind anything failed */
|
|
if (parent)
|
|
device_lock(parent);
|
|
|
|
device_release_driver(&udev->dev);
|
|
if (parent)
|
|
device_unlock(parent);
|
|
|
|
usb_put_dev(udev);
|
|
}
|
|
|
|
static void carl9170_usb_firmware_finish(struct ar9170 *ar)
|
|
{
|
|
int err;
|
|
|
|
err = carl9170_parse_firmware(ar);
|
|
if (err)
|
|
goto err_freefw;
|
|
|
|
err = carl9170_usb_init_device(ar);
|
|
if (err)
|
|
goto err_freefw;
|
|
|
|
err = carl9170_usb_open(ar);
|
|
if (err)
|
|
goto err_unrx;
|
|
|
|
err = carl9170_register(ar);
|
|
|
|
carl9170_usb_stop(ar);
|
|
if (err)
|
|
goto err_unrx;
|
|
|
|
complete(&ar->fw_load_wait);
|
|
usb_put_dev(ar->udev);
|
|
return;
|
|
|
|
err_unrx:
|
|
carl9170_usb_cancel_urbs(ar);
|
|
|
|
err_freefw:
|
|
carl9170_release_firmware(ar);
|
|
carl9170_usb_firmware_failed(ar);
|
|
}
|
|
|
|
static void carl9170_usb_firmware_step2(const struct firmware *fw,
|
|
void *context)
|
|
{
|
|
struct ar9170 *ar = context;
|
|
|
|
if (fw) {
|
|
ar->fw.fw = fw;
|
|
carl9170_usb_firmware_finish(ar);
|
|
return;
|
|
}
|
|
|
|
dev_err(&ar->udev->dev, "firmware not found.\n");
|
|
carl9170_usb_firmware_failed(ar);
|
|
}
|
|
|
|
static int carl9170_usb_probe(struct usb_interface *intf,
|
|
const struct usb_device_id *id)
|
|
{
|
|
struct ar9170 *ar;
|
|
struct usb_device *udev;
|
|
int err;
|
|
|
|
err = usb_reset_device(interface_to_usbdev(intf));
|
|
if (err)
|
|
return err;
|
|
|
|
ar = carl9170_alloc(sizeof(*ar));
|
|
if (IS_ERR(ar))
|
|
return PTR_ERR(ar);
|
|
|
|
udev = interface_to_usbdev(intf);
|
|
usb_get_dev(udev);
|
|
ar->udev = udev;
|
|
ar->intf = intf;
|
|
ar->features = id->driver_info;
|
|
|
|
usb_set_intfdata(intf, ar);
|
|
SET_IEEE80211_DEV(ar->hw, &intf->dev);
|
|
|
|
init_usb_anchor(&ar->rx_anch);
|
|
init_usb_anchor(&ar->rx_pool);
|
|
init_usb_anchor(&ar->rx_work);
|
|
init_usb_anchor(&ar->tx_wait);
|
|
init_usb_anchor(&ar->tx_anch);
|
|
init_usb_anchor(&ar->tx_cmd);
|
|
init_usb_anchor(&ar->tx_err);
|
|
init_completion(&ar->cmd_wait);
|
|
init_completion(&ar->fw_boot_wait);
|
|
init_completion(&ar->fw_load_wait);
|
|
tasklet_init(&ar->usb_tasklet, carl9170_usb_tasklet,
|
|
(unsigned long)ar);
|
|
|
|
atomic_set(&ar->tx_cmd_urbs, 0);
|
|
atomic_set(&ar->tx_anch_urbs, 0);
|
|
atomic_set(&ar->rx_work_urbs, 0);
|
|
atomic_set(&ar->rx_anch_urbs, 0);
|
|
atomic_set(&ar->rx_pool_urbs, 0);
|
|
ar->cmd_seq = -2;
|
|
|
|
usb_get_dev(ar->udev);
|
|
|
|
carl9170_set_state(ar, CARL9170_STOPPED);
|
|
|
|
return request_firmware_nowait(THIS_MODULE, 1, CARL9170FW_NAME,
|
|
&ar->udev->dev, GFP_KERNEL, ar, carl9170_usb_firmware_step2);
|
|
}
|
|
|
|
static void carl9170_usb_disconnect(struct usb_interface *intf)
|
|
{
|
|
struct ar9170 *ar = usb_get_intfdata(intf);
|
|
struct usb_device *udev;
|
|
|
|
if (WARN_ON(!ar))
|
|
return;
|
|
|
|
udev = ar->udev;
|
|
wait_for_completion(&ar->fw_load_wait);
|
|
|
|
if (IS_INITIALIZED(ar)) {
|
|
carl9170_reboot(ar);
|
|
carl9170_usb_stop(ar);
|
|
}
|
|
|
|
carl9170_usb_cancel_urbs(ar);
|
|
carl9170_unregister(ar);
|
|
|
|
usb_set_intfdata(intf, NULL);
|
|
|
|
carl9170_release_firmware(ar);
|
|
carl9170_free(ar);
|
|
usb_put_dev(udev);
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int carl9170_usb_suspend(struct usb_interface *intf,
|
|
pm_message_t message)
|
|
{
|
|
struct ar9170 *ar = usb_get_intfdata(intf);
|
|
|
|
if (!ar)
|
|
return -ENODEV;
|
|
|
|
carl9170_usb_cancel_urbs(ar);
|
|
|
|
/*
|
|
* firmware automatically reboots for usb suspend.
|
|
*/
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int carl9170_usb_resume(struct usb_interface *intf)
|
|
{
|
|
struct ar9170 *ar = usb_get_intfdata(intf);
|
|
int err;
|
|
|
|
if (!ar)
|
|
return -ENODEV;
|
|
|
|
usb_unpoison_anchored_urbs(&ar->rx_anch);
|
|
|
|
err = carl9170_usb_init_device(ar);
|
|
if (err)
|
|
goto err_unrx;
|
|
|
|
err = carl9170_usb_open(ar);
|
|
if (err)
|
|
goto err_unrx;
|
|
|
|
return 0;
|
|
|
|
err_unrx:
|
|
carl9170_usb_cancel_urbs(ar);
|
|
|
|
return err;
|
|
}
|
|
#endif /* CONFIG_PM */
|
|
|
|
static struct usb_driver carl9170_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.probe = carl9170_usb_probe,
|
|
.disconnect = carl9170_usb_disconnect,
|
|
.id_table = carl9170_usb_ids,
|
|
.soft_unbind = 1,
|
|
#ifdef CONFIG_PM
|
|
.suspend = carl9170_usb_suspend,
|
|
.resume = carl9170_usb_resume,
|
|
#endif /* CONFIG_PM */
|
|
};
|
|
|
|
static int __init carl9170_usb_init(void)
|
|
{
|
|
return usb_register(&carl9170_driver);
|
|
}
|
|
|
|
static void __exit carl9170_usb_exit(void)
|
|
{
|
|
usb_deregister(&carl9170_driver);
|
|
}
|
|
|
|
module_init(carl9170_usb_init);
|
|
module_exit(carl9170_usb_exit);
|