|  | /* 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: | 
|  | *) The current firmware always strips the VLAN tag off, even if | 
|  | we tell it not to. You should filter VLANs at the switch | 
|  | as a workaround (good practice in any event) until we can | 
|  | get this fixed. | 
|  | *) 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 DRV_MODULE_NAME		"typhoon" | 
|  | #define DRV_MODULE_VERSION 	"1.5.8" | 
|  | #define DRV_MODULE_RELDATE	"06/11/09" | 
|  | #define PFX			DRV_MODULE_NAME ": " | 
|  | #define ERR_PFX			KERN_ERR PFX | 
|  |  | 
|  | #include <linux/module.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/string.h> | 
|  | #include <linux/timer.h> | 
|  | #include <linux/errno.h> | 
|  | #include <linux/ioport.h> | 
|  | #include <linux/slab.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 <asm/uaccess.h> | 
|  | #include <linux/in6.h> | 
|  | #include <linux/dma-mapping.h> | 
|  |  | 
|  | #include "typhoon.h" | 
|  | #include "typhoon-firmware.h" | 
|  |  | 
|  | static char version[] __devinitdata = | 
|  | "typhoon.c: version " DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n"; | 
|  |  | 
|  | MODULE_AUTHOR("David Dillow <dave@thedillows.org>"); | 
|  | MODULE_VERSION(DRV_MODULE_VERSION); | 
|  | MODULE_LICENSE("GPL"); | 
|  | 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 defined(NETIF_F_TSO) && MAX_SKB_FRAGS > 32 | 
|  | #warning Typhoon only supports 32 entries in its SG list for TSO, disabling TSO | 
|  | #undef NETIF_F_TSO | 
|  | #endif | 
|  |  | 
|  | #if TXLO_ENTRIES <= (2 * MAX_SKB_FRAGS) | 
|  | #error TX ring too small! | 
|  | #endif | 
|  |  | 
|  | struct typhoon_card_info { | 
|  | char *name; | 
|  | 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[] __devinitdata = { | 
|  | { "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 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]; | 
|  | } __attribute__ ((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; | 
|  | spinlock_t		state_lock; | 
|  | struct vlan_group *	vlgrp; | 
|  | 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; | 
|  | struct net_device_stats	stats_saved; | 
|  | const char *		name; | 
|  | 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 updateing */ | 
|  | 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); | 
|  | smp_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 { | 
|  | printk(KERN_ERR "%s: dumping unexpected response " | 
|  | "0x%04x:%d:0x%02x:0x%04x:%08x:%08x\n", | 
|  | tp->name, 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) { | 
|  | printk("%s: no descs for cmd, had (needed) %d (%d) cmd, " | 
|  | "%d (%d) resp\n", tp->name, 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 void | 
|  | typhoon_vlan_rx_register(struct net_device *dev, struct vlan_group *grp) | 
|  | { | 
|  | struct typhoon *tp = netdev_priv(dev); | 
|  | struct cmd_desc xp_cmd; | 
|  | int err; | 
|  |  | 
|  | spin_lock_bh(&tp->state_lock); | 
|  | if(!tp->vlgrp != !grp) { | 
|  | /* We've either been turned on for the first time, or we've | 
|  | * been turned off. Update the 3XP. | 
|  | */ | 
|  | if(grp) | 
|  | tp->offload |= TYPHOON_OFFLOAD_VLAN; | 
|  | else | 
|  | tp->offload &= ~TYPHOON_OFFLOAD_VLAN; | 
|  |  | 
|  | /* If the interface is up, the runtime is running -- and we | 
|  | * must be up for the vlan core to call us. | 
|  | * | 
|  | * Do the command outside of the spin lock, as it is slow. | 
|  | */ | 
|  | INIT_COMMAND_WITH_RESPONSE(&xp_cmd, | 
|  | TYPHOON_CMD_SET_OFFLOAD_TASKS); | 
|  | xp_cmd.parm2 = tp->offload; | 
|  | xp_cmd.parm3 = tp->offload; | 
|  | spin_unlock_bh(&tp->state_lock); | 
|  | err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL); | 
|  | if(err < 0) | 
|  | printk("%s: vlan offload error %d\n", tp->name, -err); | 
|  | spin_lock_bh(&tp->state_lock); | 
|  | } | 
|  |  | 
|  | /* now make the change visible */ | 
|  | tp->vlgrp = grp; | 
|  | spin_unlock_bh(&tp->state_lock); | 
|  | } | 
|  |  | 
|  | 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 int | 
|  | 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(vlan_tx_tag_present(skb)) { | 
|  | first_txd->processFlags |= | 
|  | TYPHOON_TX_PF_INSERT_VLAN | TYPHOON_TX_PF_VLAN_PRIORITY; | 
|  | first_txd->processFlags |= | 
|  | cpu_to_le32(ntohs(vlan_tx_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 = pci_map_single(tp->tx_pdev, skb->data, skb->len, | 
|  | PCI_DMA_TODEVICE); | 
|  | 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 = pci_map_single(tp->tx_pdev, skb->data, len, | 
|  | PCI_DMA_TODEVICE); | 
|  | 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++) { | 
|  | 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 = frag->size; | 
|  | frag_addr = (void *) page_address(frag->page) + | 
|  | frag->page_offset; | 
|  | skb_dma = pci_map_single(tp->tx_pdev, frag_addr, len, | 
|  | PCI_DMA_TODEVICE); | 
|  | 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); | 
|  |  | 
|  | dev->trans_start = jiffies; | 
|  |  | 
|  | /* 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 inbetween, 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 0; | 
|  | } | 
|  |  | 
|  | 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((dev->mc_count > multicast_filter_limit) || | 
|  | (dev->flags & IFF_ALLMULTI)) { | 
|  | /* Too many to match, or accept all multicasts. */ | 
|  | filter |= TYPHOON_RX_FILTER_ALL_MCAST; | 
|  | } else if(dev->mc_count) { | 
|  | struct dev_mc_list *mclist; | 
|  | int i; | 
|  |  | 
|  | memset(mc_filter, 0, sizeof(mc_filter)); | 
|  | for(i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count; | 
|  | i++, mclist = mclist->next) { | 
|  | int bit = ether_crc(ETH_ALEN, mclist->dmi_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_NO_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->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); | 
|  | stats->tx_bytes = le64_to_cpu(s->txBytes); | 
|  | stats->tx_errors = le32_to_cpu(s->txCarrierLost); | 
|  | stats->tx_carrier_errors = le32_to_cpu(s->txCarrierLost); | 
|  | stats->collisions = le32_to_cpu(s->txMultipleCollisions); | 
|  | stats->rx_packets = le32_to_cpu(s->rxPacketsGood); | 
|  | stats->rx_bytes = le64_to_cpu(s->rxBytesGood); | 
|  | stats->rx_fifo_errors = le32_to_cpu(s->rxFifoOverruns); | 
|  | stats->rx_errors = le32_to_cpu(s->rxFifoOverruns) + | 
|  | le32_to_cpu(s->BadSSD) + le32_to_cpu(s->rxCrcErrors); | 
|  | stats->rx_crc_errors = le32_to_cpu(s->rxCrcErrors); | 
|  | stats->rx_length_errors = le32_to_cpu(s->rxOversized); | 
|  | tp->speed = (s->linkStatus & TYPHOON_LINK_100MBPS) ? | 
|  | SPEED_100 : SPEED_10; | 
|  | tp->duplex = (s->linkStatus & TYPHOON_LINK_FULL_DUPLEX) ? | 
|  | DUPLEX_FULL : DUPLEX_HALF; | 
|  |  | 
|  | /* add in the saved statistics | 
|  | */ | 
|  | stats->tx_packets += saved->tx_packets; | 
|  | stats->tx_bytes += saved->tx_bytes; | 
|  | stats->tx_errors += saved->tx_errors; | 
|  | stats->collisions += saved->collisions; | 
|  | stats->rx_packets += saved->rx_packets; | 
|  | stats->rx_bytes += saved->rx_bytes; | 
|  | stats->rx_fifo_errors += saved->rx_fifo_errors; | 
|  | stats->rx_errors += saved->rx_errors; | 
|  | stats->rx_crc_errors += saved->rx_crc_errors; | 
|  | stats->rx_length_errors += saved->rx_length_errors; | 
|  |  | 
|  | 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->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) { | 
|  | printk(KERN_ERR "%s: error getting stats\n", dev->name); | 
|  | return saved; | 
|  | } | 
|  |  | 
|  | return stats; | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_set_mac_address(struct net_device *dev, void *addr) | 
|  | { | 
|  | struct sockaddr *saddr = (struct sockaddr *) addr; | 
|  |  | 
|  | if(netif_running(dev)) | 
|  | return -EBUSY; | 
|  |  | 
|  | memcpy(dev->dev_addr, saddr->sa_data, dev->addr_len); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | 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) { | 
|  | strcpy(info->fw_version, "Sleep image"); | 
|  | } else { | 
|  | INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_READ_VERSIONS); | 
|  | if(typhoon_issue_command(tp, 1, &xp_cmd, 3, xp_resp) < 0) { | 
|  | strcpy(info->fw_version, "Unknown runtime"); | 
|  | } else { | 
|  | u32 sleep_ver = le32_to_cpu(xp_resp[0].parm2); | 
|  | snprintf(info->fw_version, 32, "%02x.%03x.%03x", | 
|  | sleep_ver >> 24, (sleep_ver >> 12) & 0xfff, | 
|  | sleep_ver & 0xfff); | 
|  | } | 
|  | } | 
|  |  | 
|  | strcpy(info->driver, DRV_MODULE_NAME); | 
|  | strcpy(info->version, DRV_MODULE_VERSION); | 
|  | strcpy(info->bus_info, pci_name(pci_dev)); | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) | 
|  | { | 
|  | struct typhoon *tp = netdev_priv(dev); | 
|  |  | 
|  | cmd->supported = SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | | 
|  | SUPPORTED_Autoneg; | 
|  |  | 
|  | switch (tp->xcvr_select) { | 
|  | case TYPHOON_XCVR_10HALF: | 
|  | cmd->advertising = ADVERTISED_10baseT_Half; | 
|  | break; | 
|  | case TYPHOON_XCVR_10FULL: | 
|  | cmd->advertising = ADVERTISED_10baseT_Full; | 
|  | break; | 
|  | case TYPHOON_XCVR_100HALF: | 
|  | cmd->advertising = ADVERTISED_100baseT_Half; | 
|  | break; | 
|  | case TYPHOON_XCVR_100FULL: | 
|  | cmd->advertising = ADVERTISED_100baseT_Full; | 
|  | break; | 
|  | case TYPHOON_XCVR_AUTONEG: | 
|  | cmd->advertising = ADVERTISED_10baseT_Half | | 
|  | ADVERTISED_10baseT_Full | | 
|  | ADVERTISED_100baseT_Half | | 
|  | ADVERTISED_100baseT_Full | | 
|  | ADVERTISED_Autoneg; | 
|  | break; | 
|  | } | 
|  |  | 
|  | if(tp->capabilities & TYPHOON_FIBER) { | 
|  | cmd->supported |= SUPPORTED_FIBRE; | 
|  | cmd->advertising |= ADVERTISED_FIBRE; | 
|  | cmd->port = PORT_FIBRE; | 
|  | } else { | 
|  | cmd->supported |= SUPPORTED_10baseT_Half | | 
|  | SUPPORTED_10baseT_Full | | 
|  | SUPPORTED_TP; | 
|  | cmd->advertising |= ADVERTISED_TP; | 
|  | cmd->port = PORT_TP; | 
|  | } | 
|  |  | 
|  | /* need to get stats to make these link speed/duplex valid */ | 
|  | typhoon_do_get_stats(tp); | 
|  | cmd->speed = tp->speed; | 
|  | cmd->duplex = tp->duplex; | 
|  | cmd->phy_address = 0; | 
|  | cmd->transceiver = XCVR_INTERNAL; | 
|  | if(tp->xcvr_select == TYPHOON_XCVR_AUTONEG) | 
|  | cmd->autoneg = AUTONEG_ENABLE; | 
|  | else | 
|  | cmd->autoneg = AUTONEG_DISABLE; | 
|  | cmd->maxtxpkt = 1; | 
|  | cmd->maxrxpkt = 1; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_set_settings(struct net_device *dev, struct ethtool_cmd *cmd) | 
|  | { | 
|  | struct typhoon *tp = netdev_priv(dev); | 
|  | struct cmd_desc xp_cmd; | 
|  | __le16 xcvr; | 
|  | int err; | 
|  |  | 
|  | err = -EINVAL; | 
|  | if(cmd->autoneg == AUTONEG_ENABLE) { | 
|  | xcvr = TYPHOON_XCVR_AUTONEG; | 
|  | } else { | 
|  | if(cmd->duplex == DUPLEX_HALF) { | 
|  | if(cmd->speed == SPEED_10) | 
|  | xcvr = TYPHOON_XCVR_10HALF; | 
|  | else if(cmd->speed == SPEED_100) | 
|  | xcvr = TYPHOON_XCVR_100HALF; | 
|  | else | 
|  | goto out; | 
|  | } else if(cmd->duplex == DUPLEX_FULL) { | 
|  | if(cmd->speed == SPEED_10) | 
|  | xcvr = TYPHOON_XCVR_10FULL; | 
|  | else if(cmd->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->autoneg == AUTONEG_ENABLE) { | 
|  | tp->speed = 0xff;	/* invalid */ | 
|  | tp->duplex = 0xff;	/* invalid */ | 
|  | } else { | 
|  | tp->speed = cmd->speed; | 
|  | tp->duplex = cmd->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 u32 | 
|  | typhoon_get_rx_csum(struct net_device *dev) | 
|  | { | 
|  | /* For now, we don't allow turning off RX checksums. | 
|  | */ | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static void | 
|  | typhoon_get_ringparam(struct net_device *dev, struct ethtool_ringparam *ering) | 
|  | { | 
|  | ering->rx_max_pending = RXENT_ENTRIES; | 
|  | ering->rx_mini_max_pending = 0; | 
|  | ering->rx_jumbo_max_pending = 0; | 
|  | ering->tx_max_pending = TXLO_ENTRIES - 1; | 
|  |  | 
|  | ering->rx_pending = RXENT_ENTRIES; | 
|  | ering->rx_mini_pending = 0; | 
|  | ering->rx_jumbo_pending = 0; | 
|  | ering->tx_pending = TXLO_ENTRIES - 1; | 
|  | } | 
|  |  | 
|  | static const struct ethtool_ops typhoon_ethtool_ops = { | 
|  | .get_settings		= typhoon_get_settings, | 
|  | .set_settings		= typhoon_set_settings, | 
|  | .get_drvinfo		= typhoon_get_drvinfo, | 
|  | .get_wol		= typhoon_get_wol, | 
|  | .set_wol		= typhoon_set_wol, | 
|  | .get_link		= ethtool_op_get_link, | 
|  | .get_rx_csum		= typhoon_get_rx_csum, | 
|  | .set_tx_csum		= ethtool_op_set_tx_csum, | 
|  | .set_sg			= ethtool_op_set_sg, | 
|  | .set_tso		= ethtool_op_set_tso, | 
|  | .get_ringparam		= typhoon_get_ringparam, | 
|  | }; | 
|  |  | 
|  | 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; | 
|  | smp_wmb(); | 
|  |  | 
|  | tp->offload = TYPHOON_OFFLOAD_IP_CHKSUM | TYPHOON_OFFLOAD_TCP_CHKSUM; | 
|  | tp->offload |= TYPHOON_OFFLOAD_UDP_CHKSUM | TSO_OFFLOAD_ON; | 
|  |  | 
|  | spin_lock_init(&tp->command_lock); | 
|  | spin_lock_init(&tp->state_lock); | 
|  | } | 
|  |  | 
|  | 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->cmdRing.lastWrite = 0; | 
|  |  | 
|  | tp->txLoRing.lastRead = 0; | 
|  | tp->txHiRing.lastRead = 0; | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_download_firmware(struct typhoon *tp) | 
|  | { | 
|  | void __iomem *ioaddr = tp->ioaddr; | 
|  | struct pci_dev *pdev = tp->pdev; | 
|  | struct typhoon_file_header *fHdr; | 
|  | struct typhoon_section_header *sHdr; | 
|  | 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; | 
|  |  | 
|  | err = -EINVAL; | 
|  | fHdr = (struct typhoon_file_header *) typhoon_firmware_image; | 
|  | image_data = (u8 *) fHdr; | 
|  |  | 
|  | if(memcmp(fHdr->tag, "TYPHOON", 8)) { | 
|  | printk(KERN_ERR "%s: Invalid firmware image!\n", tp->name); | 
|  | goto err_out; | 
|  | } | 
|  |  | 
|  | /* Cannot just map the firmware image using pci_map_single() as | 
|  | * the firmware is part of the kernel/module image, so we allocate | 
|  | * some consistent memory to copy the sections into, as it is simpler, | 
|  | * and short-lived. If we ever split out and require a userland | 
|  | * firmware loader, then we can revisit this. | 
|  | */ | 
|  | err = -ENOMEM; | 
|  | dpage = pci_alloc_consistent(pdev, PAGE_SIZE, &dpage_dma); | 
|  | if(!dpage) { | 
|  | printk(KERN_ERR "%s: no DMA mem for firmware\n", tp->name); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: card ready timeout\n", tp->name); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: segment ready timeout\n", | 
|  | tp->name); | 
|  | 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, | 
|  | 0)); | 
|  |  | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: final segment ready timeout\n", tp->name); | 
|  | goto err_out_irq; | 
|  | } | 
|  |  | 
|  | iowrite32(TYPHOON_BOOTCMD_DNLD_COMPLETE, ioaddr + TYPHOON_REG_COMMAND); | 
|  |  | 
|  | if(typhoon_wait_status(ioaddr, TYPHOON_STATUS_WAITING_FOR_BOOT) < 0) { | 
|  | printk(KERN_ERR "%s: boot ready timeout, status 0x%0x\n", | 
|  | tp->name, 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); | 
|  |  | 
|  | pci_free_consistent(pdev, 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) { | 
|  | printk(KERN_ERR "%s: boot ready timeout\n", tp->name); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: boot finish timeout (status 0x%x)\n", | 
|  | tp->name, 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); | 
|  | pci_unmap_single(tp->pdev, skb_dma, dma_len, | 
|  | PCI_DMA_TODEVICE); | 
|  | } | 
|  |  | 
|  | 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 = dev_alloc_skb(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 | 
|  |  | 
|  | skb->dev = tp->dev; | 
|  | dma_addr = pci_map_single(tp->pdev, skb->data, | 
|  | PKT_BUF_SZ, PCI_DMA_FROMDEVICE); | 
|  |  | 
|  | /* 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 = dev_alloc_skb(pkt_len + 2)) != NULL) { | 
|  | skb_reserve(new_skb, 2); | 
|  | pci_dma_sync_single_for_cpu(tp->pdev, dma_addr, | 
|  | PKT_BUF_SZ, | 
|  | PCI_DMA_FROMDEVICE); | 
|  | skb_copy_to_linear_data(new_skb, skb->data, pkt_len); | 
|  | pci_dma_sync_single_for_device(tp->pdev, dma_addr, | 
|  | PKT_BUF_SZ, | 
|  | PCI_DMA_FROMDEVICE); | 
|  | skb_put(new_skb, pkt_len); | 
|  | typhoon_recycle_rx_skb(tp, idx); | 
|  | } else { | 
|  | new_skb = skb; | 
|  | skb_put(new_skb, pkt_len); | 
|  | pci_unmap_single(tp->pdev, dma_addr, PKT_BUF_SZ, | 
|  | PCI_DMA_FROMDEVICE); | 
|  | 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 | 
|  | new_skb->ip_summed = CHECKSUM_NONE; | 
|  |  | 
|  | spin_lock(&tp->state_lock); | 
|  | if(tp->vlgrp != NULL && rx->rxStatus & TYPHOON_RX_VLAN) | 
|  | vlan_hwaccel_receive_skb(new_skb, tp->vlgrp, | 
|  | ntohl(rx->vlanTag) & 0xffff); | 
|  | else | 
|  | netif_receive_skb(new_skb); | 
|  | spin_unlock(&tp->state_lock); | 
|  |  | 
|  | 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) { | 
|  | netif_rx_complete(napi); | 
|  | 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 (netif_rx_schedule_prep(&tp->napi)) { | 
|  | iowrite32(TYPHOON_INTR_ALL, ioaddr + TYPHOON_REG_INTR_MASK); | 
|  | typhoon_post_pci_writes(ioaddr); | 
|  | __netif_rx_schedule(&tp->napi); | 
|  | } else { | 
|  | printk(KERN_ERR "%s: Error, poll already scheduled\n", | 
|  | dev->name); | 
|  | } | 
|  | 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) { | 
|  | pci_unmap_single(tp->pdev, rxb->dma_addr, PKT_BUF_SZ, | 
|  | PCI_DMA_FROMDEVICE); | 
|  | dev_kfree_skb(rxb->skb); | 
|  | rxb->skb = NULL; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_sleep(struct typhoon *tp, pci_power_t state, __le16 events) | 
|  | { | 
|  | struct pci_dev *pdev = tp->pdev; | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: typhoon_sleep(): wake events cmd err %d\n", | 
|  | tp->name, 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) { | 
|  | printk(KERN_ERR "%s: typhoon_sleep(): sleep cmd err %d\n", | 
|  | tp->name, 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); | 
|  |  | 
|  | pci_enable_wake(tp->pdev, state, 1); | 
|  | pci_disable_device(pdev); | 
|  | return pci_set_power_state(pdev, state); | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_wakeup(struct typhoon *tp, int wait_type) | 
|  | { | 
|  | struct pci_dev *pdev = tp->pdev; | 
|  | void __iomem *ioaddr = tp->ioaddr; | 
|  |  | 
|  | pci_set_power_state(pdev, PCI_D0); | 
|  | pci_restore_state(pdev); | 
|  |  | 
|  | /* 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) { | 
|  | printk("%s: cannot load runtime on 3XP\n", tp->name); | 
|  | goto error_out; | 
|  | } | 
|  |  | 
|  | if(typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_BOOT) < 0) { | 
|  | printk("%s: cannot boot 3XP\n", tp->name); | 
|  | 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 = __constant_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); | 
|  | spin_lock_bh(&tp->state_lock); | 
|  | xp_cmd.parm2 = tp->offload; | 
|  | xp_cmd.parm3 = tp->offload; | 
|  | err = typhoon_issue_command(tp, 1, &xp_cmd, 0, NULL); | 
|  | spin_unlock_bh(&tp->state_lock); | 
|  | 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) | 
|  | printk(KERN_ERR | 
|  | "%s: halt timed out waiting for Tx to complete\n", | 
|  | tp->name); | 
|  |  | 
|  | 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->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) | 
|  | printk(KERN_ERR "%s: timed out waiting for 3XP to halt\n", | 
|  | tp->name); | 
|  |  | 
|  | if(typhoon_reset(ioaddr, wait_type) < 0) { | 
|  | printk(KERN_ERR "%s: unable to reset 3XP\n", tp->name); | 
|  | 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) | 
|  | { | 
|  | struct typhoon *tp = netdev_priv(dev); | 
|  |  | 
|  | if(typhoon_reset(tp->ioaddr, WaitNoSleep) < 0) { | 
|  | printk(KERN_WARNING "%s: could not reset in tx timeout\n", | 
|  | dev->name); | 
|  | goto truely_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) { | 
|  | printk(KERN_ERR "%s: could not start runtime in tx timeout\n", | 
|  | dev->name); | 
|  | goto truely_dead; | 
|  | } | 
|  |  | 
|  | netif_wake_queue(dev); | 
|  | return; | 
|  |  | 
|  | truely_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_wakeup(tp, WaitSleep); | 
|  | if(err < 0) { | 
|  | printk(KERN_ERR "%s: unable to wakeup device\n", dev->name); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: unable to reboot into sleep img\n", | 
|  | dev->name); | 
|  | typhoon_reset(tp->ioaddr, NoWait); | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if(typhoon_sleep(tp, PCI_D3hot, 0) < 0) | 
|  | printk(KERN_ERR "%s: unable to go back to sleep\n", dev->name); | 
|  |  | 
|  | 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) | 
|  | printk(KERN_ERR "%s: unable to stop runtime\n", dev->name); | 
|  |  | 
|  | /* 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) | 
|  | printk(KERN_ERR "%s: unable to boot sleep image\n", dev->name); | 
|  |  | 
|  | if(typhoon_sleep(tp, PCI_D3hot, 0) < 0) | 
|  | printk(KERN_ERR "%s: unable to put card to sleep\n", dev->name); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_PM | 
|  | static int | 
|  | typhoon_resume(struct pci_dev *pdev) | 
|  | { | 
|  | struct net_device *dev = pci_get_drvdata(pdev); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: critical: could not wake up in resume\n", | 
|  | dev->name); | 
|  | goto reset; | 
|  | } | 
|  |  | 
|  | if(typhoon_start_runtime(tp) < 0) { | 
|  | printk(KERN_ERR "%s: critical: could not start runtime in " | 
|  | "resume\n", dev->name); | 
|  | goto reset; | 
|  | } | 
|  |  | 
|  | netif_device_attach(dev); | 
|  | return 0; | 
|  |  | 
|  | reset: | 
|  | typhoon_reset(tp->ioaddr, NoWait); | 
|  | return -EBUSY; | 
|  | } | 
|  |  | 
|  | static int | 
|  | typhoon_suspend(struct pci_dev *pdev, pm_message_t state) | 
|  | { | 
|  | 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; | 
|  |  | 
|  | spin_lock_bh(&tp->state_lock); | 
|  | if(tp->vlgrp && tp->wol_events & TYPHOON_WAKE_MAGIC_PKT) { | 
|  | spin_unlock_bh(&tp->state_lock); | 
|  | printk(KERN_ERR "%s: cannot do WAKE_MAGIC with VLANS\n", | 
|  | dev->name); | 
|  | return -EBUSY; | 
|  | } | 
|  | spin_unlock_bh(&tp->state_lock); | 
|  |  | 
|  | netif_device_detach(dev); | 
|  |  | 
|  | if(typhoon_stop_runtime(tp, WaitNoSleep) < 0) { | 
|  | printk(KERN_ERR "%s: unable to stop runtime\n", dev->name); | 
|  | goto need_resume; | 
|  | } | 
|  |  | 
|  | typhoon_free_rx_rings(tp); | 
|  | typhoon_init_rings(tp); | 
|  |  | 
|  | if(typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_HOST) < 0) { | 
|  | printk(KERN_ERR "%s: unable to boot sleep image\n", dev->name); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: unable to set mac address in suspend\n", | 
|  | dev->name); | 
|  | 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) { | 
|  | printk(KERN_ERR "%s: unable to set rx filter in suspend\n", | 
|  | dev->name); | 
|  | goto need_resume; | 
|  | } | 
|  |  | 
|  | if(typhoon_sleep(tp, pci_choose_state(pdev, state), tp->wol_events) < 0) { | 
|  | printk(KERN_ERR "%s: unable to put card to sleep\n", dev->name); | 
|  | goto need_resume; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | need_resume: | 
|  | typhoon_resume(pdev); | 
|  | return -EBUSY; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static int __devinit | 
|  | 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) | 
|  | printk(KERN_INFO PFX "falling back to port IO\n"); | 
|  | return mode; | 
|  | } | 
|  |  | 
|  | static const struct net_device_ops typhoon_netdev_ops = { | 
|  | .ndo_open		= typhoon_open, | 
|  | .ndo_stop		= typhoon_close, | 
|  | .ndo_start_xmit		= typhoon_start_tx, | 
|  | .ndo_set_multicast_list	= 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	= typhoon_set_mac_address, | 
|  | .ndo_change_mtu		= eth_change_mtu, | 
|  | .ndo_vlan_rx_register	= typhoon_vlan_rx_register, | 
|  | }; | 
|  |  | 
|  | static int __devinit | 
|  | typhoon_init_one(struct pci_dev *pdev, const struct pci_device_id *ent) | 
|  | { | 
|  | static int did_version = 0; | 
|  | struct net_device *dev; | 
|  | struct typhoon *tp; | 
|  | int card_id = (int) ent->driver_data; | 
|  | void __iomem *ioaddr; | 
|  | void *shared; | 
|  | dma_addr_t shared_dma; | 
|  | struct cmd_desc xp_cmd; | 
|  | struct resp_desc xp_resp[3]; | 
|  | int err = 0; | 
|  |  | 
|  | if(!did_version++) | 
|  | printk(KERN_INFO "%s", version); | 
|  |  | 
|  | dev = alloc_etherdev(sizeof(*tp)); | 
|  | if(dev == NULL) { | 
|  | printk(ERR_PFX "%s: unable to alloc new net device\n", | 
|  | pci_name(pdev)); | 
|  | err = -ENOMEM; | 
|  | goto error_out; | 
|  | } | 
|  | SET_NETDEV_DEV(dev, &pdev->dev); | 
|  |  | 
|  | err = pci_enable_device(pdev); | 
|  | if(err < 0) { | 
|  | printk(ERR_PFX "%s: unable to enable device\n", | 
|  | pci_name(pdev)); | 
|  | goto error_out_dev; | 
|  | } | 
|  |  | 
|  | err = pci_set_mwi(pdev); | 
|  | if(err < 0) { | 
|  | printk(ERR_PFX "%s: unable to set MWI\n", pci_name(pdev)); | 
|  | goto error_out_disable; | 
|  | } | 
|  |  | 
|  | err = pci_set_dma_mask(pdev, DMA_32BIT_MASK); | 
|  | if(err < 0) { | 
|  | printk(ERR_PFX "%s: No usable DMA configuration\n", | 
|  | pci_name(pdev)); | 
|  | goto error_out_mwi; | 
|  | } | 
|  |  | 
|  | /* sanity checks on IO and MMIO BARs | 
|  | */ | 
|  | if(!(pci_resource_flags(pdev, 0) & IORESOURCE_IO)) { | 
|  | printk(ERR_PFX | 
|  | "%s: region #1 not a PCI IO resource, aborting\n", | 
|  | pci_name(pdev)); | 
|  | err = -ENODEV; | 
|  | goto error_out_mwi; | 
|  | } | 
|  | if(pci_resource_len(pdev, 0) < 128) { | 
|  | printk(ERR_PFX "%s: Invalid PCI IO region size, aborting\n", | 
|  | pci_name(pdev)); | 
|  | err = -ENODEV; | 
|  | goto error_out_mwi; | 
|  | } | 
|  | if(!(pci_resource_flags(pdev, 1) & IORESOURCE_MEM)) { | 
|  | printk(ERR_PFX | 
|  | "%s: region #1 not a PCI MMIO resource, aborting\n", | 
|  | pci_name(pdev)); | 
|  | err = -ENODEV; | 
|  | goto error_out_mwi; | 
|  | } | 
|  | if(pci_resource_len(pdev, 1) < 128) { | 
|  | printk(ERR_PFX "%s: Invalid PCI MMIO region size, aborting\n", | 
|  | pci_name(pdev)); | 
|  | err = -ENODEV; | 
|  | goto error_out_mwi; | 
|  | } | 
|  |  | 
|  | err = pci_request_regions(pdev, "typhoon"); | 
|  | if(err < 0) { | 
|  | printk(ERR_PFX "%s: could not request regions\n", | 
|  | pci_name(pdev)); | 
|  | 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) { | 
|  | printk(ERR_PFX "%s: cannot remap registers, aborting\n", | 
|  | pci_name(pdev)); | 
|  | err = -EIO; | 
|  | goto error_out_regions; | 
|  | } | 
|  |  | 
|  | /* allocate pci dma space for rx and tx descriptor rings | 
|  | */ | 
|  | shared = pci_alloc_consistent(pdev, sizeof(struct typhoon_shared), | 
|  | &shared_dma); | 
|  | if(!shared) { | 
|  | printk(ERR_PFX "%s: could not allocate DMA memory\n", | 
|  | pci_name(pdev)); | 
|  | err = -ENOMEM; | 
|  | goto error_out_remap; | 
|  | } | 
|  |  | 
|  | dev->irq = pdev->irq; | 
|  | tp = netdev_priv(dev); | 
|  | tp->shared = (struct typhoon_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. | 
|  | */ | 
|  | if (typhoon_reset(ioaddr, WaitSleep) < 0) { | 
|  | printk(ERR_PFX "%s: could not reset 3XP\n", pci_name(pdev)); | 
|  | err = -EIO; | 
|  | 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); | 
|  |  | 
|  | /* dev->name is not valid until we register, but we need to | 
|  | * use some common routines to initialize the card. So that those | 
|  | * routines print the right name, we keep our oun pointer to the name | 
|  | */ | 
|  | tp->name = pci_name(pdev); | 
|  |  | 
|  | typhoon_init_interface(tp); | 
|  | typhoon_init_rings(tp); | 
|  |  | 
|  | if(typhoon_boot_3XP(tp, TYPHOON_STATUS_WAITING_FOR_HOST) < 0) { | 
|  | printk(ERR_PFX "%s: cannot boot 3XP sleep image\n", | 
|  | pci_name(pdev)); | 
|  | err = -EIO; | 
|  | goto error_out_reset; | 
|  | } | 
|  |  | 
|  | INIT_COMMAND_WITH_RESPONSE(&xp_cmd, TYPHOON_CMD_READ_MAC_ADDRESS); | 
|  | if(typhoon_issue_command(tp, 1, &xp_cmd, 1, xp_resp) < 0) { | 
|  | printk(ERR_PFX "%s: cannot read MAC address\n", | 
|  | pci_name(pdev)); | 
|  | err = -EIO; | 
|  | goto error_out_reset; | 
|  | } | 
|  |  | 
|  | *(__be16 *)&dev->dev_addr[0] = htons(le16_to_cpu(xp_resp[0].parm1)); | 
|  | *(__be32 *)&dev->dev_addr[2] = htonl(le32_to_cpu(xp_resp[0].parm2)); | 
|  |  | 
|  | if(!is_valid_ether_addr(dev->dev_addr)) { | 
|  | printk(ERR_PFX "%s: Could not obtain valid ethernet address, " | 
|  | "aborting\n", pci_name(pdev)); | 
|  | 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); | 
|  | if(typhoon_issue_command(tp, 1, &xp_cmd, 3, xp_resp) < 0) { | 
|  | printk(ERR_PFX "%s: Could not get Sleep Image version\n", | 
|  | pci_name(pdev)); | 
|  | 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; | 
|  |  | 
|  | if(typhoon_sleep(tp, PCI_D3hot, 0) < 0) { | 
|  | printk(ERR_PFX "%s: cannot put adapter to sleep\n", | 
|  | pci_name(pdev)); | 
|  | err = -EIO; | 
|  | goto error_out_reset; | 
|  | } | 
|  |  | 
|  | /* The chip-specific entries in the device structure. */ | 
|  | dev->netdev_ops		= &typhoon_netdev_ops; | 
|  | netif_napi_add(dev, &tp->napi, typhoon_poll, 16); | 
|  | dev->watchdog_timeo	= TX_TIMEOUT; | 
|  |  | 
|  | SET_ETHTOOL_OPS(dev, &typhoon_ethtool_ops); | 
|  |  | 
|  | /* We can handle scatter gather, up to 16 entries, and | 
|  | * we can do IP checksumming (only version 4, doh...) | 
|  | */ | 
|  | dev->features |= NETIF_F_SG | NETIF_F_IP_CSUM; | 
|  | dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX; | 
|  | dev->features |= NETIF_F_TSO; | 
|  |  | 
|  | if(register_netdev(dev) < 0) | 
|  | goto error_out_reset; | 
|  |  | 
|  | /* fixup our local name */ | 
|  | tp->name = dev->name; | 
|  |  | 
|  | pci_set_drvdata(pdev, dev); | 
|  |  | 
|  | printk(KERN_INFO "%s: %s at %s 0x%llx, %pM\n", | 
|  | dev->name, 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; | 
|  | printk(KERN_INFO "%s: Typhoon 1.0 Sleep Image built " | 
|  | "%02u/%02u/2000\n", dev->name, 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; | 
|  | printk(KERN_INFO "%s: Typhoon 1.1+ Sleep Image version " | 
|  | "%02x.%03x.%03x %s\n", dev->name, sleep_ver >> 24, | 
|  | (sleep_ver >> 12) & 0xfff, sleep_ver & 0xfff, | 
|  | ver_string); | 
|  | } else { | 
|  | printk(KERN_WARNING "%s: Unknown Sleep Image version " | 
|  | "(%u:%04x)\n", dev->name, xp_resp[0].numDesc, | 
|  | le32_to_cpu(xp_resp[0].parm2)); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | error_out_reset: | 
|  | typhoon_reset(ioaddr, NoWait); | 
|  |  | 
|  | error_out_dma: | 
|  | pci_free_consistent(pdev, 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: | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static void __devexit | 
|  | 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); | 
|  | pci_free_consistent(pdev, sizeof(struct typhoon_shared), | 
|  | tp->shared, tp->shared_dma); | 
|  | pci_release_regions(pdev); | 
|  | pci_clear_mwi(pdev); | 
|  | pci_disable_device(pdev); | 
|  | pci_set_drvdata(pdev, NULL); | 
|  | free_netdev(dev); | 
|  | } | 
|  |  | 
|  | static struct pci_driver typhoon_driver = { | 
|  | .name		= DRV_MODULE_NAME, | 
|  | .id_table	= typhoon_pci_tbl, | 
|  | .probe		= typhoon_init_one, | 
|  | .remove		= __devexit_p(typhoon_remove_one), | 
|  | #ifdef CONFIG_PM | 
|  | .suspend	= typhoon_suspend, | 
|  | .resume		= typhoon_resume, | 
|  | #endif | 
|  | }; | 
|  |  | 
|  | static int __init | 
|  | typhoon_init(void) | 
|  | { | 
|  | return pci_register_driver(&typhoon_driver); | 
|  | } | 
|  |  | 
|  | static void __exit | 
|  | typhoon_cleanup(void) | 
|  | { | 
|  | pci_unregister_driver(&typhoon_driver); | 
|  | } | 
|  |  | 
|  | module_init(typhoon_init); | 
|  | module_exit(typhoon_cleanup); |