2589 lines
72 KiB
C
2589 lines
72 KiB
C
|
/* typhoon.c: A Linux Ethernet device driver for 3Com 3CR990 family of NICs */
|
||
|
/*
|
||
|
Written 2002-2004 by David Dillow <dave@thedillows.org>
|
||
|
Based on code written 1998-2000 by Donald Becker <becker@scyld.com> and
|
||
|
Linux 2.2.x driver by David P. McLean <davidpmclean@yahoo.com>.
|
||
|
|
||
|
This software may be used and distributed according to the terms of
|
||
|
the GNU General Public License (GPL), incorporated herein by reference.
|
||
|
Drivers based on or derived from this code fall under the GPL and must
|
||
|
retain the authorship, copyright and license notice. This file is not
|
||
|
a complete program and may only be used when the entire operating
|
||
|
system is licensed under the GPL.
|
||
|
|
||
|
This software is available on a public web site. It may enable
|
||
|
cryptographic capabilities of the 3Com hardware, and may be
|
||
|
exported from the United States under License Exception "TSU"
|
||
|
pursuant to 15 C.F.R. Section 740.13(e).
|
||
|
|
||
|
This work was funded by the National Library of Medicine under
|
||
|
the Department of Energy project number 0274DD06D1 and NLM project
|
||
|
number Y1-LM-2015-01.
|
||
|
|
||
|
This driver is designed for the 3Com 3CR990 Family of cards with the
|
||
|
3XP Processor. It has been tested on x86 and sparc64.
|
||
|
|
||
|
KNOWN ISSUES:
|
||
|
*) Cannot DMA Rx packets to a 2 byte aligned address. Also firmware
|
||
|
issue. Hopefully 3Com will fix it.
|
||
|
*) Waiting for a command response takes 8ms due to non-preemptable
|
||
|
polling. Only significant for getting stats and creating
|
||
|
SAs, but an ugly wart never the less.
|
||
|
|
||
|
TODO:
|
||
|
*) Doesn't do IPSEC offloading. Yet. Keep yer pants on, it's coming.
|
||
|
*) Add more support for ethtool (especially for NIC stats)
|
||
|
*) Allow disabling of RX checksum offloading
|
||
|
*) Fix MAC changing to work while the interface is up
|
||
|
(Need to put commands on the TX ring, which changes
|
||
|
the locking)
|
||
|
*) Add in FCS to {rx,tx}_bytes, since the hardware doesn't. See
|
||
|
http://oss.sgi.com/cgi-bin/mesg.cgi?a=netdev&i=20031215152211.7003fe8e.rddunlap%40osdl.org
|
||
|
*/
|
||
|
|
||
|
/* Set the copy breakpoint for the copy-only-tiny-frames scheme.
|
||
|
* Setting to > 1518 effectively disables this feature.
|
||
|
*/
|
||
|
static int rx_copybreak = 200;
|
||
|
|
||
|
/* Should we use MMIO or Port IO?
|
||
|
* 0: Port IO
|
||
|
* 1: MMIO
|
||
|
* 2: Try MMIO, fallback to Port IO
|
||
|
*/
|
||
|
static unsigned int use_mmio = 2;
|
||
|
|
||
|
/* end user-configurable values */
|
||
|
|
||
|
/* Maximum number of multicast addresses to filter (vs. rx-all-multicast).
|
||
|
*/
|
||
|
static const int multicast_filter_limit = 32;
|
||
|
|
||
|
/* Operational parameters that are set at compile time. */
|
||
|
|
||
|
/* Keep the ring sizes a power of two for compile efficiency.
|
||
|
* The compiler will convert <unsigned>'%'<2^N> into a bit mask.
|
||
|
* Making the Tx ring too large decreases the effectiveness of channel
|
||
|
* bonding and packet priority.
|
||
|
* There are no ill effects from too-large receive rings.
|
||
|
*
|
||
|
* We don't currently use the Hi Tx ring so, don't make it very big.
|
||
|
*
|
||
|
* Beware that if we start using the Hi Tx ring, we will need to change
|
||
|
* typhoon_num_free_tx() and typhoon_tx_complete() to account for that.
|
||
|
*/
|
||
|
#define TXHI_ENTRIES 2
|
||
|
#define TXLO_ENTRIES 128
|
||
|
#define RX_ENTRIES 32
|
||
|
#define COMMAND_ENTRIES 16
|
||
|
#define RESPONSE_ENTRIES 32
|
||
|
|
||
|
#define COMMAND_RING_SIZE (COMMAND_ENTRIES * sizeof(struct cmd_desc))
|
||
|
#define RESPONSE_RING_SIZE (RESPONSE_ENTRIES * sizeof(struct resp_desc))
|
||
|
|
||
|
/* The 3XP will preload and remove 64 entries from the free buffer
|
||
|
* list, and we need one entry to keep the ring from wrapping, so
|
||
|
* to keep this a power of two, we use 128 entries.
|
||
|
*/
|
||
|
#define RXFREE_ENTRIES 128
|
||
|
#define RXENT_ENTRIES (RXFREE_ENTRIES - 1)
|
||
|
|
||
|
/* Operational parameters that usually are not changed. */
|
||
|
|
||
|
/* Time in jiffies before concluding the transmitter is hung. */
|
||
|
#define TX_TIMEOUT (2*HZ)
|
||
|
|
||
|
#define PKT_BUF_SZ 1536
|
||
|
#define FIRMWARE_NAME "3com/typhoon.bin"
|
||
|
|
||
|
#define pr_fmt(fmt) KBUILD_MODNAME " " fmt
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/sched.h>
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/timer.h>
|
||
|
#include <linux/errno.h>
|
||
|
#include <linux/ioport.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/netdevice.h>
|
||
|
#include <linux/etherdevice.h>
|
||
|
#include <linux/skbuff.h>
|
||
|
#include <linux/mm.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/ethtool.h>
|
||
|
#include <linux/if_vlan.h>
|
||
|
#include <linux/crc32.h>
|
||
|
#include <linux/bitops.h>
|
||
|
#include <asm/processor.h>
|
||
|
#include <asm/io.h>
|
||
|
#include <linux/uaccess.h>
|
||
|
#include <linux/in6.h>
|
||
|
#include <linux/dma-mapping.h>
|
||
|
#include <linux/firmware.h>
|
||
|
|
||
|
#include "typhoon.h"
|
||
|
|
||
|
MODULE_AUTHOR("David Dillow <dave@thedillows.org>");
|
||
|
MODULE_LICENSE("GPL");
|
||
|
MODULE_FIRMWARE(FIRMWARE_NAME);
|
||
|
MODULE_DESCRIPTION("3Com Typhoon Family (3C990, 3CR990, and variants)");
|
||
|
MODULE_PARM_DESC(rx_copybreak, "Packets smaller than this are copied and "
|
||
|
"the buffer given back to the NIC. Default "
|
||
|
"is 200.");
|
||
|
MODULE_PARM_DESC(use_mmio, "Use MMIO (1) or PIO(0) to access the NIC. "
|
||
|
"Default is to try MMIO and fallback to PIO.");
|
||
|
module_param(rx_copybreak, int, 0);
|
||
|
module_param(use_mmio, int, 0);
|
||
|
|
||
|
#if TXLO_ENTRIES <= (2 * MAX_SKB_FRAGS)
|
||
|
#error TX ring too small!
|
||
|
#endif
|
||
|
|
||
|
struct typhoon_card_info {
|
||
|
const char *name;
|
||
|
const int capabilities;
|
||
|
};
|
||
|
|
||
|
#define TYPHOON_CRYPTO_NONE 0x00
|
||
|
#define TYPHOON_CRYPTO_DES 0x01
|
||
|
#define TYPHOON_CRYPTO_3DES 0x02
|
||
|
#define TYPHOON_CRYPTO_VARIABLE 0x04
|
||
|
#define TYPHOON_FIBER 0x08
|
||
|
#define TYPHOON_WAKEUP_NEEDS_RESET 0x10
|
||
|
|
||
|
enum typhoon_cards {
|
||
|
TYPHOON_TX = 0, TYPHOON_TX95, TYPHOON_TX97, TYPHOON_SVR,
|
||
|
TYPHOON_SVR95, TYPHOON_SVR97, TYPHOON_TXM, TYPHOON_BSVR,
|
||
|
TYPHOON_FX95, TYPHOON_FX97, TYPHOON_FX95SVR, TYPHOON_FX97SVR,
|
||
|
TYPHOON_FXM,
|
||
|
};
|
||
|
|
||
|
/* directly indexed by enum typhoon_cards, above */
|
||
|
static struct typhoon_card_info typhoon_card_info[] = {
|
||
|
{ "3Com Typhoon (3C990-TX)",
|
||
|
TYPHOON_CRYPTO_NONE},
|
||
|
{ "3Com Typhoon (3CR990-TX-95)",
|
||
|
TYPHOON_CRYPTO_DES},
|
||
|
{ "3Com Typhoon (3CR990-TX-97)",
|
||
|
TYPHOON_CRYPTO_DES | TYPHOON_CRYPTO_3DES},
|
||
|
{ "3Com Typhoon (3C990SVR)",
|
||
|
TYPHOON_CRYPTO_NONE},
|
||
|
{ "3Com Typhoon (3CR990SVR95)",
|
||
|
TYPHOON_CRYPTO_DES},
|
||
|
{ "3Com Typhoon (3CR990SVR97)",
|
||
|
TYPHOON_CRYPTO_DES | TYPHOON_CRYPTO_3DES},
|
||
|
{ "3Com Typhoon2 (3C990B-TX-M)",
|
||
|
TYPHOON_CRYPTO_VARIABLE},
|
||
|
{ "3Com Typhoon2 (3C990BSVR)",
|
||
|
TYPHOON_CRYPTO_VARIABLE},
|
||
|
{ "3Com Typhoon (3CR990-FX-95)",
|
||
|
TYPHOON_CRYPTO_DES | TYPHOON_FIBER},
|
||
|
{ "3Com Typhoon (3CR990-FX-97)",
|
||
|
TYPHOON_CRYPTO_DES | TYPHOON_CRYPTO_3DES | TYPHOON_FIBER},
|
||
|
{ "3Com Typhoon (3CR990-FX-95 Server)",
|
||
|
TYPHOON_CRYPTO_DES | TYPHOON_FIBER},
|
||
|
{ "3Com Typhoon (3CR990-FX-97 Server)",
|
||
|
TYPHOON_CRYPTO_DES | TYPHOON_CRYPTO_3DES | TYPHOON_FIBER},
|
||
|
{ "3Com Typhoon2 (3C990B-FX-97)",
|
||
|
TYPHOON_CRYPTO_VARIABLE | TYPHOON_FIBER},
|
||
|
};
|
||
|
|
||
|
/* Notes on the new subsystem numbering scheme:
|
||
|
* bits 0-1 indicate crypto capabilities: (0) variable, (1) DES, or (2) 3DES
|
||
|
* bit 4 indicates if this card has secured firmware (we don't support it)
|
||
|
* bit 8 indicates if this is a (0) copper or (1) fiber card
|
||
|
* bits 12-16 indicate card type: (0) client and (1) server
|
||
|
*/
|
||
|
static const struct pci_device_id typhoon_pci_tbl[] = {
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990,
|
||
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0,TYPHOON_TX },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990_TX_95,
|
||
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPHOON_TX95 },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990_TX_97,
|
||
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPHOON_TX97 },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990B,
|
||
|
PCI_ANY_ID, 0x1000, 0, 0, TYPHOON_TXM },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990B,
|
||
|
PCI_ANY_ID, 0x1102, 0, 0, TYPHOON_FXM },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990B,
|
||
|
PCI_ANY_ID, 0x2000, 0, 0, TYPHOON_BSVR },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990_FX,
|
||
|
PCI_ANY_ID, 0x1101, 0, 0, TYPHOON_FX95 },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990_FX,
|
||
|
PCI_ANY_ID, 0x1102, 0, 0, TYPHOON_FX97 },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990_FX,
|
||
|
PCI_ANY_ID, 0x2101, 0, 0, TYPHOON_FX95SVR },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990_FX,
|
||
|
PCI_ANY_ID, 0x2102, 0, 0, TYPHOON_FX97SVR },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990SVR95,
|
||
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPHOON_SVR95 },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990SVR97,
|
||
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPHOON_SVR97 },
|
||
|
{ PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3CR990SVR,
|
||
|
PCI_ANY_ID, PCI_ANY_ID, 0, 0, TYPHOON_SVR },
|
||
|
{ 0, }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(pci, typhoon_pci_tbl);
|
||
|
|
||
|
/* Define the shared memory area
|
||
|
* Align everything the 3XP will normally be using.
|
||
|
* We'll need to move/align txHi if we start using that ring.
|
||
|
*/
|
||
|
#define __3xp_aligned ____cacheline_aligned
|
||
|
struct typhoon_shared {
|
||
|
struct typhoon_interface iface;
|
||
|
struct typhoon_indexes indexes __3xp_aligned;
|
||
|
struct tx_desc txLo[TXLO_ENTRIES] __3xp_aligned;
|
||
|
struct rx_desc rxLo[RX_ENTRIES] __3xp_aligned;
|
||
|
struct rx_desc rxHi[RX_ENTRIES] __3xp_aligned;
|
||
|
struct cmd_desc cmd[COMMAND_ENTRIES] __3xp_aligned;
|
||
|
struct resp_desc resp[RESPONSE_ENTRIES] __3xp_aligned;
|
||
|
struct rx_free rxBuff[RXFREE_ENTRIES] __3xp_aligned;
|
||
|
u32 zeroWord;
|
||
|
struct tx_desc txHi[TXHI_ENTRIES];
|
||
|
} __packed;
|
||
|
|
||
|
struct rxbuff_ent {
|
||
|
struct sk_buff *skb;
|
||
|
dma_addr_t dma_addr;
|
||
|
};
|
||
|
|
||
|
struct typhoon {
|
||
|
/* Tx cache line section */
|
||
|
struct transmit_ring txLoRing ____cacheline_aligned;
|
||
|
struct pci_dev * tx_pdev;
|
||
|
void __iomem *tx_ioaddr;
|
||
|
u32 txlo_dma_addr;
|
||
|
|
||
|
/* Irq/Rx cache line section */
|
||
|
void __iomem *ioaddr ____cacheline_aligned;
|
||
|
struct typhoon_indexes *indexes;
|
||
|
u8 awaiting_resp;
|
||
|
u8 duplex;
|
||
|
u8 speed;
|
||
|
u8 card_state;
|
||
|
struct basic_ring rxLoRing;
|
||
|
struct pci_dev * pdev;
|
||
|
struct net_device * dev;
|
||
|
struct napi_struct napi;
|
||
|
struct basic_ring rxHiRing;
|
||
|
struct basic_ring rxBuffRing;
|
||
|
struct rxbuff_ent rxbuffers[RXENT_ENTRIES];
|
||
|
|
||
|
/* general section */
|
||
|
spinlock_t command_lock ____cacheline_aligned;
|
||
|
struct basic_ring cmdRing;
|
||
|
struct basic_ring respRing;
|
||
|
struct net_device_stats stats_saved;
|
||
|
struct typhoon_shared * shared;
|
||
|
dma_addr_t shared_dma;
|
||
|
__le16 xcvr_select;
|
||
|
__le16 wol_events;
|
||
|
__le32 offload;
|
||
|
|
||
|
/* unused stuff (future use) */
|
||
|
int capabilities;
|
||
|
struct transmit_ring txHiRing;
|
||
|
};
|
||
|
|
||
|
enum completion_wait_values {
|
||
|
NoWait = 0, WaitNoSleep, WaitSleep,
|
||
|
};
|
||
|
|
||
|
/* These are the values for the typhoon.card_state variable.
|
||
|
* These determine where the statistics will come from in get_stats().
|
||
|
* The sleep image does not support the statistics we need.
|
||
|
*/
|
||
|
enum state_values {
|
||
|
Sleeping = 0, Running,
|
||
|
};
|
||
|
|
||
|
/* PCI writes are not guaranteed to be posted in order, but outstanding writes
|
||
|
* cannot pass a read, so this forces current writes to post.
|
||
|
*/
|
||
|
#define typhoon_post_pci_writes(x) \
|
||
|
do { if (likely(use_mmio)) ioread32(x+TYPHOON_REG_HEARTBEAT); } while (0)
|
||
|
|
||
|
/* We'll wait up to six seconds for a reset, and half a second normally.
|
||
|
*/
|
||
|
#define TYPHOON_UDELAY 50
|
||
|
#define TYPHOON_RESET_TIMEOUT_SLEEP (6 * HZ)
|
||
|
#define TYPHOON_RESET_TIMEOUT_NOSLEEP ((6 * 1000000) / TYPHOON_UDELAY)
|
||
|
#define TYPHOON_WAIT_TIMEOUT ((1000000 / 2) / TYPHOON_UDELAY)
|
||
|
|
||
|
#if defined(NETIF_F_TSO)
|
||
|
#define skb_tso_size(x) (skb_shinfo(x)->gso_size)
|
||
|
#define TSO_NUM_DESCRIPTORS 2
|
||
|
#define TSO_OFFLOAD_ON TYPHOON_OFFLOAD_TCP_SEGMENT
|
||
|
#else
|
||
|
#define NETIF_F_TSO 0
|
||
|
#define skb_tso_size(x) 0
|
||
|
#define TSO_NUM_DESCRIPTORS 0
|
||
|
#define TSO_OFFLOAD_ON 0
|
||
|
#endif
|
||
|
|
||
|
static inline void
|
||
|
typhoon_inc_index(u32 *index, const int count, const int num_entries)
|
||
|
{
|
||
|
/* Increment a ring index -- we can use this for all rings execept
|
||
|
* the Rx rings, as they use different size descriptors
|
||
|
* otherwise, everything is the same size as a cmd_desc
|
||
|
*/
|
||
|
*index += count * sizeof(struct cmd_desc);
|
||
|
*index %= num_entries * sizeof(struct cmd_desc);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_inc_cmd_index(u32 *index, const int count)
|
||
|
{
|
||
|
typhoon_inc_index(index, count, COMMAND_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_inc_resp_index(u32 *index, const int count)
|
||
|
{
|
||
|
typhoon_inc_index(index, count, RESPONSE_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_inc_rxfree_index(u32 *index, const int count)
|
||
|
{
|
||
|
typhoon_inc_index(index, count, RXFREE_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_inc_tx_index(u32 *index, const int count)
|
||
|
{
|
||
|
/* if we start using the Hi Tx ring, this needs updating */
|
||
|
typhoon_inc_index(index, count, TXLO_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_inc_rx_index(u32 *index, const int count)
|
||
|
{
|
||
|
/* sizeof(struct rx_desc) != sizeof(struct cmd_desc) */
|
||
|
*index += count * sizeof(struct rx_desc);
|
||
|
*index %= RX_ENTRIES * sizeof(struct rx_desc);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_reset(void __iomem *ioaddr, int wait_type)
|
||
|
{
|
||
|
int i, err = 0;
|
||
|
int timeout;
|
||
|
|
||
|
if (wait_type == WaitNoSleep)
|
||
|
timeout = TYPHOON_RESET_TIMEOUT_NOSLEEP;
|
||
|
else
|
||
|
timeout = TYPHOON_RESET_TIMEOUT_SLEEP;
|
||
|
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
|
||
|
iowrite32(TYPHOON_RESET_ALL, ioaddr + TYPHOON_REG_SOFT_RESET);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
udelay(1);
|
||
|
iowrite32(TYPHOON_RESET_NONE, ioaddr + TYPHOON_REG_SOFT_RESET);
|
||
|
|
||
|
if (wait_type != NoWait) {
|
||
|
for (i = 0; i < timeout; i++) {
|
||
|
if (ioread32(ioaddr + TYPHOON_REG_STATUS) ==
|
||
|
TYPHOON_STATUS_WAITING_FOR_HOST)
|
||
|
goto out;
|
||
|
|
||
|
if (wait_type == WaitSleep)
|
||
|
schedule_timeout_uninterruptible(1);
|
||
|
else
|
||
|
udelay(TYPHOON_UDELAY);
|
||
|
}
|
||
|
|
||
|
err = -ETIMEDOUT;
|
||
|
}
|
||
|
|
||
|
out:
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
|
||
|
/* The 3XP seems to need a little extra time to complete the load
|
||
|
* of the sleep image before we can reliably boot it. Failure to
|
||
|
* do this occasionally results in a hung adapter after boot in
|
||
|
* typhoon_init_one() while trying to read the MAC address or
|
||
|
* putting the card to sleep. 3Com's driver waits 5ms, but
|
||
|
* that seems to be overkill. However, if we can sleep, we might
|
||
|
* as well give it that much time. Otherwise, we'll give it 500us,
|
||
|
* which should be enough (I've see it work well at 100us, but still
|
||
|
* saw occasional problems.)
|
||
|
*/
|
||
|
if (wait_type == WaitSleep)
|
||
|
msleep(5);
|
||
|
else
|
||
|
udelay(500);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_wait_status(void __iomem *ioaddr, u32 wait_value)
|
||
|
{
|
||
|
int i, err = 0;
|
||
|
|
||
|
for (i = 0; i < TYPHOON_WAIT_TIMEOUT; i++) {
|
||
|
if (ioread32(ioaddr + TYPHOON_REG_STATUS) == wait_value)
|
||
|
goto out;
|
||
|
udelay(TYPHOON_UDELAY);
|
||
|
}
|
||
|
|
||
|
err = -ETIMEDOUT;
|
||
|
|
||
|
out:
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_media_status(struct net_device *dev, struct resp_desc *resp)
|
||
|
{
|
||
|
if (resp->parm1 & TYPHOON_MEDIA_STAT_NO_LINK)
|
||
|
netif_carrier_off(dev);
|
||
|
else
|
||
|
netif_carrier_on(dev);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_hello(struct typhoon *tp)
|
||
|
{
|
||
|
struct basic_ring *ring = &tp->cmdRing;
|
||
|
struct cmd_desc *cmd;
|
||
|
|
||
|
/* We only get a hello request if we've not sent anything to the
|
||
|
* card in a long while. If the lock is held, then we're in the
|
||
|
* process of issuing a command, so we don't need to respond.
|
||
|
*/
|
||
|
if (spin_trylock(&tp->command_lock)) {
|
||
|
cmd = (struct cmd_desc *)(ring->ringBase + ring->lastWrite);
|
||
|
typhoon_inc_cmd_index(&ring->lastWrite, 1);
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(cmd, TYPHOON_CMD_HELLO_RESP);
|
||
|
wmb();
|
||
|
iowrite32(ring->lastWrite, tp->ioaddr + TYPHOON_REG_CMD_READY);
|
||
|
spin_unlock(&tp->command_lock);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_process_response(struct typhoon *tp, int resp_size,
|
||
|
struct resp_desc *resp_save)
|
||
|
{
|
||
|
struct typhoon_indexes *indexes = tp->indexes;
|
||
|
struct resp_desc *resp;
|
||
|
u8 *base = tp->respRing.ringBase;
|
||
|
int count, len, wrap_len;
|
||
|
u32 cleared;
|
||
|
u32 ready;
|
||
|
|
||
|
cleared = le32_to_cpu(indexes->respCleared);
|
||
|
ready = le32_to_cpu(indexes->respReady);
|
||
|
while (cleared != ready) {
|
||
|
resp = (struct resp_desc *)(base + cleared);
|
||
|
count = resp->numDesc + 1;
|
||
|
if (resp_save && resp->seqNo) {
|
||
|
if (count > resp_size) {
|
||
|
resp_save->flags = TYPHOON_RESP_ERROR;
|
||
|
goto cleanup;
|
||
|
}
|
||
|
|
||
|
wrap_len = 0;
|
||
|
len = count * sizeof(*resp);
|
||
|
if (unlikely(cleared + len > RESPONSE_RING_SIZE)) {
|
||
|
wrap_len = cleared + len - RESPONSE_RING_SIZE;
|
||
|
len = RESPONSE_RING_SIZE - cleared;
|
||
|
}
|
||
|
|
||
|
memcpy(resp_save, resp, len);
|
||
|
if (unlikely(wrap_len)) {
|
||
|
resp_save += len / sizeof(*resp);
|
||
|
memcpy(resp_save, base, wrap_len);
|
||
|
}
|
||
|
|
||
|
resp_save = NULL;
|
||
|
} else if (resp->cmd == TYPHOON_CMD_READ_MEDIA_STATUS) {
|
||
|
typhoon_media_status(tp->dev, resp);
|
||
|
} else if (resp->cmd == TYPHOON_CMD_HELLO_RESP) {
|
||
|
typhoon_hello(tp);
|
||
|
} else {
|
||
|
netdev_err(tp->dev,
|
||
|
"dumping unexpected response 0x%04x:%d:0x%02x:0x%04x:%08x:%08x\n",
|
||
|
le16_to_cpu(resp->cmd),
|
||
|
resp->numDesc, resp->flags,
|
||
|
le16_to_cpu(resp->parm1),
|
||
|
le32_to_cpu(resp->parm2),
|
||
|
le32_to_cpu(resp->parm3));
|
||
|
}
|
||
|
|
||
|
cleanup:
|
||
|
typhoon_inc_resp_index(&cleared, count);
|
||
|
}
|
||
|
|
||
|
indexes->respCleared = cpu_to_le32(cleared);
|
||
|
wmb();
|
||
|
return resp_save == NULL;
|
||
|
}
|
||
|
|
||
|
static inline int
|
||
|
typhoon_num_free(int lastWrite, int lastRead, int ringSize)
|
||
|
{
|
||
|
/* this works for all descriptors but rx_desc, as they are a
|
||
|
* different size than the cmd_desc -- everyone else is the same
|
||
|
*/
|
||
|
lastWrite /= sizeof(struct cmd_desc);
|
||
|
lastRead /= sizeof(struct cmd_desc);
|
||
|
return (ringSize + lastRead - lastWrite - 1) % ringSize;
|
||
|
}
|
||
|
|
||
|
static inline int
|
||
|
typhoon_num_free_cmd(struct typhoon *tp)
|
||
|
{
|
||
|
int lastWrite = tp->cmdRing.lastWrite;
|
||
|
int cmdCleared = le32_to_cpu(tp->indexes->cmdCleared);
|
||
|
|
||
|
return typhoon_num_free(lastWrite, cmdCleared, COMMAND_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static inline int
|
||
|
typhoon_num_free_resp(struct typhoon *tp)
|
||
|
{
|
||
|
int respReady = le32_to_cpu(tp->indexes->respReady);
|
||
|
int respCleared = le32_to_cpu(tp->indexes->respCleared);
|
||
|
|
||
|
return typhoon_num_free(respReady, respCleared, RESPONSE_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static inline int
|
||
|
typhoon_num_free_tx(struct transmit_ring *ring)
|
||
|
{
|
||
|
/* if we start using the Hi Tx ring, this needs updating */
|
||
|
return typhoon_num_free(ring->lastWrite, ring->lastRead, TXLO_ENTRIES);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_issue_command(struct typhoon *tp, int num_cmd, struct cmd_desc *cmd,
|
||
|
int num_resp, struct resp_desc *resp)
|
||
|
{
|
||
|
struct typhoon_indexes *indexes = tp->indexes;
|
||
|
struct basic_ring *ring = &tp->cmdRing;
|
||
|
struct resp_desc local_resp;
|
||
|
int i, err = 0;
|
||
|
int got_resp;
|
||
|
int freeCmd, freeResp;
|
||
|
int len, wrap_len;
|
||
|
|
||
|
spin_lock(&tp->command_lock);
|
||
|
|
||
|
freeCmd = typhoon_num_free_cmd(tp);
|
||
|
freeResp = typhoon_num_free_resp(tp);
|
||
|
|
||
|
if (freeCmd < num_cmd || freeResp < num_resp) {
|
||
|
netdev_err(tp->dev, "no descs for cmd, had (needed) %d (%d) cmd, %d (%d) resp\n",
|
||
|
freeCmd, num_cmd, freeResp, num_resp);
|
||
|
err = -ENOMEM;
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (cmd->flags & TYPHOON_CMD_RESPOND) {
|
||
|
/* If we're expecting a response, but the caller hasn't given
|
||
|
* us a place to put it, we'll provide one.
|
||
|
*/
|
||
|
tp->awaiting_resp = 1;
|
||
|
if (resp == NULL) {
|
||
|
resp = &local_resp;
|
||
|
num_resp = 1;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
wrap_len = 0;
|
||
|
len = num_cmd * sizeof(*cmd);
|
||
|
if (unlikely(ring->lastWrite + len > COMMAND_RING_SIZE)) {
|
||
|
wrap_len = ring->lastWrite + len - COMMAND_RING_SIZE;
|
||
|
len = COMMAND_RING_SIZE - ring->lastWrite;
|
||
|
}
|
||
|
|
||
|
memcpy(ring->ringBase + ring->lastWrite, cmd, len);
|
||
|
if (unlikely(wrap_len)) {
|
||
|
struct cmd_desc *wrap_ptr = cmd;
|
||
|
wrap_ptr += len / sizeof(*cmd);
|
||
|
memcpy(ring->ringBase, wrap_ptr, wrap_len);
|
||
|
}
|
||
|
|
||
|
typhoon_inc_cmd_index(&ring->lastWrite, num_cmd);
|
||
|
|
||
|
/* "I feel a presence... another warrior is on the mesa."
|
||
|
*/
|
||
|
wmb();
|
||
|
iowrite32(ring->lastWrite, tp->ioaddr + TYPHOON_REG_CMD_READY);
|
||
|
typhoon_post_pci_writes(tp->ioaddr);
|
||
|
|
||
|
if ((cmd->flags & TYPHOON_CMD_RESPOND) == 0)
|
||
|
goto out;
|
||
|
|
||
|
/* Ugh. We'll be here about 8ms, spinning our thumbs, unable to
|
||
|
* preempt or do anything other than take interrupts. So, don't
|
||
|
* wait for a response unless you have to.
|
||
|
*
|
||
|
* I've thought about trying to sleep here, but we're called
|
||
|
* from many contexts that don't allow that. Also, given the way
|
||
|
* 3Com has implemented irq coalescing, we would likely timeout --
|
||
|
* this has been observed in real life!
|
||
|
*
|
||
|
* The big killer is we have to wait to get stats from the card,
|
||
|
* though we could go to a periodic refresh of those if we don't
|
||
|
* mind them getting somewhat stale. The rest of the waiting
|
||
|
* commands occur during open/close/suspend/resume, so they aren't
|
||
|
* time critical. Creating SAs in the future will also have to
|
||
|
* wait here.
|
||
|
*/
|
||
|
got_resp = 0;
|
||
|
for (i = 0; i < TYPHOON_WAIT_TIMEOUT && !got_resp; i++) {
|
||
|
if (indexes->respCleared != indexes->respReady)
|
||
|
got_resp = typhoon_process_response(tp, num_resp,
|
||
|
resp);
|
||
|
udelay(TYPHOON_UDELAY);
|
||
|
}
|
||
|
|
||
|
if (!got_resp) {
|
||
|
err = -ETIMEDOUT;
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
/* Collect the error response even if we don't care about the
|
||
|
* rest of the response
|
||
|
*/
|
||
|
if (resp->flags & TYPHOON_RESP_ERROR)
|
||
|
err = -EIO;
|
||
|
|
||
|
out:
|
||
|
if (tp->awaiting_resp) {
|
||
|
tp->awaiting_resp = 0;
|
||
|
smp_wmb();
|
||
|
|
||
|
/* Ugh. If a response was added to the ring between
|
||
|
* the call to typhoon_process_response() and the clearing
|
||
|
* of tp->awaiting_resp, we could have missed the interrupt
|
||
|
* and it could hang in the ring an indeterminate amount of
|
||
|
* time. So, check for it, and interrupt ourselves if this
|
||
|
* is the case.
|
||
|
*/
|
||
|
if (indexes->respCleared != indexes->respReady)
|
||
|
iowrite32(1, tp->ioaddr + TYPHOON_REG_SELF_INTERRUPT);
|
||
|
}
|
||
|
|
||
|
spin_unlock(&tp->command_lock);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
typhoon_tso_fill(struct sk_buff *skb, struct transmit_ring *txRing,
|
||
|
u32 ring_dma)
|
||
|
{
|
||
|
struct tcpopt_desc *tcpd;
|
||
|
u32 tcpd_offset = ring_dma;
|
||
|
|
||
|
tcpd = (struct tcpopt_desc *) (txRing->ringBase + txRing->lastWrite);
|
||
|
tcpd_offset += txRing->lastWrite;
|
||
|
tcpd_offset += offsetof(struct tcpopt_desc, bytesTx);
|
||
|
typhoon_inc_tx_index(&txRing->lastWrite, 1);
|
||
|
|
||
|
tcpd->flags = TYPHOON_OPT_DESC | TYPHOON_OPT_TCP_SEG;
|
||
|
tcpd->numDesc = 1;
|
||
|
tcpd->mss_flags = cpu_to_le16(skb_tso_size(skb));
|
||
|
tcpd->mss_flags |= TYPHOON_TSO_FIRST | TYPHOON_TSO_LAST;
|
||
|
tcpd->respAddrLo = cpu_to_le32(tcpd_offset);
|
||
|
tcpd->bytesTx = cpu_to_le32(skb->len);
|
||
|
tcpd->status = 0;
|
||
|
}
|
||
|
|
||
|
static netdev_tx_t
|
||
|
typhoon_start_tx(struct sk_buff *skb, struct net_device *dev)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
struct transmit_ring *txRing;
|
||
|
struct tx_desc *txd, *first_txd;
|
||
|
dma_addr_t skb_dma;
|
||
|
int numDesc;
|
||
|
|
||
|
/* we have two rings to choose from, but we only use txLo for now
|
||
|
* If we start using the Hi ring as well, we'll need to update
|
||
|
* typhoon_stop_runtime(), typhoon_interrupt(), typhoon_num_free_tx(),
|
||
|
* and TXHI_ENTRIES to match, as well as update the TSO code below
|
||
|
* to get the right DMA address
|
||
|
*/
|
||
|
txRing = &tp->txLoRing;
|
||
|
|
||
|
/* We need one descriptor for each fragment of the sk_buff, plus the
|
||
|
* one for the ->data area of it.
|
||
|
*
|
||
|
* The docs say a maximum of 16 fragment descriptors per TCP option
|
||
|
* descriptor, then make a new packet descriptor and option descriptor
|
||
|
* for the next 16 fragments. The engineers say just an option
|
||
|
* descriptor is needed. I've tested up to 26 fragments with a single
|
||
|
* packet descriptor/option descriptor combo, so I use that for now.
|
||
|
*
|
||
|
* If problems develop with TSO, check this first.
|
||
|
*/
|
||
|
numDesc = skb_shinfo(skb)->nr_frags + 1;
|
||
|
if (skb_is_gso(skb))
|
||
|
numDesc++;
|
||
|
|
||
|
/* When checking for free space in the ring, we need to also
|
||
|
* account for the initial Tx descriptor, and we always must leave
|
||
|
* at least one descriptor unused in the ring so that it doesn't
|
||
|
* wrap and look empty.
|
||
|
*
|
||
|
* The only time we should loop here is when we hit the race
|
||
|
* between marking the queue awake and updating the cleared index.
|
||
|
* Just loop and it will appear. This comes from the acenic driver.
|
||
|
*/
|
||
|
while (unlikely(typhoon_num_free_tx(txRing) < (numDesc + 2)))
|
||
|
smp_rmb();
|
||
|
|
||
|
first_txd = (struct tx_desc *) (txRing->ringBase + txRing->lastWrite);
|
||
|
typhoon_inc_tx_index(&txRing->lastWrite, 1);
|
||
|
|
||
|
first_txd->flags = TYPHOON_TX_DESC | TYPHOON_DESC_VALID;
|
||
|
first_txd->numDesc = 0;
|
||
|
first_txd->len = 0;
|
||
|
first_txd->tx_addr = (u64)((unsigned long) skb);
|
||
|
first_txd->processFlags = 0;
|
||
|
|
||
|
if (skb->ip_summed == CHECKSUM_PARTIAL) {
|
||
|
/* The 3XP will figure out if this is UDP/TCP */
|
||
|
first_txd->processFlags |= TYPHOON_TX_PF_TCP_CHKSUM;
|
||
|
first_txd->processFlags |= TYPHOON_TX_PF_UDP_CHKSUM;
|
||
|
first_txd->processFlags |= TYPHOON_TX_PF_IP_CHKSUM;
|
||
|
}
|
||
|
|
||
|
if (skb_vlan_tag_present(skb)) {
|
||
|
first_txd->processFlags |=
|
||
|
TYPHOON_TX_PF_INSERT_VLAN | TYPHOON_TX_PF_VLAN_PRIORITY;
|
||
|
first_txd->processFlags |=
|
||
|
cpu_to_le32(htons(skb_vlan_tag_get(skb)) <<
|
||
|
TYPHOON_TX_PF_VLAN_TAG_SHIFT);
|
||
|
}
|
||
|
|
||
|
if (skb_is_gso(skb)) {
|
||
|
first_txd->processFlags |= TYPHOON_TX_PF_TCP_SEGMENT;
|
||
|
first_txd->numDesc++;
|
||
|
|
||
|
typhoon_tso_fill(skb, txRing, tp->txlo_dma_addr);
|
||
|
}
|
||
|
|
||
|
txd = (struct tx_desc *) (txRing->ringBase + txRing->lastWrite);
|
||
|
typhoon_inc_tx_index(&txRing->lastWrite, 1);
|
||
|
|
||
|
/* No need to worry about padding packet -- the firmware pads
|
||
|
* it with zeros to ETH_ZLEN for us.
|
||
|
*/
|
||
|
if (skb_shinfo(skb)->nr_frags == 0) {
|
||
|
skb_dma = dma_map_single(&tp->tx_pdev->dev, skb->data,
|
||
|
skb->len, DMA_TO_DEVICE);
|
||
|
txd->flags = TYPHOON_FRAG_DESC | TYPHOON_DESC_VALID;
|
||
|
txd->len = cpu_to_le16(skb->len);
|
||
|
txd->frag.addr = cpu_to_le32(skb_dma);
|
||
|
txd->frag.addrHi = 0;
|
||
|
first_txd->numDesc++;
|
||
|
} else {
|
||
|
int i, len;
|
||
|
|
||
|
len = skb_headlen(skb);
|
||
|
skb_dma = dma_map_single(&tp->tx_pdev->dev, skb->data, len,
|
||
|
DMA_TO_DEVICE);
|
||
|
txd->flags = TYPHOON_FRAG_DESC | TYPHOON_DESC_VALID;
|
||
|
txd->len = cpu_to_le16(len);
|
||
|
txd->frag.addr = cpu_to_le32(skb_dma);
|
||
|
txd->frag.addrHi = 0;
|
||
|
first_txd->numDesc++;
|
||
|
|
||
|
for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
|
||
|
const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
|
||
|
void *frag_addr;
|
||
|
|
||
|
txd = (struct tx_desc *) (txRing->ringBase +
|
||
|
txRing->lastWrite);
|
||
|
typhoon_inc_tx_index(&txRing->lastWrite, 1);
|
||
|
|
||
|
len = skb_frag_size(frag);
|
||
|
frag_addr = skb_frag_address(frag);
|
||
|
skb_dma = dma_map_single(&tp->tx_pdev->dev, frag_addr,
|
||
|
len, DMA_TO_DEVICE);
|
||
|
txd->flags = TYPHOON_FRAG_DESC | TYPHOON_DESC_VALID;
|
||
|
txd->len = cpu_to_le16(len);
|
||
|
txd->frag.addr = cpu_to_le32(skb_dma);
|
||
|
txd->frag.addrHi = 0;
|
||
|
first_txd->numDesc++;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Kick the 3XP
|
||
|
*/
|
||
|
wmb();
|
||
|
iowrite32(txRing->lastWrite, tp->tx_ioaddr + txRing->writeRegister);
|
||
|
|
||
|
/* If we don't have room to put the worst case packet on the
|
||
|
* queue, then we must stop the queue. We need 2 extra
|
||
|
* descriptors -- one to prevent ring wrap, and one for the
|
||
|
* Tx header.
|
||
|
*/
|
||
|
numDesc = MAX_SKB_FRAGS + TSO_NUM_DESCRIPTORS + 1;
|
||
|
|
||
|
if (typhoon_num_free_tx(txRing) < (numDesc + 2)) {
|
||
|
netif_stop_queue(dev);
|
||
|
|
||
|
/* A Tx complete IRQ could have gotten between, making
|
||
|
* the ring free again. Only need to recheck here, since
|
||
|
* Tx is serialized.
|
||
|
*/
|
||
|
if (typhoon_num_free_tx(txRing) >= (numDesc + 2))
|
||
|
netif_wake_queue(dev);
|
||
|
}
|
||
|
|
||
|
return NETDEV_TX_OK;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_set_rx_mode(struct net_device *dev)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
struct cmd_desc xp_cmd;
|
||
|
u32 mc_filter[2];
|
||
|
__le16 filter;
|
||
|
|
||
|
filter = TYPHOON_RX_FILTER_DIRECTED | TYPHOON_RX_FILTER_BROADCAST;
|
||
|
if (dev->flags & IFF_PROMISC) {
|
||
|
filter |= TYPHOON_RX_FILTER_PROMISCOUS;
|
||
|
} else if ((netdev_mc_count(dev) > multicast_filter_limit) ||
|
||
|
(dev->flags & IFF_ALLMULTI)) {
|
||
|
/* Too many to match, or accept all multicasts. */
|
||
|
filter |= TYPHOON_RX_FILTER_ALL_MCAST;
|
||
|
} else if (!netdev_mc_empty(dev)) {
|
||
|
struct netdev_hw_addr *ha;
|
||
|
|
||
|
memset(mc_filter, 0, sizeof(mc_filter));
|
||
|
netdev_for_each_mc_addr(ha, dev) {
|
||
|
int bit = ether_crc(ETH_ALEN, ha->addr) & 0x3f;
|
||
|
mc_filter[bit >> 5] |= 1 << (bit & 0x1f);
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd,
|
||
|
TYPHOON_CMD_SET_MULTICAST_HASH);
|
||
|
xp_cmd.parm1 = TYPHOON_MCAST_HASH_SET;
|
||
|
xp_cmd.parm2 = cpu_to_le32(mc_filter[0]);
|
||
|
xp_cmd.parm3 = cpu_to_le32(mc_filter[1]);
|
||
|
typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
|
||
|
filter |= TYPHOON_RX_FILTER_MCAST_HASH;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_SET_RX_FILTER);
|
||
|
xp_cmd.parm1 = filter;
|
||
|
typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_do_get_stats(struct typhoon *tp)
|
||
|
{
|
||
|
struct net_device_stats *stats = &tp->dev->stats;
|
||
|
struct net_device_stats *saved = &tp->stats_saved;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
struct resp_desc xp_resp[7];
|
||
|
struct stats_resp *s = (struct stats_resp *) xp_resp;
|
||
|
int err;
|
||
|
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_READ_STATS);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 7, xp_resp);
|
||
|
if (err < 0)
|
||
|
return err;
|
||
|
|
||
|
/* 3Com's Linux driver uses txMultipleCollisions as it's
|
||
|
* collisions value, but there is some other collision info as well...
|
||
|
*
|
||
|
* The extra status reported would be a good candidate for
|
||
|
* ethtool_ops->get_{strings,stats}()
|
||
|
*/
|
||
|
stats->tx_packets = le32_to_cpu(s->txPackets) +
|
||
|
saved->tx_packets;
|
||
|
stats->tx_bytes = le64_to_cpu(s->txBytes) +
|
||
|
saved->tx_bytes;
|
||
|
stats->tx_errors = le32_to_cpu(s->txCarrierLost) +
|
||
|
saved->tx_errors;
|
||
|
stats->tx_carrier_errors = le32_to_cpu(s->txCarrierLost) +
|
||
|
saved->tx_carrier_errors;
|
||
|
stats->collisions = le32_to_cpu(s->txMultipleCollisions) +
|
||
|
saved->collisions;
|
||
|
stats->rx_packets = le32_to_cpu(s->rxPacketsGood) +
|
||
|
saved->rx_packets;
|
||
|
stats->rx_bytes = le64_to_cpu(s->rxBytesGood) +
|
||
|
saved->rx_bytes;
|
||
|
stats->rx_fifo_errors = le32_to_cpu(s->rxFifoOverruns) +
|
||
|
saved->rx_fifo_errors;
|
||
|
stats->rx_errors = le32_to_cpu(s->rxFifoOverruns) +
|
||
|
le32_to_cpu(s->BadSSD) + le32_to_cpu(s->rxCrcErrors) +
|
||
|
saved->rx_errors;
|
||
|
stats->rx_crc_errors = le32_to_cpu(s->rxCrcErrors) +
|
||
|
saved->rx_crc_errors;
|
||
|
stats->rx_length_errors = le32_to_cpu(s->rxOversized) +
|
||
|
saved->rx_length_errors;
|
||
|
tp->speed = (s->linkStatus & TYPHOON_LINK_100MBPS) ?
|
||
|
SPEED_100 : SPEED_10;
|
||
|
tp->duplex = (s->linkStatus & TYPHOON_LINK_FULL_DUPLEX) ?
|
||
|
DUPLEX_FULL : DUPLEX_HALF;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static struct net_device_stats *
|
||
|
typhoon_get_stats(struct net_device *dev)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
struct net_device_stats *stats = &tp->dev->stats;
|
||
|
struct net_device_stats *saved = &tp->stats_saved;
|
||
|
|
||
|
smp_rmb();
|
||
|
if (tp->card_state == Sleeping)
|
||
|
return saved;
|
||
|
|
||
|
if (typhoon_do_get_stats(tp) < 0) {
|
||
|
netdev_err(dev, "error getting stats\n");
|
||
|
return saved;
|
||
|
}
|
||
|
|
||
|
return stats;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
struct pci_dev *pci_dev = tp->pdev;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
struct resp_desc xp_resp[3];
|
||
|
|
||
|
smp_rmb();
|
||
|
if (tp->card_state == Sleeping) {
|
||
|
strscpy(info->fw_version, "Sleep image",
|
||
|
sizeof(info->fw_version));
|
||
|
} else {
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_READ_VERSIONS);
|
||
|
if (typhoon_issue_command(tp, 1, &xp_cmd, 3, xp_resp) < 0) {
|
||
|
strscpy(info->fw_version, "Unknown runtime",
|
||
|
sizeof(info->fw_version));
|
||
|
} else {
|
||
|
u32 sleep_ver = le32_to_cpu(xp_resp[0].parm2);
|
||
|
snprintf(info->fw_version, sizeof(info->fw_version),
|
||
|
"%02x.%03x.%03x", sleep_ver >> 24,
|
||
|
(sleep_ver >> 12) & 0xfff, sleep_ver & 0xfff);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
strscpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
|
||
|
strscpy(info->bus_info, pci_name(pci_dev), sizeof(info->bus_info));
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_get_link_ksettings(struct net_device *dev,
|
||
|
struct ethtool_link_ksettings *cmd)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
u32 supported, advertising = 0;
|
||
|
|
||
|
supported = SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
|
||
|
SUPPORTED_Autoneg;
|
||
|
|
||
|
switch (tp->xcvr_select) {
|
||
|
case TYPHOON_XCVR_10HALF:
|
||
|
advertising = ADVERTISED_10baseT_Half;
|
||
|
break;
|
||
|
case TYPHOON_XCVR_10FULL:
|
||
|
advertising = ADVERTISED_10baseT_Full;
|
||
|
break;
|
||
|
case TYPHOON_XCVR_100HALF:
|
||
|
advertising = ADVERTISED_100baseT_Half;
|
||
|
break;
|
||
|
case TYPHOON_XCVR_100FULL:
|
||
|
advertising = ADVERTISED_100baseT_Full;
|
||
|
break;
|
||
|
case TYPHOON_XCVR_AUTONEG:
|
||
|
advertising = ADVERTISED_10baseT_Half |
|
||
|
ADVERTISED_10baseT_Full |
|
||
|
ADVERTISED_100baseT_Half |
|
||
|
ADVERTISED_100baseT_Full |
|
||
|
ADVERTISED_Autoneg;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (tp->capabilities & TYPHOON_FIBER) {
|
||
|
supported |= SUPPORTED_FIBRE;
|
||
|
advertising |= ADVERTISED_FIBRE;
|
||
|
cmd->base.port = PORT_FIBRE;
|
||
|
} else {
|
||
|
supported |= SUPPORTED_10baseT_Half |
|
||
|
SUPPORTED_10baseT_Full |
|
||
|
SUPPORTED_TP;
|
||
|
advertising |= ADVERTISED_TP;
|
||
|
cmd->base.port = PORT_TP;
|
||
|
}
|
||
|
|
||
|
/* need to get stats to make these link speed/duplex valid */
|
||
|
typhoon_do_get_stats(tp);
|
||
|
cmd->base.speed = tp->speed;
|
||
|
cmd->base.duplex = tp->duplex;
|
||
|
cmd->base.phy_address = 0;
|
||
|
if (tp->xcvr_select == TYPHOON_XCVR_AUTONEG)
|
||
|
cmd->base.autoneg = AUTONEG_ENABLE;
|
||
|
else
|
||
|
cmd->base.autoneg = AUTONEG_DISABLE;
|
||
|
|
||
|
ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
|
||
|
supported);
|
||
|
ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
|
||
|
advertising);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_set_link_ksettings(struct net_device *dev,
|
||
|
const struct ethtool_link_ksettings *cmd)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
u32 speed = cmd->base.speed;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
__le16 xcvr;
|
||
|
int err;
|
||
|
|
||
|
err = -EINVAL;
|
||
|
if (cmd->base.autoneg == AUTONEG_ENABLE) {
|
||
|
xcvr = TYPHOON_XCVR_AUTONEG;
|
||
|
} else {
|
||
|
if (cmd->base.duplex == DUPLEX_HALF) {
|
||
|
if (speed == SPEED_10)
|
||
|
xcvr = TYPHOON_XCVR_10HALF;
|
||
|
else if (speed == SPEED_100)
|
||
|
xcvr = TYPHOON_XCVR_100HALF;
|
||
|
else
|
||
|
goto out;
|
||
|
} else if (cmd->base.duplex == DUPLEX_FULL) {
|
||
|
if (speed == SPEED_10)
|
||
|
xcvr = TYPHOON_XCVR_10FULL;
|
||
|
else if (speed == SPEED_100)
|
||
|
xcvr = TYPHOON_XCVR_100FULL;
|
||
|
else
|
||
|
goto out;
|
||
|
} else
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_XCVR_SELECT);
|
||
|
xp_cmd.parm1 = xcvr;
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto out;
|
||
|
|
||
|
tp->xcvr_select = xcvr;
|
||
|
if (cmd->base.autoneg == AUTONEG_ENABLE) {
|
||
|
tp->speed = 0xff; /* invalid */
|
||
|
tp->duplex = 0xff; /* invalid */
|
||
|
} else {
|
||
|
tp->speed = speed;
|
||
|
tp->duplex = cmd->base.duplex;
|
||
|
}
|
||
|
|
||
|
out:
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
|
||
|
wol->supported = WAKE_PHY | WAKE_MAGIC;
|
||
|
wol->wolopts = 0;
|
||
|
if (tp->wol_events & TYPHOON_WAKE_LINK_EVENT)
|
||
|
wol->wolopts |= WAKE_PHY;
|
||
|
if (tp->wol_events & TYPHOON_WAKE_MAGIC_PKT)
|
||
|
wol->wolopts |= WAKE_MAGIC;
|
||
|
memset(&wol->sopass, 0, sizeof(wol->sopass));
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
|
||
|
if (wol->wolopts & ~(WAKE_PHY | WAKE_MAGIC))
|
||
|
return -EINVAL;
|
||
|
|
||
|
tp->wol_events = 0;
|
||
|
if (wol->wolopts & WAKE_PHY)
|
||
|
tp->wol_events |= TYPHOON_WAKE_LINK_EVENT;
|
||
|
if (wol->wolopts & WAKE_MAGIC)
|
||
|
tp->wol_events |= TYPHOON_WAKE_MAGIC_PKT;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_get_ringparam(struct net_device *dev, struct ethtool_ringparam *ering,
|
||
|
struct kernel_ethtool_ringparam *kernel_ering,
|
||
|
struct netlink_ext_ack *extack)
|
||
|
{
|
||
|
ering->rx_max_pending = RXENT_ENTRIES;
|
||
|
ering->tx_max_pending = TXLO_ENTRIES - 1;
|
||
|
|
||
|
ering->rx_pending = RXENT_ENTRIES;
|
||
|
ering->tx_pending = TXLO_ENTRIES - 1;
|
||
|
}
|
||
|
|
||
|
static const struct ethtool_ops typhoon_ethtool_ops = {
|
||
|
.get_drvinfo = typhoon_get_drvinfo,
|
||
|
.get_wol = typhoon_get_wol,
|
||
|
.set_wol = typhoon_set_wol,
|
||
|
.get_link = ethtool_op_get_link,
|
||
|
.get_ringparam = typhoon_get_ringparam,
|
||
|
.get_link_ksettings = typhoon_get_link_ksettings,
|
||
|
.set_link_ksettings = typhoon_set_link_ksettings,
|
||
|
};
|
||
|
|
||
|
static int
|
||
|
typhoon_wait_interrupt(void __iomem *ioaddr)
|
||
|
{
|
||
|
int i, err = 0;
|
||
|
|
||
|
for (i = 0; i < TYPHOON_WAIT_TIMEOUT; i++) {
|
||
|
if (ioread32(ioaddr + TYPHOON_REG_INTR_STATUS) &
|
||
|
TYPHOON_INTR_BOOTCMD)
|
||
|
goto out;
|
||
|
udelay(TYPHOON_UDELAY);
|
||
|
}
|
||
|
|
||
|
err = -ETIMEDOUT;
|
||
|
|
||
|
out:
|
||
|
iowrite32(TYPHOON_INTR_BOOTCMD, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
#define shared_offset(x) offsetof(struct typhoon_shared, x)
|
||
|
|
||
|
static void
|
||
|
typhoon_init_interface(struct typhoon *tp)
|
||
|
{
|
||
|
struct typhoon_interface *iface = &tp->shared->iface;
|
||
|
dma_addr_t shared_dma;
|
||
|
|
||
|
memset(tp->shared, 0, sizeof(struct typhoon_shared));
|
||
|
|
||
|
/* The *Hi members of iface are all init'd to zero by the memset().
|
||
|
*/
|
||
|
shared_dma = tp->shared_dma + shared_offset(indexes);
|
||
|
iface->ringIndex = cpu_to_le32(shared_dma);
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(txLo);
|
||
|
iface->txLoAddr = cpu_to_le32(shared_dma);
|
||
|
iface->txLoSize = cpu_to_le32(TXLO_ENTRIES * sizeof(struct tx_desc));
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(txHi);
|
||
|
iface->txHiAddr = cpu_to_le32(shared_dma);
|
||
|
iface->txHiSize = cpu_to_le32(TXHI_ENTRIES * sizeof(struct tx_desc));
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(rxBuff);
|
||
|
iface->rxBuffAddr = cpu_to_le32(shared_dma);
|
||
|
iface->rxBuffSize = cpu_to_le32(RXFREE_ENTRIES *
|
||
|
sizeof(struct rx_free));
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(rxLo);
|
||
|
iface->rxLoAddr = cpu_to_le32(shared_dma);
|
||
|
iface->rxLoSize = cpu_to_le32(RX_ENTRIES * sizeof(struct rx_desc));
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(rxHi);
|
||
|
iface->rxHiAddr = cpu_to_le32(shared_dma);
|
||
|
iface->rxHiSize = cpu_to_le32(RX_ENTRIES * sizeof(struct rx_desc));
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(cmd);
|
||
|
iface->cmdAddr = cpu_to_le32(shared_dma);
|
||
|
iface->cmdSize = cpu_to_le32(COMMAND_RING_SIZE);
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(resp);
|
||
|
iface->respAddr = cpu_to_le32(shared_dma);
|
||
|
iface->respSize = cpu_to_le32(RESPONSE_RING_SIZE);
|
||
|
|
||
|
shared_dma = tp->shared_dma + shared_offset(zeroWord);
|
||
|
iface->zeroAddr = cpu_to_le32(shared_dma);
|
||
|
|
||
|
tp->indexes = &tp->shared->indexes;
|
||
|
tp->txLoRing.ringBase = (u8 *) tp->shared->txLo;
|
||
|
tp->txHiRing.ringBase = (u8 *) tp->shared->txHi;
|
||
|
tp->rxLoRing.ringBase = (u8 *) tp->shared->rxLo;
|
||
|
tp->rxHiRing.ringBase = (u8 *) tp->shared->rxHi;
|
||
|
tp->rxBuffRing.ringBase = (u8 *) tp->shared->rxBuff;
|
||
|
tp->cmdRing.ringBase = (u8 *) tp->shared->cmd;
|
||
|
tp->respRing.ringBase = (u8 *) tp->shared->resp;
|
||
|
|
||
|
tp->txLoRing.writeRegister = TYPHOON_REG_TX_LO_READY;
|
||
|
tp->txHiRing.writeRegister = TYPHOON_REG_TX_HI_READY;
|
||
|
|
||
|
tp->txlo_dma_addr = le32_to_cpu(iface->txLoAddr);
|
||
|
tp->card_state = Sleeping;
|
||
|
|
||
|
tp->offload = TYPHOON_OFFLOAD_IP_CHKSUM | TYPHOON_OFFLOAD_TCP_CHKSUM;
|
||
|
tp->offload |= TYPHOON_OFFLOAD_UDP_CHKSUM | TSO_OFFLOAD_ON;
|
||
|
tp->offload |= TYPHOON_OFFLOAD_VLAN;
|
||
|
|
||
|
spin_lock_init(&tp->command_lock);
|
||
|
|
||
|
/* Force the writes to the shared memory area out before continuing. */
|
||
|
wmb();
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_init_rings(struct typhoon *tp)
|
||
|
{
|
||
|
memset(tp->indexes, 0, sizeof(struct typhoon_indexes));
|
||
|
|
||
|
tp->txLoRing.lastWrite = 0;
|
||
|
tp->txHiRing.lastWrite = 0;
|
||
|
tp->rxLoRing.lastWrite = 0;
|
||
|
tp->rxHiRing.lastWrite = 0;
|
||
|
tp->rxBuffRing.lastWrite = 0;
|
||
|
tp->cmdRing.lastWrite = 0;
|
||
|
tp->respRing.lastWrite = 0;
|
||
|
|
||
|
tp->txLoRing.lastRead = 0;
|
||
|
tp->txHiRing.lastRead = 0;
|
||
|
}
|
||
|
|
||
|
static const struct firmware *typhoon_fw;
|
||
|
|
||
|
static int
|
||
|
typhoon_request_firmware(struct typhoon *tp)
|
||
|
{
|
||
|
const struct typhoon_file_header *fHdr;
|
||
|
const struct typhoon_section_header *sHdr;
|
||
|
const u8 *image_data;
|
||
|
u32 numSections;
|
||
|
u32 section_len;
|
||
|
u32 remaining;
|
||
|
int err;
|
||
|
|
||
|
if (typhoon_fw)
|
||
|
return 0;
|
||
|
|
||
|
err = request_firmware(&typhoon_fw, FIRMWARE_NAME, &tp->pdev->dev);
|
||
|
if (err) {
|
||
|
netdev_err(tp->dev, "Failed to load firmware \"%s\"\n",
|
||
|
FIRMWARE_NAME);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
image_data = typhoon_fw->data;
|
||
|
remaining = typhoon_fw->size;
|
||
|
if (remaining < sizeof(struct typhoon_file_header))
|
||
|
goto invalid_fw;
|
||
|
|
||
|
fHdr = (struct typhoon_file_header *) image_data;
|
||
|
if (memcmp(fHdr->tag, "TYPHOON", 8))
|
||
|
goto invalid_fw;
|
||
|
|
||
|
numSections = le32_to_cpu(fHdr->numSections);
|
||
|
image_data += sizeof(struct typhoon_file_header);
|
||
|
remaining -= sizeof(struct typhoon_file_header);
|
||
|
|
||
|
while (numSections--) {
|
||
|
if (remaining < sizeof(struct typhoon_section_header))
|
||
|
goto invalid_fw;
|
||
|
|
||
|
sHdr = (struct typhoon_section_header *) image_data;
|
||
|
image_data += sizeof(struct typhoon_section_header);
|
||
|
section_len = le32_to_cpu(sHdr->len);
|
||
|
|
||
|
if (remaining < section_len)
|
||
|
goto invalid_fw;
|
||
|
|
||
|
image_data += section_len;
|
||
|
remaining -= section_len;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
invalid_fw:
|
||
|
netdev_err(tp->dev, "Invalid firmware image\n");
|
||
|
release_firmware(typhoon_fw);
|
||
|
typhoon_fw = NULL;
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_download_firmware(struct typhoon *tp)
|
||
|
{
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
struct pci_dev *pdev = tp->pdev;
|
||
|
const struct typhoon_file_header *fHdr;
|
||
|
const struct typhoon_section_header *sHdr;
|
||
|
const u8 *image_data;
|
||
|
void *dpage;
|
||
|
dma_addr_t dpage_dma;
|
||
|
__sum16 csum;
|
||
|
u32 irqEnabled;
|
||
|
u32 irqMasked;
|
||
|
u32 numSections;
|
||
|
u32 section_len;
|
||
|
u32 len;
|
||
|
u32 load_addr;
|
||
|
u32 hmac;
|
||
|
int i;
|
||
|
int err;
|
||
|
|
||
|
image_data = typhoon_fw->data;
|
||
|
fHdr = (struct typhoon_file_header *) image_data;
|
||
|
|
||
|
/* Cannot just map the firmware image using dma_map_single() as
|
||
|
* the firmware is vmalloc()'d and may not be physically contiguous,
|
||
|
* so we allocate some coherent memory to copy the sections into.
|
||
|
*/
|
||
|
err = -ENOMEM;
|
||
|
dpage = dma_alloc_coherent(&pdev->dev, PAGE_SIZE, &dpage_dma, GFP_ATOMIC);
|
||
|
if (!dpage) {
|
||
|
netdev_err(tp->dev, "no DMA mem for firmware\n");
|
||
|
goto err_out;
|
||
|
}
|
||
|
|
||
|
irqEnabled = ioread32(ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
iowrite32(irqEnabled | TYPHOON_INTR_BOOTCMD,
|
||
|
ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
irqMasked = ioread32(ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
iowrite32(irqMasked | TYPHOON_INTR_BOOTCMD,
|
||
|
ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
|
||
|
err = -ETIMEDOUT;
|
||
|
if (typhoon_wait_status(ioaddr, TYPHOON_STATUS_WAITING_FOR_HOST) < 0) {
|
||
|
netdev_err(tp->dev, "card ready timeout\n");
|
||
|
goto err_out_irq;
|
||
|
}
|
||
|
|
||
|
numSections = le32_to_cpu(fHdr->numSections);
|
||
|
load_addr = le32_to_cpu(fHdr->startAddr);
|
||
|
|
||
|
iowrite32(TYPHOON_INTR_BOOTCMD, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
iowrite32(load_addr, ioaddr + TYPHOON_REG_DOWNLOAD_BOOT_ADDR);
|
||
|
hmac = le32_to_cpu(fHdr->hmacDigest[0]);
|
||
|
iowrite32(hmac, ioaddr + TYPHOON_REG_DOWNLOAD_HMAC_0);
|
||
|
hmac = le32_to_cpu(fHdr->hmacDigest[1]);
|
||
|
iowrite32(hmac, ioaddr + TYPHOON_REG_DOWNLOAD_HMAC_1);
|
||
|
hmac = le32_to_cpu(fHdr->hmacDigest[2]);
|
||
|
iowrite32(hmac, ioaddr + TYPHOON_REG_DOWNLOAD_HMAC_2);
|
||
|
hmac = le32_to_cpu(fHdr->hmacDigest[3]);
|
||
|
iowrite32(hmac, ioaddr + TYPHOON_REG_DOWNLOAD_HMAC_3);
|
||
|
hmac = le32_to_cpu(fHdr->hmacDigest[4]);
|
||
|
iowrite32(hmac, ioaddr + TYPHOON_REG_DOWNLOAD_HMAC_4);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
iowrite32(TYPHOON_BOOTCMD_RUNTIME_IMAGE, ioaddr + TYPHOON_REG_COMMAND);
|
||
|
|
||
|
image_data += sizeof(struct typhoon_file_header);
|
||
|
|
||
|
/* The ioread32() in typhoon_wait_interrupt() will force the
|
||
|
* last write to the command register to post, so
|
||
|
* we don't need a typhoon_post_pci_writes() after it.
|
||
|
*/
|
||
|
for (i = 0; i < numSections; i++) {
|
||
|
sHdr = (struct typhoon_section_header *) image_data;
|
||
|
image_data += sizeof(struct typhoon_section_header);
|
||
|
load_addr = le32_to_cpu(sHdr->startAddr);
|
||
|
section_len = le32_to_cpu(sHdr->len);
|
||
|
|
||
|
while (section_len) {
|
||
|
len = min_t(u32, section_len, PAGE_SIZE);
|
||
|
|
||
|
if (typhoon_wait_interrupt(ioaddr) < 0 ||
|
||
|
ioread32(ioaddr + TYPHOON_REG_STATUS) !=
|
||
|
TYPHOON_STATUS_WAITING_FOR_SEGMENT) {
|
||
|
netdev_err(tp->dev, "segment ready timeout\n");
|
||
|
goto err_out_irq;
|
||
|
}
|
||
|
|
||
|
/* Do an pseudo IPv4 checksum on the data -- first
|
||
|
* need to convert each u16 to cpu order before
|
||
|
* summing. Fortunately, due to the properties of
|
||
|
* the checksum, we can do this once, at the end.
|
||
|
*/
|
||
|
csum = csum_fold(csum_partial_copy_nocheck(image_data,
|
||
|
dpage, len));
|
||
|
|
||
|
iowrite32(len, ioaddr + TYPHOON_REG_BOOT_LENGTH);
|
||
|
iowrite32(le16_to_cpu((__force __le16)csum),
|
||
|
ioaddr + TYPHOON_REG_BOOT_CHECKSUM);
|
||
|
iowrite32(load_addr,
|
||
|
ioaddr + TYPHOON_REG_BOOT_DEST_ADDR);
|
||
|
iowrite32(0, ioaddr + TYPHOON_REG_BOOT_DATA_HI);
|
||
|
iowrite32(dpage_dma, ioaddr + TYPHOON_REG_BOOT_DATA_LO);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
iowrite32(TYPHOON_BOOTCMD_SEG_AVAILABLE,
|
||
|
ioaddr + TYPHOON_REG_COMMAND);
|
||
|
|
||
|
image_data += len;
|
||
|
load_addr += len;
|
||
|
section_len -= len;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (typhoon_wait_interrupt(ioaddr) < 0 ||
|
||
|
ioread32(ioaddr + TYPHOON_REG_STATUS) !=
|
||
|
TYPHOON_STATUS_WAITING_FOR_SEGMENT) {
|
||
|
netdev_err(tp->dev, "final segment ready timeout\n");
|
||
|
goto err_out_irq;
|
||
|
}
|
||
|
|
||
|
iowrite32(TYPHOON_BOOTCMD_DNLD_COMPLETE, ioaddr + TYPHOON_REG_COMMAND);
|
||
|
|
||
|
if (typhoon_wait_status(ioaddr, TYPHOON_STATUS_WAITING_FOR_BOOT) < 0) {
|
||
|
netdev_err(tp->dev, "boot ready timeout, status 0x%0x\n",
|
||
|
ioread32(ioaddr + TYPHOON_REG_STATUS));
|
||
|
goto err_out_irq;
|
||
|
}
|
||
|
|
||
|
err = 0;
|
||
|
|
||
|
err_out_irq:
|
||
|
iowrite32(irqMasked, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
iowrite32(irqEnabled, ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
|
||
|
dma_free_coherent(&pdev->dev, PAGE_SIZE, dpage, dpage_dma);
|
||
|
|
||
|
err_out:
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_boot_3XP(struct typhoon *tp, u32 initial_status)
|
||
|
{
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
|
||
|
if (typhoon_wait_status(ioaddr, initial_status) < 0) {
|
||
|
netdev_err(tp->dev, "boot ready timeout\n");
|
||
|
goto out_timeout;
|
||
|
}
|
||
|
|
||
|
iowrite32(0, ioaddr + TYPHOON_REG_BOOT_RECORD_ADDR_HI);
|
||
|
iowrite32(tp->shared_dma, ioaddr + TYPHOON_REG_BOOT_RECORD_ADDR_LO);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
iowrite32(TYPHOON_BOOTCMD_REG_BOOT_RECORD,
|
||
|
ioaddr + TYPHOON_REG_COMMAND);
|
||
|
|
||
|
if (typhoon_wait_status(ioaddr, TYPHOON_STATUS_RUNNING) < 0) {
|
||
|
netdev_err(tp->dev, "boot finish timeout (status 0x%x)\n",
|
||
|
ioread32(ioaddr + TYPHOON_REG_STATUS));
|
||
|
goto out_timeout;
|
||
|
}
|
||
|
|
||
|
/* Clear the Transmit and Command ready registers
|
||
|
*/
|
||
|
iowrite32(0, ioaddr + TYPHOON_REG_TX_HI_READY);
|
||
|
iowrite32(0, ioaddr + TYPHOON_REG_CMD_READY);
|
||
|
iowrite32(0, ioaddr + TYPHOON_REG_TX_LO_READY);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
iowrite32(TYPHOON_BOOTCMD_BOOT, ioaddr + TYPHOON_REG_COMMAND);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
out_timeout:
|
||
|
return -ETIMEDOUT;
|
||
|
}
|
||
|
|
||
|
static u32
|
||
|
typhoon_clean_tx(struct typhoon *tp, struct transmit_ring *txRing,
|
||
|
volatile __le32 * index)
|
||
|
{
|
||
|
u32 lastRead = txRing->lastRead;
|
||
|
struct tx_desc *tx;
|
||
|
dma_addr_t skb_dma;
|
||
|
int dma_len;
|
||
|
int type;
|
||
|
|
||
|
while (lastRead != le32_to_cpu(*index)) {
|
||
|
tx = (struct tx_desc *) (txRing->ringBase + lastRead);
|
||
|
type = tx->flags & TYPHOON_TYPE_MASK;
|
||
|
|
||
|
if (type == TYPHOON_TX_DESC) {
|
||
|
/* This tx_desc describes a packet.
|
||
|
*/
|
||
|
unsigned long ptr = tx->tx_addr;
|
||
|
struct sk_buff *skb = (struct sk_buff *) ptr;
|
||
|
dev_kfree_skb_irq(skb);
|
||
|
} else if (type == TYPHOON_FRAG_DESC) {
|
||
|
/* This tx_desc describes a memory mapping. Free it.
|
||
|
*/
|
||
|
skb_dma = (dma_addr_t) le32_to_cpu(tx->frag.addr);
|
||
|
dma_len = le16_to_cpu(tx->len);
|
||
|
dma_unmap_single(&tp->pdev->dev, skb_dma, dma_len,
|
||
|
DMA_TO_DEVICE);
|
||
|
}
|
||
|
|
||
|
tx->flags = 0;
|
||
|
typhoon_inc_tx_index(&lastRead, 1);
|
||
|
}
|
||
|
|
||
|
return lastRead;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_tx_complete(struct typhoon *tp, struct transmit_ring *txRing,
|
||
|
volatile __le32 * index)
|
||
|
{
|
||
|
u32 lastRead;
|
||
|
int numDesc = MAX_SKB_FRAGS + 1;
|
||
|
|
||
|
/* This will need changing if we start to use the Hi Tx ring. */
|
||
|
lastRead = typhoon_clean_tx(tp, txRing, index);
|
||
|
if (netif_queue_stopped(tp->dev) && typhoon_num_free(txRing->lastWrite,
|
||
|
lastRead, TXLO_ENTRIES) > (numDesc + 2))
|
||
|
netif_wake_queue(tp->dev);
|
||
|
|
||
|
txRing->lastRead = lastRead;
|
||
|
smp_wmb();
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_recycle_rx_skb(struct typhoon *tp, u32 idx)
|
||
|
{
|
||
|
struct typhoon_indexes *indexes = tp->indexes;
|
||
|
struct rxbuff_ent *rxb = &tp->rxbuffers[idx];
|
||
|
struct basic_ring *ring = &tp->rxBuffRing;
|
||
|
struct rx_free *r;
|
||
|
|
||
|
if ((ring->lastWrite + sizeof(*r)) % (RXFREE_ENTRIES * sizeof(*r)) ==
|
||
|
le32_to_cpu(indexes->rxBuffCleared)) {
|
||
|
/* no room in ring, just drop the skb
|
||
|
*/
|
||
|
dev_kfree_skb_any(rxb->skb);
|
||
|
rxb->skb = NULL;
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
r = (struct rx_free *) (ring->ringBase + ring->lastWrite);
|
||
|
typhoon_inc_rxfree_index(&ring->lastWrite, 1);
|
||
|
r->virtAddr = idx;
|
||
|
r->physAddr = cpu_to_le32(rxb->dma_addr);
|
||
|
|
||
|
/* Tell the card about it */
|
||
|
wmb();
|
||
|
indexes->rxBuffReady = cpu_to_le32(ring->lastWrite);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_alloc_rx_skb(struct typhoon *tp, u32 idx)
|
||
|
{
|
||
|
struct typhoon_indexes *indexes = tp->indexes;
|
||
|
struct rxbuff_ent *rxb = &tp->rxbuffers[idx];
|
||
|
struct basic_ring *ring = &tp->rxBuffRing;
|
||
|
struct rx_free *r;
|
||
|
struct sk_buff *skb;
|
||
|
dma_addr_t dma_addr;
|
||
|
|
||
|
rxb->skb = NULL;
|
||
|
|
||
|
if ((ring->lastWrite + sizeof(*r)) % (RXFREE_ENTRIES * sizeof(*r)) ==
|
||
|
le32_to_cpu(indexes->rxBuffCleared))
|
||
|
return -ENOMEM;
|
||
|
|
||
|
skb = netdev_alloc_skb(tp->dev, PKT_BUF_SZ);
|
||
|
if (!skb)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
#if 0
|
||
|
/* Please, 3com, fix the firmware to allow DMA to a unaligned
|
||
|
* address! Pretty please?
|
||
|
*/
|
||
|
skb_reserve(skb, 2);
|
||
|
#endif
|
||
|
|
||
|
dma_addr = dma_map_single(&tp->pdev->dev, skb->data, PKT_BUF_SZ,
|
||
|
DMA_FROM_DEVICE);
|
||
|
|
||
|
/* Since no card does 64 bit DAC, the high bits will never
|
||
|
* change from zero.
|
||
|
*/
|
||
|
r = (struct rx_free *) (ring->ringBase + ring->lastWrite);
|
||
|
typhoon_inc_rxfree_index(&ring->lastWrite, 1);
|
||
|
r->virtAddr = idx;
|
||
|
r->physAddr = cpu_to_le32(dma_addr);
|
||
|
rxb->skb = skb;
|
||
|
rxb->dma_addr = dma_addr;
|
||
|
|
||
|
/* Tell the card about it */
|
||
|
wmb();
|
||
|
indexes->rxBuffReady = cpu_to_le32(ring->lastWrite);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_rx(struct typhoon *tp, struct basic_ring *rxRing, volatile __le32 * ready,
|
||
|
volatile __le32 * cleared, int budget)
|
||
|
{
|
||
|
struct rx_desc *rx;
|
||
|
struct sk_buff *skb, *new_skb;
|
||
|
struct rxbuff_ent *rxb;
|
||
|
dma_addr_t dma_addr;
|
||
|
u32 local_ready;
|
||
|
u32 rxaddr;
|
||
|
int pkt_len;
|
||
|
u32 idx;
|
||
|
__le32 csum_bits;
|
||
|
int received;
|
||
|
|
||
|
received = 0;
|
||
|
local_ready = le32_to_cpu(*ready);
|
||
|
rxaddr = le32_to_cpu(*cleared);
|
||
|
while (rxaddr != local_ready && budget > 0) {
|
||
|
rx = (struct rx_desc *) (rxRing->ringBase + rxaddr);
|
||
|
idx = rx->addr;
|
||
|
rxb = &tp->rxbuffers[idx];
|
||
|
skb = rxb->skb;
|
||
|
dma_addr = rxb->dma_addr;
|
||
|
|
||
|
typhoon_inc_rx_index(&rxaddr, 1);
|
||
|
|
||
|
if (rx->flags & TYPHOON_RX_ERROR) {
|
||
|
typhoon_recycle_rx_skb(tp, idx);
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
pkt_len = le16_to_cpu(rx->frameLen);
|
||
|
|
||
|
if (pkt_len < rx_copybreak &&
|
||
|
(new_skb = netdev_alloc_skb(tp->dev, pkt_len + 2)) != NULL) {
|
||
|
skb_reserve(new_skb, 2);
|
||
|
dma_sync_single_for_cpu(&tp->pdev->dev, dma_addr,
|
||
|
PKT_BUF_SZ, DMA_FROM_DEVICE);
|
||
|
skb_copy_to_linear_data(new_skb, skb->data, pkt_len);
|
||
|
dma_sync_single_for_device(&tp->pdev->dev, dma_addr,
|
||
|
PKT_BUF_SZ,
|
||
|
DMA_FROM_DEVICE);
|
||
|
skb_put(new_skb, pkt_len);
|
||
|
typhoon_recycle_rx_skb(tp, idx);
|
||
|
} else {
|
||
|
new_skb = skb;
|
||
|
skb_put(new_skb, pkt_len);
|
||
|
dma_unmap_single(&tp->pdev->dev, dma_addr, PKT_BUF_SZ,
|
||
|
DMA_FROM_DEVICE);
|
||
|
typhoon_alloc_rx_skb(tp, idx);
|
||
|
}
|
||
|
new_skb->protocol = eth_type_trans(new_skb, tp->dev);
|
||
|
csum_bits = rx->rxStatus & (TYPHOON_RX_IP_CHK_GOOD |
|
||
|
TYPHOON_RX_UDP_CHK_GOOD | TYPHOON_RX_TCP_CHK_GOOD);
|
||
|
if (csum_bits ==
|
||
|
(TYPHOON_RX_IP_CHK_GOOD | TYPHOON_RX_TCP_CHK_GOOD) ||
|
||
|
csum_bits ==
|
||
|
(TYPHOON_RX_IP_CHK_GOOD | TYPHOON_RX_UDP_CHK_GOOD)) {
|
||
|
new_skb->ip_summed = CHECKSUM_UNNECESSARY;
|
||
|
} else
|
||
|
skb_checksum_none_assert(new_skb);
|
||
|
|
||
|
if (rx->rxStatus & TYPHOON_RX_VLAN)
|
||
|
__vlan_hwaccel_put_tag(new_skb, htons(ETH_P_8021Q),
|
||
|
ntohl(rx->vlanTag) & 0xffff);
|
||
|
netif_receive_skb(new_skb);
|
||
|
|
||
|
received++;
|
||
|
budget--;
|
||
|
}
|
||
|
*cleared = cpu_to_le32(rxaddr);
|
||
|
|
||
|
return received;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_fill_free_ring(struct typhoon *tp)
|
||
|
{
|
||
|
u32 i;
|
||
|
|
||
|
for (i = 0; i < RXENT_ENTRIES; i++) {
|
||
|
struct rxbuff_ent *rxb = &tp->rxbuffers[i];
|
||
|
if (rxb->skb)
|
||
|
continue;
|
||
|
if (typhoon_alloc_rx_skb(tp, i) < 0)
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_poll(struct napi_struct *napi, int budget)
|
||
|
{
|
||
|
struct typhoon *tp = container_of(napi, struct typhoon, napi);
|
||
|
struct typhoon_indexes *indexes = tp->indexes;
|
||
|
int work_done;
|
||
|
|
||
|
rmb();
|
||
|
if (!tp->awaiting_resp && indexes->respReady != indexes->respCleared)
|
||
|
typhoon_process_response(tp, 0, NULL);
|
||
|
|
||
|
if (le32_to_cpu(indexes->txLoCleared) != tp->txLoRing.lastRead)
|
||
|
typhoon_tx_complete(tp, &tp->txLoRing, &indexes->txLoCleared);
|
||
|
|
||
|
work_done = 0;
|
||
|
|
||
|
if (indexes->rxHiCleared != indexes->rxHiReady) {
|
||
|
work_done += typhoon_rx(tp, &tp->rxHiRing, &indexes->rxHiReady,
|
||
|
&indexes->rxHiCleared, budget);
|
||
|
}
|
||
|
|
||
|
if (indexes->rxLoCleared != indexes->rxLoReady) {
|
||
|
work_done += typhoon_rx(tp, &tp->rxLoRing, &indexes->rxLoReady,
|
||
|
&indexes->rxLoCleared, budget - work_done);
|
||
|
}
|
||
|
|
||
|
if (le32_to_cpu(indexes->rxBuffCleared) == tp->rxBuffRing.lastWrite) {
|
||
|
/* rxBuff ring is empty, try to fill it. */
|
||
|
typhoon_fill_free_ring(tp);
|
||
|
}
|
||
|
|
||
|
if (work_done < budget) {
|
||
|
napi_complete_done(napi, work_done);
|
||
|
iowrite32(TYPHOON_INTR_NONE,
|
||
|
tp->ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
typhoon_post_pci_writes(tp->ioaddr);
|
||
|
}
|
||
|
|
||
|
return work_done;
|
||
|
}
|
||
|
|
||
|
static irqreturn_t
|
||
|
typhoon_interrupt(int irq, void *dev_instance)
|
||
|
{
|
||
|
struct net_device *dev = dev_instance;
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
u32 intr_status;
|
||
|
|
||
|
intr_status = ioread32(ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
if (!(intr_status & TYPHOON_INTR_HOST_INT))
|
||
|
return IRQ_NONE;
|
||
|
|
||
|
iowrite32(intr_status, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
|
||
|
if (napi_schedule_prep(&tp->napi)) {
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
__napi_schedule(&tp->napi);
|
||
|
} else {
|
||
|
netdev_err(dev, "Error, poll already scheduled\n");
|
||
|
}
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_free_rx_rings(struct typhoon *tp)
|
||
|
{
|
||
|
u32 i;
|
||
|
|
||
|
for (i = 0; i < RXENT_ENTRIES; i++) {
|
||
|
struct rxbuff_ent *rxb = &tp->rxbuffers[i];
|
||
|
if (rxb->skb) {
|
||
|
dma_unmap_single(&tp->pdev->dev, rxb->dma_addr,
|
||
|
PKT_BUF_SZ, DMA_FROM_DEVICE);
|
||
|
dev_kfree_skb(rxb->skb);
|
||
|
rxb->skb = NULL;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_sleep_early(struct typhoon *tp, __le16 events)
|
||
|
{
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
int err;
|
||
|
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_ENABLE_WAKE_EVENTS);
|
||
|
xp_cmd.parm1 = events;
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0) {
|
||
|
netdev_err(tp->dev, "typhoon_sleep(): wake events cmd err %d\n",
|
||
|
err);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_GOTO_SLEEP);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0) {
|
||
|
netdev_err(tp->dev, "typhoon_sleep(): sleep cmd err %d\n", err);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
if (typhoon_wait_status(ioaddr, TYPHOON_STATUS_SLEEPING) < 0)
|
||
|
return -ETIMEDOUT;
|
||
|
|
||
|
/* Since we cannot monitor the status of the link while sleeping,
|
||
|
* tell the world it went away.
|
||
|
*/
|
||
|
netif_carrier_off(tp->dev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_sleep(struct typhoon *tp, pci_power_t state, __le16 events)
|
||
|
{
|
||
|
int err;
|
||
|
|
||
|
err = typhoon_sleep_early(tp, events);
|
||
|
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
pci_enable_wake(tp->pdev, state, 1);
|
||
|
pci_disable_device(tp->pdev);
|
||
|
return pci_set_power_state(tp->pdev, state);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_wakeup(struct typhoon *tp, int wait_type)
|
||
|
{
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
|
||
|
/* Post 2.x.x versions of the Sleep Image require a reset before
|
||
|
* we can download the Runtime Image. But let's not make users of
|
||
|
* the old firmware pay for the reset.
|
||
|
*/
|
||
|
iowrite32(TYPHOON_BOOTCMD_WAKEUP, ioaddr + TYPHOON_REG_COMMAND);
|
||
|
if (typhoon_wait_status(ioaddr, TYPHOON_STATUS_WAITING_FOR_HOST) < 0 ||
|
||
|
(tp->capabilities & TYPHOON_WAKEUP_NEEDS_RESET))
|
||
|
return typhoon_reset(ioaddr, wait_type);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_start_runtime(struct typhoon *tp)
|
||
|
{
|
||
|
struct net_device *dev = tp->dev;
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
int err;
|
||
|
|
||
|
typhoon_init_rings(tp);
|
||
|
typhoon_fill_free_ring(tp);
|
||
|
|
||
|
err = typhoon_download_firmware(tp);
|
||
|
if (err < 0) {
|
||
|
netdev_err(tp->dev, "cannot load runtime on 3XP\n");
|
||
|
goto error_out;
|
||
|
}
|
||
|
|
||
|
if (typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_BOOT) < 0) {
|
||
|
netdev_err(tp->dev, "cannot boot 3XP\n");
|
||
|
err = -EIO;
|
||
|
goto error_out;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_SET_MAX_PKT_SIZE);
|
||
|
xp_cmd.parm1 = cpu_to_le16(PKT_BUF_SZ);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_SET_MAC_ADDRESS);
|
||
|
xp_cmd.parm1 = cpu_to_le16(ntohs(*(__be16 *)&dev->dev_addr[0]));
|
||
|
xp_cmd.parm2 = cpu_to_le32(ntohl(*(__be32 *)&dev->dev_addr[2]));
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
/* Disable IRQ coalescing -- we can reenable it when 3Com gives
|
||
|
* us some more information on how to control it.
|
||
|
*/
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_IRQ_COALESCE_CTRL);
|
||
|
xp_cmd.parm1 = 0;
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_XCVR_SELECT);
|
||
|
xp_cmd.parm1 = tp->xcvr_select;
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_VLAN_TYPE_WRITE);
|
||
|
xp_cmd.parm1 = cpu_to_le16(ETH_P_8021Q);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_SET_OFFLOAD_TASKS);
|
||
|
xp_cmd.parm2 = tp->offload;
|
||
|
xp_cmd.parm3 = tp->offload;
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
typhoon_set_rx_mode(dev);
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_TX_ENABLE);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_RX_ENABLE);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
if (err < 0)
|
||
|
goto error_out;
|
||
|
|
||
|
tp->card_state = Running;
|
||
|
smp_wmb();
|
||
|
|
||
|
iowrite32(TYPHOON_INTR_ENABLE_ALL, ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
iowrite32(TYPHOON_INTR_NONE, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
typhoon_post_pci_writes(ioaddr);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
error_out:
|
||
|
typhoon_reset(ioaddr, WaitNoSleep);
|
||
|
typhoon_free_rx_rings(tp);
|
||
|
typhoon_init_rings(tp);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_stop_runtime(struct typhoon *tp, int wait_type)
|
||
|
{
|
||
|
struct typhoon_indexes *indexes = tp->indexes;
|
||
|
struct transmit_ring *txLo = &tp->txLoRing;
|
||
|
void __iomem *ioaddr = tp->ioaddr;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
int i;
|
||
|
|
||
|
/* Disable interrupts early, since we can't schedule a poll
|
||
|
* when called with !netif_running(). This will be posted
|
||
|
* when we force the posting of the command.
|
||
|
*/
|
||
|
iowrite32(TYPHOON_INTR_NONE, ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_RX_DISABLE);
|
||
|
typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
|
||
|
/* Wait 1/2 sec for any outstanding transmits to occur
|
||
|
* We'll cleanup after the reset if this times out.
|
||
|
*/
|
||
|
for (i = 0; i < TYPHOON_WAIT_TIMEOUT; i++) {
|
||
|
if (indexes->txLoCleared == cpu_to_le32(txLo->lastWrite))
|
||
|
break;
|
||
|
udelay(TYPHOON_UDELAY);
|
||
|
}
|
||
|
|
||
|
if (i == TYPHOON_WAIT_TIMEOUT)
|
||
|
netdev_err(tp->dev, "halt timed out waiting for Tx to complete\n");
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_TX_DISABLE);
|
||
|
typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
|
||
|
/* save the statistics so when we bring the interface up again,
|
||
|
* the values reported to userspace are correct.
|
||
|
*/
|
||
|
tp->card_state = Sleeping;
|
||
|
smp_wmb();
|
||
|
typhoon_do_get_stats(tp);
|
||
|
memcpy(&tp->stats_saved, &tp->dev->stats, sizeof(struct net_device_stats));
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_HALT);
|
||
|
typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL);
|
||
|
|
||
|
if (typhoon_wait_status(ioaddr, TYPHOON_STATUS_HALTED) < 0)
|
||
|
netdev_err(tp->dev, "timed out waiting for 3XP to halt\n");
|
||
|
|
||
|
if (typhoon_reset(ioaddr, wait_type) < 0) {
|
||
|
netdev_err(tp->dev, "unable to reset 3XP\n");
|
||
|
return -ETIMEDOUT;
|
||
|
}
|
||
|
|
||
|
/* cleanup any outstanding Tx packets */
|
||
|
if (indexes->txLoCleared != cpu_to_le32(txLo->lastWrite)) {
|
||
|
indexes->txLoCleared = cpu_to_le32(txLo->lastWrite);
|
||
|
typhoon_clean_tx(tp, &tp->txLoRing, &indexes->txLoCleared);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_tx_timeout(struct net_device *dev, unsigned int txqueue)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
|
||
|
if (typhoon_reset(tp->ioaddr, WaitNoSleep) < 0) {
|
||
|
netdev_warn(dev, "could not reset in tx timeout\n");
|
||
|
goto truly_dead;
|
||
|
}
|
||
|
|
||
|
/* If we ever start using the Hi ring, it will need cleaning too */
|
||
|
typhoon_clean_tx(tp, &tp->txLoRing, &tp->indexes->txLoCleared);
|
||
|
typhoon_free_rx_rings(tp);
|
||
|
|
||
|
if (typhoon_start_runtime(tp) < 0) {
|
||
|
netdev_err(dev, "could not start runtime in tx timeout\n");
|
||
|
goto truly_dead;
|
||
|
}
|
||
|
|
||
|
netif_wake_queue(dev);
|
||
|
return;
|
||
|
|
||
|
truly_dead:
|
||
|
/* Reset the hardware, and turn off carrier to avoid more timeouts */
|
||
|
typhoon_reset(tp->ioaddr, NoWait);
|
||
|
netif_carrier_off(dev);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_open(struct net_device *dev)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
int err;
|
||
|
|
||
|
err = typhoon_request_firmware(tp);
|
||
|
if (err)
|
||
|
goto out;
|
||
|
|
||
|
pci_set_power_state(tp->pdev, PCI_D0);
|
||
|
pci_restore_state(tp->pdev);
|
||
|
|
||
|
err = typhoon_wakeup(tp, WaitSleep);
|
||
|
if (err < 0) {
|
||
|
netdev_err(dev, "unable to wakeup device\n");
|
||
|
goto out_sleep;
|
||
|
}
|
||
|
|
||
|
err = request_irq(dev->irq, typhoon_interrupt, IRQF_SHARED,
|
||
|
dev->name, dev);
|
||
|
if (err < 0)
|
||
|
goto out_sleep;
|
||
|
|
||
|
napi_enable(&tp->napi);
|
||
|
|
||
|
err = typhoon_start_runtime(tp);
|
||
|
if (err < 0) {
|
||
|
napi_disable(&tp->napi);
|
||
|
goto out_irq;
|
||
|
}
|
||
|
|
||
|
netif_start_queue(dev);
|
||
|
return 0;
|
||
|
|
||
|
out_irq:
|
||
|
free_irq(dev->irq, dev);
|
||
|
|
||
|
out_sleep:
|
||
|
if (typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_HOST) < 0) {
|
||
|
netdev_err(dev, "unable to reboot into sleep img\n");
|
||
|
typhoon_reset(tp->ioaddr, NoWait);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (typhoon_sleep(tp, PCI_D3hot, 0) < 0)
|
||
|
netdev_err(dev, "unable to go back to sleep\n");
|
||
|
|
||
|
out:
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_close(struct net_device *dev)
|
||
|
{
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
|
||
|
netif_stop_queue(dev);
|
||
|
napi_disable(&tp->napi);
|
||
|
|
||
|
if (typhoon_stop_runtime(tp, WaitSleep) < 0)
|
||
|
netdev_err(dev, "unable to stop runtime\n");
|
||
|
|
||
|
/* Make sure there is no irq handler running on a different CPU. */
|
||
|
free_irq(dev->irq, dev);
|
||
|
|
||
|
typhoon_free_rx_rings(tp);
|
||
|
typhoon_init_rings(tp);
|
||
|
|
||
|
if (typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_HOST) < 0)
|
||
|
netdev_err(dev, "unable to boot sleep image\n");
|
||
|
|
||
|
if (typhoon_sleep(tp, PCI_D3hot, 0) < 0)
|
||
|
netdev_err(dev, "unable to put card to sleep\n");
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int __maybe_unused
|
||
|
typhoon_resume(struct device *dev_d)
|
||
|
{
|
||
|
struct net_device *dev = dev_get_drvdata(dev_d);
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
|
||
|
/* If we're down, resume when we are upped.
|
||
|
*/
|
||
|
if (!netif_running(dev))
|
||
|
return 0;
|
||
|
|
||
|
if (typhoon_wakeup(tp, WaitNoSleep) < 0) {
|
||
|
netdev_err(dev, "critical: could not wake up in resume\n");
|
||
|
goto reset;
|
||
|
}
|
||
|
|
||
|
if (typhoon_start_runtime(tp) < 0) {
|
||
|
netdev_err(dev, "critical: could not start runtime in resume\n");
|
||
|
goto reset;
|
||
|
}
|
||
|
|
||
|
netif_device_attach(dev);
|
||
|
return 0;
|
||
|
|
||
|
reset:
|
||
|
typhoon_reset(tp->ioaddr, NoWait);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
|
||
|
static int __maybe_unused
|
||
|
typhoon_suspend(struct device *dev_d)
|
||
|
{
|
||
|
struct pci_dev *pdev = to_pci_dev(dev_d);
|
||
|
struct net_device *dev = pci_get_drvdata(pdev);
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
struct cmd_desc xp_cmd;
|
||
|
|
||
|
/* If we're down, we're already suspended.
|
||
|
*/
|
||
|
if (!netif_running(dev))
|
||
|
return 0;
|
||
|
|
||
|
/* TYPHOON_OFFLOAD_VLAN is always on now, so this doesn't work */
|
||
|
if (tp->wol_events & TYPHOON_WAKE_MAGIC_PKT)
|
||
|
netdev_warn(dev, "cannot do WAKE_MAGIC with VLAN offloading\n");
|
||
|
|
||
|
netif_device_detach(dev);
|
||
|
|
||
|
if (typhoon_stop_runtime(tp, WaitNoSleep) < 0) {
|
||
|
netdev_err(dev, "unable to stop runtime\n");
|
||
|
goto need_resume;
|
||
|
}
|
||
|
|
||
|
typhoon_free_rx_rings(tp);
|
||
|
typhoon_init_rings(tp);
|
||
|
|
||
|
if (typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_HOST) < 0) {
|
||
|
netdev_err(dev, "unable to boot sleep image\n");
|
||
|
goto need_resume;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_SET_MAC_ADDRESS);
|
||
|
xp_cmd.parm1 = cpu_to_le16(ntohs(*(__be16 *)&dev->dev_addr[0]));
|
||
|
xp_cmd.parm2 = cpu_to_le32(ntohl(*(__be32 *)&dev->dev_addr[2]));
|
||
|
if (typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL) < 0) {
|
||
|
netdev_err(dev, "unable to set mac address in suspend\n");
|
||
|
goto need_resume;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_NO_RESPONSE(&xp_cmd, TYPHOON_CMD_SET_RX_FILTER);
|
||
|
xp_cmd.parm1 = TYPHOON_RX_FILTER_DIRECTED | TYPHOON_RX_FILTER_BROADCAST;
|
||
|
if (typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL) < 0) {
|
||
|
netdev_err(dev, "unable to set rx filter in suspend\n");
|
||
|
goto need_resume;
|
||
|
}
|
||
|
|
||
|
if (typhoon_sleep_early(tp, tp->wol_events) < 0) {
|
||
|
netdev_err(dev, "unable to put card to sleep\n");
|
||
|
goto need_resume;
|
||
|
}
|
||
|
|
||
|
device_wakeup_enable(dev_d);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
need_resume:
|
||
|
typhoon_resume(dev_d);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
typhoon_test_mmio(struct pci_dev *pdev)
|
||
|
{
|
||
|
void __iomem *ioaddr = pci_iomap(pdev, 1, 128);
|
||
|
int mode = 0;
|
||
|
u32 val;
|
||
|
|
||
|
if (!ioaddr)
|
||
|
goto out;
|
||
|
|
||
|
if (ioread32(ioaddr + TYPHOON_REG_STATUS) !=
|
||
|
TYPHOON_STATUS_WAITING_FOR_HOST)
|
||
|
goto out_unmap;
|
||
|
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
|
||
|
/* Ok, see if we can change our interrupt status register by
|
||
|
* sending ourselves an interrupt. If so, then MMIO works.
|
||
|
* The 50usec delay is arbitrary -- it could probably be smaller.
|
||
|
*/
|
||
|
val = ioread32(ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
if ((val & TYPHOON_INTR_SELF) == 0) {
|
||
|
iowrite32(1, ioaddr + TYPHOON_REG_SELF_INTERRUPT);
|
||
|
ioread32(ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
udelay(50);
|
||
|
val = ioread32(ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
if (val & TYPHOON_INTR_SELF)
|
||
|
mode = 1;
|
||
|
}
|
||
|
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_MASK);
|
||
|
iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
iowrite32(TYPHOON_INTR_NONE, ioaddr + TYPHOON_REG_INTR_ENABLE);
|
||
|
ioread32(ioaddr + TYPHOON_REG_INTR_STATUS);
|
||
|
|
||
|
out_unmap:
|
||
|
pci_iounmap(pdev, ioaddr);
|
||
|
|
||
|
out:
|
||
|
if (!mode)
|
||
|
pr_info("%s: falling back to port IO\n", pci_name(pdev));
|
||
|
return mode;
|
||
|
}
|
||
|
|
||
|
#if MAX_SKB_FRAGS > 32
|
||
|
|
||
|
#include <net/vxlan.h>
|
||
|
|
||
|
static netdev_features_t typhoon_features_check(struct sk_buff *skb,
|
||
|
struct net_device *dev,
|
||
|
netdev_features_t features)
|
||
|
{
|
||
|
if (skb_shinfo(skb)->nr_frags > 32 && skb_is_gso(skb))
|
||
|
features &= ~NETIF_F_GSO_MASK;
|
||
|
|
||
|
features = vlan_features_check(skb, features);
|
||
|
return vxlan_features_check(skb, features);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
static const struct net_device_ops typhoon_netdev_ops = {
|
||
|
.ndo_open = typhoon_open,
|
||
|
.ndo_stop = typhoon_close,
|
||
|
#if MAX_SKB_FRAGS > 32
|
||
|
.ndo_features_check = typhoon_features_check,
|
||
|
#endif
|
||
|
.ndo_start_xmit = typhoon_start_tx,
|
||
|
.ndo_set_rx_mode = typhoon_set_rx_mode,
|
||
|
.ndo_tx_timeout = typhoon_tx_timeout,
|
||
|
.ndo_get_stats = typhoon_get_stats,
|
||
|
.ndo_validate_addr = eth_validate_addr,
|
||
|
.ndo_set_mac_address = eth_mac_addr,
|
||
|
};
|
||
|
|
||
|
static int
|
||
|
typhoon_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
|
||
|
{
|
||
|
struct net_device *dev;
|
||
|
struct typhoon *tp;
|
||
|
int card_id = (int) ent->driver_data;
|
||
|
u8 addr[ETH_ALEN] __aligned(4);
|
||
|
void __iomem *ioaddr;
|
||
|
void *shared;
|
||
|
dma_addr_t shared_dma;
|
||
|
struct cmd_desc xp_cmd;
|
||
|
struct resp_desc xp_resp[3];
|
||
|
int err = 0;
|
||
|
const char *err_msg;
|
||
|
|
||
|
dev = alloc_etherdev(sizeof(*tp));
|
||
|
if (dev == NULL) {
|
||
|
err_msg = "unable to alloc new net device";
|
||
|
err = -ENOMEM;
|
||
|
goto error_out;
|
||
|
}
|
||
|
SET_NETDEV_DEV(dev, &pdev->dev);
|
||
|
|
||
|
err = pci_enable_device(pdev);
|
||
|
if (err < 0) {
|
||
|
err_msg = "unable to enable device";
|
||
|
goto error_out_dev;
|
||
|
}
|
||
|
|
||
|
err = pci_set_mwi(pdev);
|
||
|
if (err < 0) {
|
||
|
err_msg = "unable to set MWI";
|
||
|
goto error_out_disable;
|
||
|
}
|
||
|
|
||
|
err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
|
||
|
if (err < 0) {
|
||
|
err_msg = "No usable DMA configuration";
|
||
|
goto error_out_mwi;
|
||
|
}
|
||
|
|
||
|
/* sanity checks on IO and MMIO BARs
|
||
|
*/
|
||
|
if (!(pci_resource_flags(pdev, 0) & IORESOURCE_IO)) {
|
||
|
err_msg = "region #1 not a PCI IO resource, aborting";
|
||
|
err = -ENODEV;
|
||
|
goto error_out_mwi;
|
||
|
}
|
||
|
if (pci_resource_len(pdev, 0) < 128) {
|
||
|
err_msg = "Invalid PCI IO region size, aborting";
|
||
|
err = -ENODEV;
|
||
|
goto error_out_mwi;
|
||
|
}
|
||
|
if (!(pci_resource_flags(pdev, 1) & IORESOURCE_MEM)) {
|
||
|
err_msg = "region #1 not a PCI MMIO resource, aborting";
|
||
|
err = -ENODEV;
|
||
|
goto error_out_mwi;
|
||
|
}
|
||
|
if (pci_resource_len(pdev, 1) < 128) {
|
||
|
err_msg = "Invalid PCI MMIO region size, aborting";
|
||
|
err = -ENODEV;
|
||
|
goto error_out_mwi;
|
||
|
}
|
||
|
|
||
|
err = pci_request_regions(pdev, KBUILD_MODNAME);
|
||
|
if (err < 0) {
|
||
|
err_msg = "could not request regions";
|
||
|
goto error_out_mwi;
|
||
|
}
|
||
|
|
||
|
/* map our registers
|
||
|
*/
|
||
|
if (use_mmio != 0 && use_mmio != 1)
|
||
|
use_mmio = typhoon_test_mmio(pdev);
|
||
|
|
||
|
ioaddr = pci_iomap(pdev, use_mmio, 128);
|
||
|
if (!ioaddr) {
|
||
|
err_msg = "cannot remap registers, aborting";
|
||
|
err = -EIO;
|
||
|
goto error_out_regions;
|
||
|
}
|
||
|
|
||
|
/* allocate pci dma space for rx and tx descriptor rings
|
||
|
*/
|
||
|
shared = dma_alloc_coherent(&pdev->dev, sizeof(struct typhoon_shared),
|
||
|
&shared_dma, GFP_KERNEL);
|
||
|
if (!shared) {
|
||
|
err_msg = "could not allocate DMA memory";
|
||
|
err = -ENOMEM;
|
||
|
goto error_out_remap;
|
||
|
}
|
||
|
|
||
|
dev->irq = pdev->irq;
|
||
|
tp = netdev_priv(dev);
|
||
|
tp->shared = shared;
|
||
|
tp->shared_dma = shared_dma;
|
||
|
tp->pdev = pdev;
|
||
|
tp->tx_pdev = pdev;
|
||
|
tp->ioaddr = ioaddr;
|
||
|
tp->tx_ioaddr = ioaddr;
|
||
|
tp->dev = dev;
|
||
|
|
||
|
/* Init sequence:
|
||
|
* 1) Reset the adapter to clear any bad juju
|
||
|
* 2) Reload the sleep image
|
||
|
* 3) Boot the sleep image
|
||
|
* 4) Get the hardware address.
|
||
|
* 5) Put the card to sleep.
|
||
|
*/
|
||
|
err = typhoon_reset(ioaddr, WaitSleep);
|
||
|
if (err < 0) {
|
||
|
err_msg = "could not reset 3XP";
|
||
|
goto error_out_dma;
|
||
|
}
|
||
|
|
||
|
/* Now that we've reset the 3XP and are sure it's not going to
|
||
|
* write all over memory, enable bus mastering, and save our
|
||
|
* state for resuming after a suspend.
|
||
|
*/
|
||
|
pci_set_master(pdev);
|
||
|
pci_save_state(pdev);
|
||
|
|
||
|
typhoon_init_interface(tp);
|
||
|
typhoon_init_rings(tp);
|
||
|
|
||
|
err = typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_HOST);
|
||
|
if (err < 0) {
|
||
|
err_msg = "cannot boot 3XP sleep image";
|
||
|
goto error_out_reset;
|
||
|
}
|
||
|
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_READ_MAC_ADDRESS);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 1, xp_resp);
|
||
|
if (err < 0) {
|
||
|
err_msg = "cannot read MAC address";
|
||
|
goto error_out_reset;
|
||
|
}
|
||
|
|
||
|
*(__be16 *)&addr[0] = htons(le16_to_cpu(xp_resp[0].parm1));
|
||
|
*(__be32 *)&addr[2] = htonl(le32_to_cpu(xp_resp[0].parm2));
|
||
|
eth_hw_addr_set(dev, addr);
|
||
|
|
||
|
if (!is_valid_ether_addr(dev->dev_addr)) {
|
||
|
err_msg = "Could not obtain valid ethernet address, aborting";
|
||
|
err = -EIO;
|
||
|
goto error_out_reset;
|
||
|
}
|
||
|
|
||
|
/* Read the Sleep Image version last, so the response is valid
|
||
|
* later when we print out the version reported.
|
||
|
*/
|
||
|
INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_READ_VERSIONS);
|
||
|
err = typhoon_issue_command(tp, 1, &xp_cmd, 3, xp_resp);
|
||
|
if (err < 0) {
|
||
|
err_msg = "Could not get Sleep Image version";
|
||
|
goto error_out_reset;
|
||
|
}
|
||
|
|
||
|
tp->capabilities = typhoon_card_info[card_id].capabilities;
|
||
|
tp->xcvr_select = TYPHOON_XCVR_AUTONEG;
|
||
|
|
||
|
/* Typhoon 1.0 Sleep Images return one response descriptor to the
|
||
|
* READ_VERSIONS command. Those versions are OK after waking up
|
||
|
* from sleep without needing a reset. Typhoon 1.1+ Sleep Images
|
||
|
* seem to need a little extra help to get started. Since we don't
|
||
|
* know how to nudge it along, just kick it.
|
||
|
*/
|
||
|
if (xp_resp[0].numDesc != 0)
|
||
|
tp->capabilities |= TYPHOON_WAKEUP_NEEDS_RESET;
|
||
|
|
||
|
err = typhoon_sleep(tp, PCI_D3hot, 0);
|
||
|
if (err < 0) {
|
||
|
err_msg = "cannot put adapter to sleep";
|
||
|
goto error_out_reset;
|
||
|
}
|
||
|
|
||
|
/* The chip-specific entries in the device structure. */
|
||
|
dev->netdev_ops = &typhoon_netdev_ops;
|
||
|
netif_napi_add_weight(dev, &tp->napi, typhoon_poll, 16);
|
||
|
dev->watchdog_timeo = TX_TIMEOUT;
|
||
|
|
||
|
dev->ethtool_ops = &typhoon_ethtool_ops;
|
||
|
|
||
|
/* We can handle scatter gather, up to 16 entries, and
|
||
|
* we can do IP checksumming (only version 4, doh...)
|
||
|
*
|
||
|
* There's no way to turn off the RX VLAN offloading and stripping
|
||
|
* on the current 3XP firmware -- it does not respect the offload
|
||
|
* settings -- so we only allow the user to toggle the TX processing.
|
||
|
*/
|
||
|
dev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO |
|
||
|
NETIF_F_HW_VLAN_CTAG_TX;
|
||
|
dev->features = dev->hw_features |
|
||
|
NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_RXCSUM;
|
||
|
|
||
|
err = register_netdev(dev);
|
||
|
if (err < 0) {
|
||
|
err_msg = "unable to register netdev";
|
||
|
goto error_out_reset;
|
||
|
}
|
||
|
|
||
|
pci_set_drvdata(pdev, dev);
|
||
|
|
||
|
netdev_info(dev, "%s at %s 0x%llx, %pM\n",
|
||
|
typhoon_card_info[card_id].name,
|
||
|
use_mmio ? "MMIO" : "IO",
|
||
|
(unsigned long long)pci_resource_start(pdev, use_mmio),
|
||
|
dev->dev_addr);
|
||
|
|
||
|
/* xp_resp still contains the response to the READ_VERSIONS command.
|
||
|
* For debugging, let the user know what version he has.
|
||
|
*/
|
||
|
if (xp_resp[0].numDesc == 0) {
|
||
|
/* This is the Typhoon 1.0 type Sleep Image, last 16 bits
|
||
|
* of version is Month/Day of build.
|
||
|
*/
|
||
|
u16 monthday = le32_to_cpu(xp_resp[0].parm2) & 0xffff;
|
||
|
netdev_info(dev, "Typhoon 1.0 Sleep Image built %02u/%02u/2000\n",
|
||
|
monthday >> 8, monthday & 0xff);
|
||
|
} else if (xp_resp[0].numDesc == 2) {
|
||
|
/* This is the Typhoon 1.1+ type Sleep Image
|
||
|
*/
|
||
|
u32 sleep_ver = le32_to_cpu(xp_resp[0].parm2);
|
||
|
u8 *ver_string = (u8 *) &xp_resp[1];
|
||
|
ver_string[25] = 0;
|
||
|
netdev_info(dev, "Typhoon 1.1+ Sleep Image version %02x.%03x.%03x %s\n",
|
||
|
sleep_ver >> 24, (sleep_ver >> 12) & 0xfff,
|
||
|
sleep_ver & 0xfff, ver_string);
|
||
|
} else {
|
||
|
netdev_warn(dev, "Unknown Sleep Image version (%u:%04x)\n",
|
||
|
xp_resp[0].numDesc, le32_to_cpu(xp_resp[0].parm2));
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
error_out_reset:
|
||
|
typhoon_reset(ioaddr, NoWait);
|
||
|
|
||
|
error_out_dma:
|
||
|
dma_free_coherent(&pdev->dev, sizeof(struct typhoon_shared), shared,
|
||
|
shared_dma);
|
||
|
error_out_remap:
|
||
|
pci_iounmap(pdev, ioaddr);
|
||
|
error_out_regions:
|
||
|
pci_release_regions(pdev);
|
||
|
error_out_mwi:
|
||
|
pci_clear_mwi(pdev);
|
||
|
error_out_disable:
|
||
|
pci_disable_device(pdev);
|
||
|
error_out_dev:
|
||
|
free_netdev(dev);
|
||
|
error_out:
|
||
|
pr_err("%s: %s\n", pci_name(pdev), err_msg);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
typhoon_remove_one(struct pci_dev *pdev)
|
||
|
{
|
||
|
struct net_device *dev = pci_get_drvdata(pdev);
|
||
|
struct typhoon *tp = netdev_priv(dev);
|
||
|
|
||
|
unregister_netdev(dev);
|
||
|
pci_set_power_state(pdev, PCI_D0);
|
||
|
pci_restore_state(pdev);
|
||
|
typhoon_reset(tp->ioaddr, NoWait);
|
||
|
pci_iounmap(pdev, tp->ioaddr);
|
||
|
dma_free_coherent(&pdev->dev, sizeof(struct typhoon_shared),
|
||
|
tp->shared, tp->shared_dma);
|
||
|
pci_release_regions(pdev);
|
||
|
pci_clear_mwi(pdev);
|
||
|
pci_disable_device(pdev);
|
||
|
free_netdev(dev);
|
||
|
}
|
||
|
|
||
|
static SIMPLE_DEV_PM_OPS(typhoon_pm_ops, typhoon_suspend, typhoon_resume);
|
||
|
|
||
|
static struct pci_driver typhoon_driver = {
|
||
|
.name = KBUILD_MODNAME,
|
||
|
.id_table = typhoon_pci_tbl,
|
||
|
.probe = typhoon_init_one,
|
||
|
.remove = typhoon_remove_one,
|
||
|
.driver.pm = &typhoon_pm_ops,
|
||
|
};
|
||
|
|
||
|
static int __init
|
||
|
typhoon_init(void)
|
||
|
{
|
||
|
return pci_register_driver(&typhoon_driver);
|
||
|
}
|
||
|
|
||
|
static void __exit
|
||
|
typhoon_cleanup(void)
|
||
|
{
|
||
|
release_firmware(typhoon_fw);
|
||
|
pci_unregister_driver(&typhoon_driver);
|
||
|
}
|
||
|
|
||
|
module_init(typhoon_init);
|
||
|
module_exit(typhoon_cleanup);
|