blob: ef84d7c757a080d8f26b3d2576f3d90a490b7052 [file] [log] [blame]
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001/*
Kou Ishizaki3342cf0e2007-02-20 16:36:14 -06002 * Network device driver for Cell Processor-Based Blade and Celleb platform
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07003 *
4 * (C) Copyright IBM Corp. 2005
Kou Ishizaki3342cf0e2007-02-20 16:36:14 -06005 * (C) Copyright 2006 TOSHIBA CORPORATION
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07006 *
7 * Authors : Utz Bacher <utz.bacher@de.ibm.com>
8 * Jens Osterkamp <Jens.Osterkamp@de.ibm.com>
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2, or (at your option)
13 * any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 */
24
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070025#include <linux/compiler.h>
26#include <linux/crc32.h>
27#include <linux/delay.h>
28#include <linux/etherdevice.h>
29#include <linux/ethtool.h>
30#include <linux/firmware.h>
31#include <linux/if_vlan.h>
Arnd Bergmann7c5c2202006-01-12 17:16:45 -050032#include <linux/in.h>
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070033#include <linux/init.h>
34#include <linux/ioport.h>
35#include <linux/ip.h>
36#include <linux/kernel.h>
37#include <linux/mii.h>
38#include <linux/module.h>
39#include <linux/netdevice.h>
40#include <linux/device.h>
41#include <linux/pci.h>
42#include <linux/skbuff.h>
43#include <linux/slab.h>
44#include <linux/tcp.h>
45#include <linux/types.h>
Arnd Bergmann11f1a522006-01-12 17:16:44 -050046#include <linux/vmalloc.h>
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070047#include <linux/wait.h>
48#include <linux/workqueue.h>
49#include <asm/bitops.h>
50#include <asm/pci-bridge.h>
51#include <net/checksum.h>
52
53#include "spider_net.h"
54
55MODULE_AUTHOR("Utz Bacher <utz.bacher@de.ibm.com> and Jens Osterkamp " \
56 "<Jens.Osterkamp@de.ibm.com>");
57MODULE_DESCRIPTION("Spider Southbridge Gigabit Ethernet driver");
58MODULE_LICENSE("GPL");
Linas Vepstas90f10842006-10-10 15:56:04 -050059MODULE_VERSION(VERSION);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070060
61static int rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_DEFAULT;
62static int tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_DEFAULT;
63
Linas Vepstase2874f22006-10-10 15:59:02 -050064module_param(rx_descriptors, int, 0444);
65module_param(tx_descriptors, int, 0444);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070066
67MODULE_PARM_DESC(rx_descriptors, "number of descriptors used " \
68 "in rx chains");
69MODULE_PARM_DESC(tx_descriptors, "number of descriptors used " \
70 "in tx chain");
71
72char spider_net_driver_name[] = "spidernet";
73
74static struct pci_device_id spider_net_pci_tbl[] = {
75 { PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_SPIDER_NET,
76 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL },
77 { 0, }
78};
79
80MODULE_DEVICE_TABLE(pci, spider_net_pci_tbl);
81
82/**
83 * spider_net_read_reg - reads an SMMIO register of a card
84 * @card: device structure
85 * @reg: register to read from
86 *
87 * returns the content of the specified SMMIO register.
88 */
Jens Osterkampbdd01502006-07-13 11:54:08 +020089static inline u32
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070090spider_net_read_reg(struct spider_net_card *card, u32 reg)
91{
Benjamin Herrenschmidt3bc0f402006-11-11 17:25:13 +110092 /* We use the powerpc specific variants instead of readl_be() because
93 * we know spidernet is not a real PCI device and we can thus avoid the
94 * performance hit caused by the PCI workarounds.
95 */
96 return in_be32(card->regs + reg);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -070097}
98
99/**
100 * spider_net_write_reg - writes to an SMMIO register of a card
101 * @card: device structure
102 * @reg: register to write to
103 * @value: value to write into the specified SMMIO register
104 */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200105static inline void
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700106spider_net_write_reg(struct spider_net_card *card, u32 reg, u32 value)
107{
Benjamin Herrenschmidt3bc0f402006-11-11 17:25:13 +1100108 /* We use the powerpc specific variants instead of writel_be() because
109 * we know spidernet is not a real PCI device and we can thus avoid the
110 * performance hit caused by the PCI workarounds.
111 */
112 out_be32(card->regs + reg, value);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700113}
114
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700115/** spider_net_write_phy - write to phy register
116 * @netdev: adapter to be written to
117 * @mii_id: id of MII
118 * @reg: PHY register
119 * @val: value to be written to phy register
120 *
121 * spider_net_write_phy_register writes to an arbitrary PHY
122 * register via the spider GPCWOPCMD register. We assume the queue does
123 * not run full (not more than 15 commands outstanding).
124 **/
125static void
126spider_net_write_phy(struct net_device *netdev, int mii_id,
127 int reg, int val)
128{
129 struct spider_net_card *card = netdev_priv(netdev);
130 u32 writevalue;
131
132 writevalue = ((u32)mii_id << 21) |
133 ((u32)reg << 16) | ((u32)val);
134
135 spider_net_write_reg(card, SPIDER_NET_GPCWOPCMD, writevalue);
136}
137
138/** spider_net_read_phy - read from phy register
139 * @netdev: network device to be read from
140 * @mii_id: id of MII
141 * @reg: PHY register
142 *
143 * Returns value read from PHY register
144 *
145 * spider_net_write_phy reads from an arbitrary PHY
146 * register via the spider GPCROPCMD register
147 **/
148static int
149spider_net_read_phy(struct net_device *netdev, int mii_id, int reg)
150{
151 struct spider_net_card *card = netdev_priv(netdev);
152 u32 readvalue;
153
154 readvalue = ((u32)mii_id << 21) | ((u32)reg << 16);
155 spider_net_write_reg(card, SPIDER_NET_GPCROPCMD, readvalue);
156
157 /* we don't use semaphores to wait for an SPIDER_NET_GPROPCMPINT
158 * interrupt, as we poll for the completion of the read operation
159 * in spider_net_read_phy. Should take about 50 us */
160 do {
161 readvalue = spider_net_read_reg(card, SPIDER_NET_GPCROPCMD);
162 } while (readvalue & SPIDER_NET_GPREXEC);
163
164 readvalue &= SPIDER_NET_GPRDAT_MASK;
165
166 return readvalue;
167}
168
169/**
Kou Ishizakiabdb66b2007-02-20 16:33:41 -0600170 * spider_net_setup_aneg - initial auto-negotiation setup
171 * @card: device structure
172 **/
173static void
174spider_net_setup_aneg(struct spider_net_card *card)
175{
176 struct mii_phy *phy = &card->phy;
177 u32 advertise = 0;
Ishizaki Koua1c38a42007-05-10 12:18:48 -0500178 u16 bmsr, estat;
Kou Ishizakiabdb66b2007-02-20 16:33:41 -0600179
Ishizaki Koua1c38a42007-05-10 12:18:48 -0500180 bmsr = spider_net_read_phy(card->netdev, phy->mii_id, MII_BMSR);
181 estat = spider_net_read_phy(card->netdev, phy->mii_id, MII_ESTATUS);
Kou Ishizakiabdb66b2007-02-20 16:33:41 -0600182
183 if (bmsr & BMSR_10HALF)
184 advertise |= ADVERTISED_10baseT_Half;
185 if (bmsr & BMSR_10FULL)
186 advertise |= ADVERTISED_10baseT_Full;
187 if (bmsr & BMSR_100HALF)
188 advertise |= ADVERTISED_100baseT_Half;
189 if (bmsr & BMSR_100FULL)
190 advertise |= ADVERTISED_100baseT_Full;
191
192 if ((bmsr & BMSR_ESTATEN) && (estat & ESTATUS_1000_TFULL))
193 advertise |= SUPPORTED_1000baseT_Full;
194 if ((bmsr & BMSR_ESTATEN) && (estat & ESTATUS_1000_THALF))
195 advertise |= SUPPORTED_1000baseT_Half;
196
197 mii_phy_probe(phy, phy->mii_id);
198 phy->def->ops->setup_aneg(phy, advertise);
199
200}
201
202/**
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500203 * spider_net_rx_irq_off - switch off rx irq on this spider card
204 * @card: device structure
205 *
206 * switches off rx irq by masking them out in the GHIINTnMSK register
207 */
208static void
209spider_net_rx_irq_off(struct spider_net_card *card)
210{
211 u32 regvalue;
212
213 regvalue = SPIDER_NET_INT0_MASK_VALUE & (~SPIDER_NET_RXINT);
214 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, regvalue);
215}
216
217/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700218 * spider_net_rx_irq_on - switch on rx irq on this spider card
219 * @card: device structure
220 *
221 * switches on rx irq by enabling them in the GHIINTnMSK register
222 */
223static void
224spider_net_rx_irq_on(struct spider_net_card *card)
225{
226 u32 regvalue;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700227
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500228 regvalue = SPIDER_NET_INT0_MASK_VALUE | SPIDER_NET_RXINT;
229 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, regvalue);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700230}
231
232/**
233 * spider_net_set_promisc - sets the unicast address or the promiscuous mode
234 * @card: card structure
235 *
236 * spider_net_set_promisc sets the unicast destination address filter and
237 * thus either allows for non-promisc mode or promisc mode
238 */
239static void
240spider_net_set_promisc(struct spider_net_card *card)
241{
242 u32 macu, macl;
243 struct net_device *netdev = card->netdev;
244
245 if (netdev->flags & IFF_PROMISC) {
246 /* clear destination entry 0 */
247 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR, 0);
248 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR + 0x04, 0);
249 spider_net_write_reg(card, SPIDER_NET_GMRUA0FIL15R,
250 SPIDER_NET_PROMISC_VALUE);
251 } else {
252 macu = netdev->dev_addr[0];
253 macu <<= 8;
254 macu |= netdev->dev_addr[1];
255 memcpy(&macl, &netdev->dev_addr[2], sizeof(macl));
256
257 macu |= SPIDER_NET_UA_DESCR_VALUE;
258 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR, macu);
259 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR + 0x04, macl);
260 spider_net_write_reg(card, SPIDER_NET_GMRUA0FIL15R,
261 SPIDER_NET_NONPROMISC_VALUE);
262 }
263}
264
265/**
266 * spider_net_get_mac_address - read mac address from spider card
267 * @card: device structure
268 *
269 * reads MAC address from GMACUNIMACU and GMACUNIMACL registers
270 */
271static int
272spider_net_get_mac_address(struct net_device *netdev)
273{
274 struct spider_net_card *card = netdev_priv(netdev);
275 u32 macl, macu;
276
277 macl = spider_net_read_reg(card, SPIDER_NET_GMACUNIMACL);
278 macu = spider_net_read_reg(card, SPIDER_NET_GMACUNIMACU);
279
280 netdev->dev_addr[0] = (macu >> 24) & 0xff;
281 netdev->dev_addr[1] = (macu >> 16) & 0xff;
282 netdev->dev_addr[2] = (macu >> 8) & 0xff;
283 netdev->dev_addr[3] = macu & 0xff;
284 netdev->dev_addr[4] = (macl >> 8) & 0xff;
285 netdev->dev_addr[5] = macl & 0xff;
286
287 if (!is_valid_ether_addr(&netdev->dev_addr[0]))
288 return -EINVAL;
289
290 return 0;
291}
292
293/**
294 * spider_net_get_descr_status -- returns the status of a descriptor
295 * @descr: descriptor to look at
296 *
297 * returns the status as in the dmac_cmd_status field of the descriptor
298 */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200299static inline int
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600300spider_net_get_descr_status(struct spider_net_hw_descr *hwdescr)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700301{
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600302 return hwdescr->dmac_cmd_status & SPIDER_NET_DESCR_IND_PROC_MASK;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700303}
304
305/**
306 * spider_net_free_chain - free descriptor chain
307 * @card: card structure
308 * @chain: address of chain
309 *
310 */
311static void
312spider_net_free_chain(struct spider_net_card *card,
313 struct spider_net_descr_chain *chain)
314{
315 struct spider_net_descr *descr;
316
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600317 descr = chain->ring;
318 do {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700319 descr->bus_addr = 0;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600320 descr->hwdescr->next_descr_addr = 0;
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600321 descr = descr->next;
322 } while (descr != chain->ring);
323
324 dma_free_coherent(&card->pdev->dev, chain->num_desc,
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600325 chain->hwring, chain->dma_addr);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700326}
327
328/**
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600329 * spider_net_init_chain - alloc and link descriptor chain
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700330 * @card: card structure
331 * @chain: address of chain
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700332 *
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600333 * We manage a circular list that mirrors the hardware structure,
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700334 * except that the hardware uses bus addresses.
335 *
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600336 * Returns 0 on success, <0 on failure
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700337 */
338static int
339spider_net_init_chain(struct spider_net_card *card,
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600340 struct spider_net_descr_chain *chain)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700341{
342 int i;
343 struct spider_net_descr *descr;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600344 struct spider_net_hw_descr *hwdescr;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500345 dma_addr_t buf;
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600346 size_t alloc_size;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700347
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600348 alloc_size = chain->num_desc * sizeof(struct spider_net_hw_descr);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700349
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600350 chain->hwring = dma_alloc_coherent(&card->pdev->dev, alloc_size,
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600351 &chain->dma_addr, GFP_KERNEL);
352
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600353 if (!chain->hwring)
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600354 return -ENOMEM;
355
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600356 memset(chain->ring, 0, chain->num_desc * sizeof(struct spider_net_descr));
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600357
358 /* Set up the hardware pointers in each descriptor */
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600359 descr = chain->ring;
360 hwdescr = chain->hwring;
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600361 buf = chain->dma_addr;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600362 for (i=0; i < chain->num_desc; i++, descr++, hwdescr++) {
363 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE;
364 hwdescr->next_descr_addr = 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700365
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600366 descr->hwdescr = hwdescr;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500367 descr->bus_addr = buf;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700368 descr->next = descr + 1;
369 descr->prev = descr - 1;
370
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600371 buf += sizeof(struct spider_net_hw_descr);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700372 }
373 /* do actual circular list */
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600374 (descr-1)->next = chain->ring;
375 chain->ring->prev = descr-1;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700376
Jens Osterkampbdd01502006-07-13 11:54:08 +0200377 spin_lock_init(&chain->lock);
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600378 chain->head = chain->ring;
379 chain->tail = chain->ring;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700380 return 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700381}
382
383/**
384 * spider_net_free_rx_chain_contents - frees descr contents in rx chain
385 * @card: card structure
386 *
387 * returns 0 on success, <0 on failure
388 */
389static void
390spider_net_free_rx_chain_contents(struct spider_net_card *card)
391{
392 struct spider_net_descr *descr;
393
394 descr = card->rx_chain.head;
Linas Vepstas64751912006-10-10 16:22:29 -0500395 do {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700396 if (descr->skb) {
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600397 pci_unmap_single(card->pdev, descr->hwdescr->buf_addr,
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500398 SPIDER_NET_MAX_FRAME,
Linas Vepstas348bc2a2006-10-10 16:21:10 -0500399 PCI_DMA_BIDIRECTIONAL);
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600400 dev_kfree_skb(descr->skb);
401 descr->skb = NULL;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700402 }
403 descr = descr->next;
Linas Vepstas64751912006-10-10 16:22:29 -0500404 } while (descr != card->rx_chain.head);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700405}
406
407/**
Linas Vepstasa4182c52006-12-13 15:19:54 -0600408 * spider_net_prepare_rx_descr - Reinitialize RX descriptor
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700409 * @card: card structure
410 * @descr: descriptor to re-init
411 *
Linas Vepstasa4182c52006-12-13 15:19:54 -0600412 * Return 0 on succes, <0 on failure.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700413 *
Linas Vepstasa4182c52006-12-13 15:19:54 -0600414 * Allocates a new rx skb, iommu-maps it and attaches it to the
415 * descriptor. Mark the descriptor as activated, ready-to-use.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700416 */
417static int
418spider_net_prepare_rx_descr(struct spider_net_card *card,
419 struct spider_net_descr *descr)
420{
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600421 struct spider_net_hw_descr *hwdescr = descr->hwdescr;
Arnd Bergmann8e0a6132006-01-12 17:16:43 -0500422 dma_addr_t buf;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700423 int offset;
424 int bufsize;
425
426 /* we need to round up the buffer size to a multiple of 128 */
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500427 bufsize = (SPIDER_NET_MAX_FRAME + SPIDER_NET_RXBUF_ALIGN - 1) &
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700428 (~(SPIDER_NET_RXBUF_ALIGN - 1));
429
430 /* and we need to have it 128 byte aligned, therefore we allocate a
431 * bit more */
432 /* allocate an skb */
Christoph Hellwig98739402007-05-16 16:58:00 -0500433 descr->skb = netdev_alloc_skb(card->netdev,
434 bufsize + SPIDER_NET_RXBUF_ALIGN - 1);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700435 if (!descr->skb) {
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500436 if (netif_msg_rx_err(card) && net_ratelimit())
437 pr_err("Not enough memory to allocate rx buffer\n");
Jim Lewis9b6b0b82006-09-22 17:22:53 -0700438 card->spider_stats.alloc_rx_skb_error++;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700439 return -ENOMEM;
440 }
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600441 hwdescr->buf_size = bufsize;
442 hwdescr->result_size = 0;
443 hwdescr->valid_size = 0;
444 hwdescr->data_status = 0;
445 hwdescr->data_error = 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700446
447 offset = ((unsigned long)descr->skb->data) &
448 (SPIDER_NET_RXBUF_ALIGN - 1);
449 if (offset)
450 skb_reserve(descr->skb, SPIDER_NET_RXBUF_ALIGN - offset);
Linas Vepstasa4182c52006-12-13 15:19:54 -0600451 /* iommu-map the skb */
Arnd Bergmann8e0a6132006-01-12 17:16:43 -0500452 buf = pci_map_single(card->pdev, descr->skb->data,
Jens Osterkampbdd01502006-07-13 11:54:08 +0200453 SPIDER_NET_MAX_FRAME, PCI_DMA_FROMDEVICE);
Olof Johanssond4b0a4c2006-09-27 14:02:26 -0500454 if (pci_dma_mapping_error(buf)) {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700455 dev_kfree_skb_any(descr->skb);
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600456 descr->skb = NULL;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500457 if (netif_msg_rx_err(card) && net_ratelimit())
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700458 pr_err("Could not iommu-map rx buffer\n");
Jim Lewis9b6b0b82006-09-22 17:22:53 -0700459 card->spider_stats.rx_iommu_map_error++;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600460 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700461 } else {
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600462 hwdescr->buf_addr = buf;
463 hwdescr->next_descr_addr = 0;
Linas Vepstas90476a22006-12-13 15:22:04 -0600464 wmb();
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600465 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_CARDOWNED |
Jens Osterkampbdd01502006-07-13 11:54:08 +0200466 SPIDER_NET_DMAC_NOINTR_COMPLETE;
Linas Vepstasd9a97202007-02-05 16:29:43 -0800467
468 wmb();
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600469 descr->prev->hwdescr->next_descr_addr = descr->bus_addr;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700470 }
471
Linas Vepstasa4182c52006-12-13 15:19:54 -0600472 return 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700473}
474
475/**
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500476 * spider_net_enable_rxchtails - sets RX dmac chain tail addresses
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700477 * @card: card structure
478 *
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500479 * spider_net_enable_rxchtails sets the RX DMAC chain tail adresses in the
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700480 * chip by writing to the appropriate register. DMA is enabled in
481 * spider_net_enable_rxdmac.
482 */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200483static inline void
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700484spider_net_enable_rxchtails(struct spider_net_card *card)
485{
486 /* assume chain is aligned correctly */
487 spider_net_write_reg(card, SPIDER_NET_GDADCHA ,
488 card->rx_chain.tail->bus_addr);
489}
490
491/**
492 * spider_net_enable_rxdmac - enables a receive DMA controller
493 * @card: card structure
494 *
495 * spider_net_enable_rxdmac enables the DMA controller by setting RX_DMA_EN
496 * in the GDADMACCNTR register
497 */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200498static inline void
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700499spider_net_enable_rxdmac(struct spider_net_card *card)
500{
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500501 wmb();
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700502 spider_net_write_reg(card, SPIDER_NET_GDADMACCNTR,
503 SPIDER_NET_DMA_RX_VALUE);
504}
505
506/**
507 * spider_net_refill_rx_chain - refills descriptors/skbs in the rx chains
508 * @card: card structure
509 *
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500510 * refills descriptors in the rx chain: allocates skbs and iommu-maps them.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700511 */
512static void
513spider_net_refill_rx_chain(struct spider_net_card *card)
514{
Jens Osterkampbdd01502006-07-13 11:54:08 +0200515 struct spider_net_descr_chain *chain = &card->rx_chain;
516 unsigned long flags;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700517
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500518 /* one context doing the refill (and a second context seeing that
519 * and omitting it) is ok. If called by NAPI, we'll be called again
520 * as spider_net_decode_one_descr is called several times. If some
521 * interrupt calls us, the NAPI is about to clean up anyway. */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200522 if (!spin_trylock_irqsave(&chain->lock, flags))
523 return;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700524
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600525 while (spider_net_get_descr_status(chain->head->hwdescr) ==
Jens Osterkampbdd01502006-07-13 11:54:08 +0200526 SPIDER_NET_DESCR_NOT_IN_USE) {
527 if (spider_net_prepare_rx_descr(card, chain->head))
528 break;
529 chain->head = chain->head->next;
530 }
531
532 spin_unlock_irqrestore(&chain->lock, flags);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700533}
534
535/**
Linas Vepstas2c307db2006-12-13 15:20:59 -0600536 * spider_net_alloc_rx_skbs - Allocates rx skbs in rx descriptor chains
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700537 * @card: card structure
538 *
Linas Vepstas2c307db2006-12-13 15:20:59 -0600539 * Returns 0 on success, <0 on failure.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700540 */
541static int
542spider_net_alloc_rx_skbs(struct spider_net_card *card)
543{
544 int result;
545 struct spider_net_descr_chain *chain;
546
547 result = -ENOMEM;
548
549 chain = &card->rx_chain;
Linas Vepstas2c307db2006-12-13 15:20:59 -0600550 /* Put at least one buffer into the chain. if this fails,
551 * we've got a problem. If not, spider_net_refill_rx_chain
552 * will do the rest at the end of this function. */
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700553 if (spider_net_prepare_rx_descr(card, chain->head))
554 goto error;
555 else
556 chain->head = chain->head->next;
557
Linas Vepstas2c307db2006-12-13 15:20:59 -0600558 /* This will allocate the rest of the rx buffers;
559 * if not, it's business as usual later on. */
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700560 spider_net_refill_rx_chain(card);
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500561 spider_net_enable_rxdmac(card);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700562 return 0;
563
564error:
565 spider_net_free_rx_chain_contents(card);
566 return result;
567}
568
569/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700570 * spider_net_get_multicast_hash - generates hash for multicast filter table
571 * @addr: multicast address
572 *
573 * returns the hash value.
574 *
575 * spider_net_get_multicast_hash calculates a hash value for a given multicast
576 * address, that is used to set the multicast filter tables
577 */
578static u8
579spider_net_get_multicast_hash(struct net_device *netdev, __u8 *addr)
580{
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700581 u32 crc;
582 u8 hash;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500583 char addr_for_crc[ETH_ALEN] = { 0, };
584 int i, bit;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700585
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500586 for (i = 0; i < ETH_ALEN * 8; i++) {
587 bit = (addr[i / 8] >> (i % 8)) & 1;
588 addr_for_crc[ETH_ALEN - 1 - i / 8] += bit << (7 - (i % 8));
589 }
590
591 crc = crc32_be(~0, addr_for_crc, netdev->addr_len);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700592
593 hash = (crc >> 27);
594 hash <<= 3;
595 hash |= crc & 7;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500596 hash &= 0xff;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700597
598 return hash;
599}
600
601/**
602 * spider_net_set_multi - sets multicast addresses and promisc flags
603 * @netdev: interface device structure
604 *
605 * spider_net_set_multi configures multicast addresses as needed for the
606 * netdev interface. It also sets up multicast, allmulti and promisc
607 * flags appropriately
608 */
609static void
610spider_net_set_multi(struct net_device *netdev)
611{
612 struct dev_mc_list *mc;
613 u8 hash;
614 int i;
615 u32 reg;
616 struct spider_net_card *card = netdev_priv(netdev);
617 unsigned long bitmask[SPIDER_NET_MULTICAST_HASHES / BITS_PER_LONG] =
618 {0, };
619
620 spider_net_set_promisc(card);
621
622 if (netdev->flags & IFF_ALLMULTI) {
623 for (i = 0; i < SPIDER_NET_MULTICAST_HASHES; i++) {
624 set_bit(i, bitmask);
625 }
626 goto write_hash;
627 }
628
629 /* well, we know, what the broadcast hash value is: it's xfd
630 hash = spider_net_get_multicast_hash(netdev, netdev->broadcast); */
631 set_bit(0xfd, bitmask);
632
633 for (mc = netdev->mc_list; mc; mc = mc->next) {
634 hash = spider_net_get_multicast_hash(netdev, mc->dmi_addr);
635 set_bit(hash, bitmask);
636 }
637
638write_hash:
639 for (i = 0; i < SPIDER_NET_MULTICAST_HASHES / 4; i++) {
640 reg = 0;
641 if (test_bit(i * 4, bitmask))
642 reg += 0x08;
643 reg <<= 8;
644 if (test_bit(i * 4 + 1, bitmask))
645 reg += 0x08;
646 reg <<= 8;
647 if (test_bit(i * 4 + 2, bitmask))
648 reg += 0x08;
649 reg <<= 8;
650 if (test_bit(i * 4 + 3, bitmask))
651 reg += 0x08;
652
653 spider_net_write_reg(card, SPIDER_NET_GMRMHFILnR + i * 4, reg);
654 }
655}
656
657/**
658 * spider_net_disable_rxdmac - disables the receive DMA controller
659 * @card: card structure
660 *
661 * spider_net_disable_rxdmac terminates processing on the DMA controller by
662 * turing off DMA and issueing a force end
663 */
664static void
665spider_net_disable_rxdmac(struct spider_net_card *card)
666{
667 spider_net_write_reg(card, SPIDER_NET_GDADMACCNTR,
668 SPIDER_NET_DMA_RX_FEND_VALUE);
669}
670
671/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700672 * spider_net_prepare_tx_descr - fill tx descriptor with skb data
673 * @card: card structure
674 * @descr: descriptor structure to fill out
675 * @skb: packet to use
676 *
677 * returns 0 on success, <0 on failure.
678 *
679 * fills out the descriptor structure with skb data and len. Copies data,
680 * if needed (32bit DMA!)
681 */
682static int
683spider_net_prepare_tx_descr(struct spider_net_card *card,
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700684 struct sk_buff *skb)
685{
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600686 struct spider_net_descr_chain *chain = &card->tx_chain;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500687 struct spider_net_descr *descr;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600688 struct spider_net_hw_descr *hwdescr;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500689 dma_addr_t buf;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500690 unsigned long flags;
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500691
James K Lewis9c434f52006-11-17 14:39:36 -0800692 buf = pci_map_single(card->pdev, skb->data, skb->len, PCI_DMA_TODEVICE);
Olof Johanssond4b0a4c2006-09-27 14:02:26 -0500693 if (pci_dma_mapping_error(buf)) {
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500694 if (netif_msg_tx_err(card) && net_ratelimit())
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700695 pr_err("could not iommu-map packet (%p, %i). "
James K Lewis9c434f52006-11-17 14:39:36 -0800696 "Dropping packet\n", skb->data, skb->len);
Jim Lewis9b6b0b82006-09-22 17:22:53 -0700697 card->spider_stats.tx_iommu_map_error++;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700698 return -ENOMEM;
699 }
700
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600701 spin_lock_irqsave(&chain->lock, flags);
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500702 descr = card->tx_chain.head;
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600703 if (descr->next == chain->tail->prev) {
704 spin_unlock_irqrestore(&chain->lock, flags);
705 pci_unmap_single(card->pdev, buf, skb->len, PCI_DMA_TODEVICE);
706 return -ENOMEM;
707 }
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600708 hwdescr = descr->hwdescr;
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600709 chain->head = descr->next;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500710
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700711 descr->skb = skb;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600712 hwdescr->buf_addr = buf;
713 hwdescr->buf_size = skb->len;
714 hwdescr->next_descr_addr = 0;
715 hwdescr->data_status = 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700716
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600717 hwdescr->dmac_cmd_status =
Jens Osterkampbdd01502006-07-13 11:54:08 +0200718 SPIDER_NET_DESCR_CARDOWNED | SPIDER_NET_DMAC_NOCS;
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600719 spin_unlock_irqrestore(&chain->lock, flags);
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500720
Linas Vepstas33bdeec2007-04-16 22:54:13 -0700721 if (skb->protocol == htons(ETH_P_IP) && skb->ip_summed == CHECKSUM_PARTIAL)
Arnaldo Carvalho de Meloeddc9ec2007-04-20 22:47:35 -0700722 switch (ip_hdr(skb)->protocol) {
Jens Osterkampbdd01502006-07-13 11:54:08 +0200723 case IPPROTO_TCP:
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600724 hwdescr->dmac_cmd_status |= SPIDER_NET_DMAC_TCP;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200725 break;
726 case IPPROTO_UDP:
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600727 hwdescr->dmac_cmd_status |= SPIDER_NET_DMAC_UDP;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200728 break;
729 }
730
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500731 /* Chain the bus address, so that the DMA engine finds this descr. */
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600732 wmb();
733 descr->prev->hwdescr->next_descr_addr = descr->bus_addr;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200734
Linas Vepstas917a5b82006-10-10 16:01:51 -0500735 card->netdev->trans_start = jiffies; /* set netdev watchdog timer */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200736 return 0;
737}
738
Linas Vepstasa664ccf2006-10-10 16:18:18 -0500739static int
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500740spider_net_set_low_watermark(struct spider_net_card *card)
741{
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600742 struct spider_net_descr *descr = card->tx_chain.tail;
743 struct spider_net_hw_descr *hwdescr;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500744 unsigned long flags;
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500745 int status;
746 int cnt=0;
747 int i;
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500748
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500749 /* Measure the length of the queue. Measurement does not
750 * need to be precise -- does not need a lock. */
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500751 while (descr != card->tx_chain.head) {
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600752 status = descr->hwdescr->dmac_cmd_status & SPIDER_NET_DESCR_NOT_IN_USE;
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500753 if (status == SPIDER_NET_DESCR_NOT_IN_USE)
754 break;
755 descr = descr->next;
756 cnt++;
757 }
758
759 /* If TX queue is short, don't even bother with interrupts */
Linas Vepstasd4ed8f82006-12-13 15:06:59 -0600760 if (cnt < card->tx_chain.num_desc/4)
Linas Vepstasa664ccf2006-10-10 16:18:18 -0500761 return cnt;
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500762
763 /* Set low-watermark 3/4th's of the way into the queue. */
764 descr = card->tx_chain.tail;
765 cnt = (cnt*3)/4;
766 for (i=0;i<cnt; i++)
767 descr = descr->next;
768
769 /* Set the new watermark, clear the old watermark */
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500770 spin_lock_irqsave(&card->tx_chain.lock, flags);
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600771 descr->hwdescr->dmac_cmd_status |= SPIDER_NET_DESCR_TXDESFLG;
772 if (card->low_watermark && card->low_watermark != descr) {
773 hwdescr = card->low_watermark->hwdescr;
774 hwdescr->dmac_cmd_status =
775 hwdescr->dmac_cmd_status & ~SPIDER_NET_DESCR_TXDESFLG;
776 }
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500777 card->low_watermark = descr;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500778 spin_unlock_irqrestore(&card->tx_chain.lock, flags);
Linas Vepstasa664ccf2006-10-10 16:18:18 -0500779 return cnt;
Linas Vepstas204e5fa2006-10-10 16:11:33 -0500780}
781
Jens Osterkampbdd01502006-07-13 11:54:08 +0200782/**
783 * spider_net_release_tx_chain - processes sent tx descriptors
784 * @card: adapter structure
785 * @brutal: if set, don't care about whether descriptor seems to be in use
786 *
787 * returns 0 if the tx ring is empty, otherwise 1.
788 *
789 * spider_net_release_tx_chain releases the tx descriptors that spider has
790 * finished with (if non-brutal) or simply release tx descriptors (if brutal).
791 * If some other context is calling this function, we return 1 so that we're
792 * scheduled again (if we were scheduled) and will not loose initiative.
793 */
794static int
795spider_net_release_tx_chain(struct spider_net_card *card, int brutal)
796{
797 struct spider_net_descr_chain *chain = &card->tx_chain;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500798 struct spider_net_descr *descr;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600799 struct spider_net_hw_descr *hwdescr;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500800 struct sk_buff *skb;
801 u32 buf_addr;
802 unsigned long flags;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200803 int status;
804
Linas Vepstas5c8e98f2007-02-20 16:41:59 -0600805 while (1) {
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500806 spin_lock_irqsave(&chain->lock, flags);
Linas Vepstas5c8e98f2007-02-20 16:41:59 -0600807 if (chain->tail == chain->head) {
808 spin_unlock_irqrestore(&chain->lock, flags);
809 return 0;
810 }
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500811 descr = chain->tail;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600812 hwdescr = descr->hwdescr;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500813
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600814 status = spider_net_get_descr_status(hwdescr);
Jens Osterkampbdd01502006-07-13 11:54:08 +0200815 switch (status) {
816 case SPIDER_NET_DESCR_COMPLETE:
817 card->netdev_stats.tx_packets++;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500818 card->netdev_stats.tx_bytes += descr->skb->len;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200819 break;
820
821 case SPIDER_NET_DESCR_CARDOWNED:
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500822 if (!brutal) {
823 spin_unlock_irqrestore(&chain->lock, flags);
Jens Osterkampbdd01502006-07-13 11:54:08 +0200824 return 1;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500825 }
826
Jens Osterkampbdd01502006-07-13 11:54:08 +0200827 /* fallthrough, if we release the descriptors
828 * brutally (then we don't care about
829 * SPIDER_NET_DESCR_CARDOWNED) */
830
831 case SPIDER_NET_DESCR_RESPONSE_ERROR:
832 case SPIDER_NET_DESCR_PROTECTION_ERROR:
833 case SPIDER_NET_DESCR_FORCE_END:
834 if (netif_msg_tx_err(card))
835 pr_err("%s: forcing end of tx descriptor "
836 "with status x%02x\n",
837 card->netdev->name, status);
838 card->netdev_stats.tx_errors++;
839 break;
840
841 default:
842 card->netdev_stats.tx_dropped++;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500843 if (!brutal) {
844 spin_unlock_irqrestore(&chain->lock, flags);
Linas Vepstasc3fee4c2006-10-10 16:00:04 -0500845 return 1;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500846 }
Jens Osterkampbdd01502006-07-13 11:54:08 +0200847 }
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700848
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500849 chain->tail = descr->next;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600850 hwdescr->dmac_cmd_status |= SPIDER_NET_DESCR_NOT_IN_USE;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500851 skb = descr->skb;
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600852 descr->skb = NULL;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600853 buf_addr = hwdescr->buf_addr;
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500854 spin_unlock_irqrestore(&chain->lock, flags);
855
856 /* unmap the skb */
857 if (skb) {
James K Lewis9c434f52006-11-17 14:39:36 -0800858 pci_unmap_single(card->pdev, buf_addr, skb->len,
859 PCI_DMA_TODEVICE);
Linas Vepstas9cc7bf72006-10-10 16:14:29 -0500860 dev_kfree_skb(skb);
861 }
862 }
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700863 return 0;
864}
865
866/**
867 * spider_net_kick_tx_dma - enables TX DMA processing
868 * @card: card structure
869 * @descr: descriptor address to enable TX processing at
870 *
Linas Vepstasa664ccf2006-10-10 16:18:18 -0500871 * This routine will start the transmit DMA running if
872 * it is not already running. This routine ned only be
873 * called when queueing a new packet to an empty tx queue.
874 * Writes the current tx chain head as start address
875 * of the tx descriptor chain and enables the transmission
876 * DMA engine.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700877 */
Jens Osterkampbdd01502006-07-13 11:54:08 +0200878static inline void
879spider_net_kick_tx_dma(struct spider_net_card *card)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700880{
Jens Osterkampbdd01502006-07-13 11:54:08 +0200881 struct spider_net_descr *descr;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700882
Jens Osterkampbdd01502006-07-13 11:54:08 +0200883 if (spider_net_read_reg(card, SPIDER_NET_GDTDMACCNTR) &
884 SPIDER_NET_TX_DMA_EN)
885 goto out;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700886
Jens Osterkampbdd01502006-07-13 11:54:08 +0200887 descr = card->tx_chain.tail;
888 for (;;) {
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600889 if (spider_net_get_descr_status(descr->hwdescr) ==
Jens Osterkampbdd01502006-07-13 11:54:08 +0200890 SPIDER_NET_DESCR_CARDOWNED) {
891 spider_net_write_reg(card, SPIDER_NET_GDTDCHA,
892 descr->bus_addr);
893 spider_net_write_reg(card, SPIDER_NET_GDTDMACCNTR,
894 SPIDER_NET_DMA_TX_VALUE);
895 break;
896 }
897 if (descr == card->tx_chain.head)
898 break;
899 descr = descr->next;
900 }
901
902out:
903 mod_timer(&card->tx_timer, jiffies + SPIDER_NET_TX_TIMER);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700904}
905
906/**
907 * spider_net_xmit - transmits a frame over the device
908 * @skb: packet to send out
909 * @netdev: interface device structure
910 *
Jens Osterkampbdd01502006-07-13 11:54:08 +0200911 * returns 0 on success, !0 on failure
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700912 */
913static int
914spider_net_xmit(struct sk_buff *skb, struct net_device *netdev)
915{
Linas Vepstasa664ccf2006-10-10 16:18:18 -0500916 int cnt;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700917 struct spider_net_card *card = netdev_priv(netdev);
Jens Osterkampbdd01502006-07-13 11:54:08 +0200918
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500919 spider_net_release_tx_chain(card, 0);
920
Linas Vepstasd9c199e2007-02-20 16:41:03 -0600921 if (spider_net_prepare_tx_descr(card, skb) != 0) {
Jim Lewis9b6b0b82006-09-22 17:22:53 -0700922 card->netdev_stats.tx_dropped++;
Linas Vepstas313ef4b2006-10-10 16:04:00 -0500923 netif_stop_queue(netdev);
924 return NETDEV_TX_BUSY;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200925 }
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700926
Linas Vepstasa664ccf2006-10-10 16:18:18 -0500927 cnt = spider_net_set_low_watermark(card);
928 if (cnt < 5)
929 spider_net_kick_tx_dma(card);
Linas Vepstas313ef4b2006-10-10 16:04:00 -0500930 return NETDEV_TX_OK;
Jens Osterkampbdd01502006-07-13 11:54:08 +0200931}
932
933/**
934 * spider_net_cleanup_tx_ring - cleans up the TX ring
935 * @card: card structure
936 *
Linas Vepstas68a8c602006-10-10 16:13:05 -0500937 * spider_net_cleanup_tx_ring is called by either the tx_timer
938 * or from the NAPI polling routine.
939 * This routine releases resources associted with transmitted
940 * packets, including updating the queue tail pointer.
Jens Osterkampbdd01502006-07-13 11:54:08 +0200941 */
942static void
943spider_net_cleanup_tx_ring(struct spider_net_card *card)
944{
Jens Osterkampbdd01502006-07-13 11:54:08 +0200945 if ((spider_net_release_tx_chain(card, 0) != 0) &&
Linas Vepstas313ef4b2006-10-10 16:04:00 -0500946 (card->netdev->flags & IFF_UP)) {
Jens Osterkampbdd01502006-07-13 11:54:08 +0200947 spider_net_kick_tx_dma(card);
Linas Vepstas313ef4b2006-10-10 16:04:00 -0500948 netif_wake_queue(card->netdev);
949 }
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700950}
951
952/**
953 * spider_net_do_ioctl - called for device ioctls
954 * @netdev: interface device structure
955 * @ifr: request parameter structure for ioctl
956 * @cmd: command code for ioctl
957 *
958 * returns 0 on success, <0 on failure. Currently, we have no special ioctls.
959 * -EOPNOTSUPP is returned, if an unknown ioctl was requested
960 */
961static int
962spider_net_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
963{
964 switch (cmd) {
965 default:
966 return -EOPNOTSUPP;
967 }
968}
969
970/**
971 * spider_net_pass_skb_up - takes an skb from a descriptor and passes it on
972 * @descr: descriptor to process
973 * @card: card structure
974 *
Linas Vepstas05b346b2006-12-13 15:15:15 -0600975 * Fills out skb structure and passes the data to the stack.
976 * The descriptor state is not changed.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700977 */
Linas Vepstas7f7223b2006-12-13 15:17:39 -0600978static void
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700979spider_net_pass_skb_up(struct spider_net_descr *descr,
Linas Vepstas1cd173f2006-12-13 15:12:26 -0600980 struct spider_net_card *card)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700981{
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600982 struct spider_net_hw_descr *hwdescr= descr->hwdescr;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700983 struct sk_buff *skb;
984 struct net_device *netdev;
985 u32 data_status, data_error;
986
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600987 data_status = hwdescr->data_status;
988 data_error = hwdescr->data_error;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700989 netdev = card->netdev;
990
Arnd Bergmann11f1a522006-01-12 17:16:44 -0500991 skb = descr->skb;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -0600992 skb_put(skb, hwdescr->valid_size);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -0700993
994 /* the card seems to add 2 bytes of junk in front
995 * of the ethernet frame */
996#define SPIDER_MISALIGN 2
997 skb_pull(skb, SPIDER_MISALIGN);
998 skb->protocol = eth_type_trans(skb, netdev);
999
1000 /* checksum offload */
1001 if (card->options.rx_csum) {
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001002 if ( ( (data_status & SPIDER_NET_DATA_STATUS_CKSUM_MASK) ==
1003 SPIDER_NET_DATA_STATUS_CKSUM_MASK) &&
1004 !(data_error & SPIDER_NET_DATA_ERR_CKSUM_MASK))
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001005 skb->ip_summed = CHECKSUM_UNNECESSARY;
1006 else
1007 skb->ip_summed = CHECKSUM_NONE;
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001008 } else
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001009 skb->ip_summed = CHECKSUM_NONE;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001010
1011 if (data_status & SPIDER_NET_VLAN_PACKET) {
1012 /* further enhancements: HW-accel VLAN
1013 * vlan_hwaccel_receive_skb
1014 */
1015 }
1016
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001017 /* update netdevice statistics */
1018 card->netdev_stats.rx_packets++;
1019 card->netdev_stats.rx_bytes += skb->len;
Florin Malita93c1d3b2007-05-22 18:09:42 -05001020
1021 /* pass skb up to stack */
1022 netif_receive_skb(skb);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001023}
1024
Linas Vepstas6d249982006-12-13 15:23:56 -06001025#ifdef DEBUG
1026static void show_rx_chain(struct spider_net_card *card)
1027{
1028 struct spider_net_descr_chain *chain = &card->rx_chain;
1029 struct spider_net_descr *start= chain->tail;
1030 struct spider_net_descr *descr= start;
1031 int status;
1032
1033 int cnt = 0;
1034 int cstat = spider_net_get_descr_status(descr);
1035 printk(KERN_INFO "RX chain tail at descr=%ld\n",
1036 (start - card->descr) - card->tx_chain.num_desc);
1037 status = cstat;
1038 do
1039 {
1040 status = spider_net_get_descr_status(descr);
1041 if (cstat != status) {
1042 printk(KERN_INFO "Have %d descrs with stat=x%08x\n", cnt, cstat);
1043 cstat = status;
1044 cnt = 0;
1045 }
1046 cnt ++;
1047 descr = descr->next;
1048 } while (descr != start);
1049 printk(KERN_INFO "Last %d descrs with stat=x%08x\n", cnt, cstat);
1050}
1051#endif
1052
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001053/**
Linas Vepstas7376e732007-02-20 16:42:59 -06001054 * spider_net_decode_one_descr - processes an RX descriptor
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001055 * @card: card structure
1056 *
Linas Vepstas7376e732007-02-20 16:42:59 -06001057 * Returns 1 if a packet has been sent to the stack, otherwise 0.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001058 *
Linas Vepstas7376e732007-02-20 16:42:59 -06001059 * Processes an RX descriptor by iommu-unmapping the data buffer
1060 * and passing the packet up to the stack. This function is called
1061 * in softirq context, e.g. either bottom half from interrupt or
1062 * NAPI polling context.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001063 */
1064static int
Linas Vepstas1cd173f2006-12-13 15:12:26 -06001065spider_net_decode_one_descr(struct spider_net_card *card)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001066{
Jens Osterkampbdd01502006-07-13 11:54:08 +02001067 struct spider_net_descr_chain *chain = &card->rx_chain;
1068 struct spider_net_descr *descr = chain->tail;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001069 struct spider_net_hw_descr *hwdescr = descr->hwdescr;
Jens Osterkampbdd01502006-07-13 11:54:08 +02001070 int status;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001071
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001072 status = spider_net_get_descr_status(hwdescr);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001073
Linas Vepstas80dab7c2006-12-13 15:18:52 -06001074 /* Nothing in the descriptor, or ring must be empty */
1075 if ((status == SPIDER_NET_DESCR_CARDOWNED) ||
1076 (status == SPIDER_NET_DESCR_NOT_IN_USE))
Linas Vepstas1cd173f2006-12-13 15:12:26 -06001077 return 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001078
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001079 /* descriptor definitively used -- move on tail */
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001080 chain->tail = descr->next;
1081
Linas Vepstas05b346b2006-12-13 15:15:15 -06001082 /* unmap descriptor */
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001083 pci_unmap_single(card->pdev, hwdescr->buf_addr,
Linas Vepstas05b346b2006-12-13 15:15:15 -06001084 SPIDER_NET_MAX_FRAME, PCI_DMA_FROMDEVICE);
1085
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001086 if ( (status == SPIDER_NET_DESCR_RESPONSE_ERROR) ||
1087 (status == SPIDER_NET_DESCR_PROTECTION_ERROR) ||
1088 (status == SPIDER_NET_DESCR_FORCE_END) ) {
1089 if (netif_msg_rx_err(card))
1090 pr_err("%s: dropping RX descriptor with state %d\n",
1091 card->netdev->name, status);
1092 card->netdev_stats.rx_dropped++;
Linas Vepstas7f7223b2006-12-13 15:17:39 -06001093 goto bad_desc;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001094 }
1095
1096 if ( (status != SPIDER_NET_DESCR_COMPLETE) &&
1097 (status != SPIDER_NET_DESCR_FRAME_END) ) {
Linas Vepstas5a028872006-12-13 15:08:25 -06001098 if (netif_msg_rx_err(card))
Linas Vepstas7376e732007-02-20 16:42:59 -06001099 pr_err("%s: RX descriptor with unknown state %d\n",
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001100 card->netdev->name, status);
Linas Vepstas5a028872006-12-13 15:08:25 -06001101 card->spider_stats.rx_desc_unk_state++;
Linas Vepstas7f7223b2006-12-13 15:17:39 -06001102 goto bad_desc;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001103 }
1104
Linas Vepstas366684b2006-12-13 15:16:18 -06001105 /* The cases we'll throw away the packet immediately */
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001106 if (hwdescr->data_error & SPIDER_NET_DESTROY_RX_FLAGS) {
Linas Vepstas366684b2006-12-13 15:16:18 -06001107 if (netif_msg_rx_err(card))
1108 pr_err("%s: error in received descriptor found, "
1109 "data_status=x%08x, data_error=x%08x\n",
1110 card->netdev->name,
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001111 hwdescr->data_status, hwdescr->data_error);
Linas Vepstas7f7223b2006-12-13 15:17:39 -06001112 goto bad_desc;
Linas Vepstas366684b2006-12-13 15:16:18 -06001113 }
1114
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001115 if (hwdescr->dmac_cmd_status & 0xfefe) {
Linas Vepstas6d249982006-12-13 15:23:56 -06001116 pr_err("%s: bad status, cmd_status=x%08x\n",
1117 card->netdev->name,
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001118 hwdescr->dmac_cmd_status);
1119 pr_err("buf_addr=x%08x\n", hwdescr->buf_addr);
1120 pr_err("buf_size=x%08x\n", hwdescr->buf_size);
1121 pr_err("next_descr_addr=x%08x\n", hwdescr->next_descr_addr);
1122 pr_err("result_size=x%08x\n", hwdescr->result_size);
1123 pr_err("valid_size=x%08x\n", hwdescr->valid_size);
1124 pr_err("data_status=x%08x\n", hwdescr->data_status);
1125 pr_err("data_error=x%08x\n", hwdescr->data_error);
Linas Vepstas6d249982006-12-13 15:23:56 -06001126 pr_err("which=%ld\n", descr - card->rx_chain.ring);
1127
1128 card->spider_stats.rx_desc_error++;
1129 goto bad_desc;
1130 }
1131
Linas Vepstas7f7223b2006-12-13 15:17:39 -06001132 /* Ok, we've got a packet in descr */
1133 spider_net_pass_skb_up(descr, card);
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001134 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE;
Linas Vepstas7f7223b2006-12-13 15:17:39 -06001135 return 1;
1136
1137bad_desc:
1138 dev_kfree_skb_irq(descr->skb);
Linas Vepstasd9c199e2007-02-20 16:41:03 -06001139 descr->skb = NULL;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06001140 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE;
Linas Vepstas7f7223b2006-12-13 15:17:39 -06001141 return 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001142}
1143
1144/**
1145 * spider_net_poll - NAPI poll function called by the stack to return packets
1146 * @netdev: interface device structure
1147 * @budget: number of packets we can pass to the stack at most
1148 *
1149 * returns 0 if no more packets available to the driver/stack. Returns 1,
1150 * if the quota is exceeded, but the driver has still packets.
1151 *
1152 * spider_net_poll returns all packets from the rx descriptors to the stack
1153 * (using netif_receive_skb). If all/enough packets are up, the driver
1154 * reenables interrupts and returns 0. If not, 1 is returned.
1155 */
1156static int
1157spider_net_poll(struct net_device *netdev, int *budget)
1158{
1159 struct spider_net_card *card = netdev_priv(netdev);
1160 int packets_to_do, packets_done = 0;
1161 int no_more_packets = 0;
1162
Linas Vepstas68a8c602006-10-10 16:13:05 -05001163 spider_net_cleanup_tx_ring(card);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001164 packets_to_do = min(*budget, netdev->quota);
1165
1166 while (packets_to_do) {
Linas Vepstas1cd173f2006-12-13 15:12:26 -06001167 if (spider_net_decode_one_descr(card)) {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001168 packets_done++;
1169 packets_to_do--;
1170 } else {
1171 /* no more packets for the stack */
1172 no_more_packets = 1;
1173 break;
1174 }
1175 }
1176
1177 netdev->quota -= packets_done;
1178 *budget -= packets_done;
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001179 spider_net_refill_rx_chain(card);
Linas Vepstas80dab7c2006-12-13 15:18:52 -06001180 spider_net_enable_rxdmac(card);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001181
1182 /* if all packets are in the stack, enable interrupts and return 0 */
1183 /* if not, return 1 */
1184 if (no_more_packets) {
1185 netif_rx_complete(netdev);
1186 spider_net_rx_irq_on(card);
1187 return 0;
1188 }
1189
1190 return 1;
1191}
1192
1193/**
1194 * spider_net_vlan_rx_reg - initializes VLAN structures in the driver and card
1195 * @netdev: interface device structure
1196 * @grp: vlan_group structure that is registered (NULL on destroying interface)
1197 */
1198static void
1199spider_net_vlan_rx_reg(struct net_device *netdev, struct vlan_group *grp)
1200{
1201 /* further enhancement... yet to do */
1202 return;
1203}
1204
1205/**
1206 * spider_net_vlan_rx_add - adds VLAN id to the card filter
1207 * @netdev: interface device structure
1208 * @vid: VLAN id to add
1209 */
1210static void
1211spider_net_vlan_rx_add(struct net_device *netdev, uint16_t vid)
1212{
1213 /* further enhancement... yet to do */
1214 /* add vid to card's VLAN filter table */
1215 return;
1216}
1217
1218/**
1219 * spider_net_vlan_rx_kill - removes VLAN id to the card filter
1220 * @netdev: interface device structure
1221 * @vid: VLAN id to remove
1222 */
1223static void
1224spider_net_vlan_rx_kill(struct net_device *netdev, uint16_t vid)
1225{
1226 /* further enhancement... yet to do */
1227 /* remove vid from card's VLAN filter table */
1228}
1229
1230/**
1231 * spider_net_get_stats - get interface statistics
1232 * @netdev: interface device structure
1233 *
1234 * returns the interface statistics residing in the spider_net_card struct
1235 */
1236static struct net_device_stats *
1237spider_net_get_stats(struct net_device *netdev)
1238{
1239 struct spider_net_card *card = netdev_priv(netdev);
1240 struct net_device_stats *stats = &card->netdev_stats;
1241 return stats;
1242}
1243
1244/**
1245 * spider_net_change_mtu - changes the MTU of an interface
1246 * @netdev: interface device structure
1247 * @new_mtu: new MTU value
1248 *
1249 * returns 0 on success, <0 on failure
1250 */
1251static int
1252spider_net_change_mtu(struct net_device *netdev, int new_mtu)
1253{
1254 /* no need to re-alloc skbs or so -- the max mtu is about 2.3k
1255 * and mtu is outbound only anyway */
1256 if ( (new_mtu < SPIDER_NET_MIN_MTU ) ||
1257 (new_mtu > SPIDER_NET_MAX_MTU) )
1258 return -EINVAL;
1259 netdev->mtu = new_mtu;
1260 return 0;
1261}
1262
1263/**
1264 * spider_net_set_mac - sets the MAC of an interface
1265 * @netdev: interface device structure
1266 * @ptr: pointer to new MAC address
1267 *
1268 * Returns 0 on success, <0 on failure. Currently, we don't support this
1269 * and will always return EOPNOTSUPP.
1270 */
1271static int
1272spider_net_set_mac(struct net_device *netdev, void *p)
1273{
1274 struct spider_net_card *card = netdev_priv(netdev);
Jens Osterkamp054034d2005-09-06 19:30:55 -07001275 u32 macl, macu, regvalue;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001276 struct sockaddr *addr = p;
1277
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001278 if (!is_valid_ether_addr(addr->sa_data))
1279 return -EADDRNOTAVAIL;
1280
Jens Osterkamp054034d2005-09-06 19:30:55 -07001281 /* switch off GMACTPE and GMACRPE */
1282 regvalue = spider_net_read_reg(card, SPIDER_NET_GMACOPEMD);
1283 regvalue &= ~((1 << 5) | (1 << 6));
1284 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD, regvalue);
1285
1286 /* write mac */
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001287 macu = (addr->sa_data[0]<<24) + (addr->sa_data[1]<<16) +
1288 (addr->sa_data[2]<<8) + (addr->sa_data[3]);
1289 macl = (addr->sa_data[4]<<8) + (addr->sa_data[5]);
1290 spider_net_write_reg(card, SPIDER_NET_GMACUNIMACU, macu);
1291 spider_net_write_reg(card, SPIDER_NET_GMACUNIMACL, macl);
1292
Jens Osterkamp054034d2005-09-06 19:30:55 -07001293 /* switch GMACTPE and GMACRPE back on */
1294 regvalue = spider_net_read_reg(card, SPIDER_NET_GMACOPEMD);
1295 regvalue |= ((1 << 5) | (1 << 6));
1296 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD, regvalue);
1297
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001298 spider_net_set_promisc(card);
1299
1300 /* look up, whether we have been successful */
1301 if (spider_net_get_mac_address(netdev))
1302 return -EADDRNOTAVAIL;
1303 if (memcmp(netdev->dev_addr,addr->sa_data,netdev->addr_len))
1304 return -EADDRNOTAVAIL;
1305
1306 return 0;
1307}
1308
1309/**
Kou Ishizakiabdb66b2007-02-20 16:33:41 -06001310 * spider_net_link_reset
1311 * @netdev: net device structure
1312 *
1313 * This is called when the PHY_LINK signal is asserted. For the blade this is
1314 * not connected so we should never get here.
1315 *
1316 */
1317static void
1318spider_net_link_reset(struct net_device *netdev)
1319{
1320
1321 struct spider_net_card *card = netdev_priv(netdev);
1322
1323 del_timer_sync(&card->aneg_timer);
1324
1325 /* clear interrupt, block further interrupts */
1326 spider_net_write_reg(card, SPIDER_NET_GMACST,
1327 spider_net_read_reg(card, SPIDER_NET_GMACST));
1328 spider_net_write_reg(card, SPIDER_NET_GMACINTEN, 0);
1329
1330 /* reset phy and setup aneg */
1331 spider_net_setup_aneg(card);
1332 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER);
1333
1334}
1335
1336/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001337 * spider_net_handle_error_irq - handles errors raised by an interrupt
1338 * @card: card structure
1339 * @status_reg: interrupt status register 0 (GHIINT0STS)
1340 *
1341 * spider_net_handle_error_irq treats or ignores all error conditions
1342 * found when an interrupt is presented
1343 */
1344static void
1345spider_net_handle_error_irq(struct spider_net_card *card, u32 status_reg)
1346{
1347 u32 error_reg1, error_reg2;
1348 u32 i;
1349 int show_error = 1;
1350
1351 error_reg1 = spider_net_read_reg(card, SPIDER_NET_GHIINT1STS);
1352 error_reg2 = spider_net_read_reg(card, SPIDER_NET_GHIINT2STS);
1353
1354 /* check GHIINT0STS ************************************/
1355 if (status_reg)
1356 for (i = 0; i < 32; i++)
1357 if (status_reg & (1<<i))
1358 switch (i)
1359 {
1360 /* let error_reg1 and error_reg2 evaluation decide, what to do
1361 case SPIDER_NET_PHYINT:
1362 case SPIDER_NET_GMAC2INT:
1363 case SPIDER_NET_GMAC1INT:
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001364 case SPIDER_NET_GFIFOINT:
1365 case SPIDER_NET_DMACINT:
1366 case SPIDER_NET_GSYSINT:
1367 break; */
1368
Linas Vepstas98b90402006-10-10 16:08:42 -05001369 case SPIDER_NET_GIPSINT:
1370 show_error = 0;
1371 break;
1372
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001373 case SPIDER_NET_GPWOPCMPINT:
1374 /* PHY write operation completed */
1375 show_error = 0;
1376 break;
1377 case SPIDER_NET_GPROPCMPINT:
1378 /* PHY read operation completed */
1379 /* we don't use semaphores, as we poll for the completion
1380 * of the read operation in spider_net_read_phy. Should take
1381 * about 50 us */
1382 show_error = 0;
1383 break;
1384 case SPIDER_NET_GPWFFINT:
1385 /* PHY command queue full */
1386 if (netif_msg_intr(card))
1387 pr_err("PHY write queue full\n");
1388 show_error = 0;
1389 break;
1390
1391 /* case SPIDER_NET_GRMDADRINT: not used. print a message */
1392 /* case SPIDER_NET_GRMARPINT: not used. print a message */
1393 /* case SPIDER_NET_GRMMPINT: not used. print a message */
1394
1395 case SPIDER_NET_GDTDEN0INT:
1396 /* someone has set TX_DMA_EN to 0 */
1397 show_error = 0;
1398 break;
1399
1400 case SPIDER_NET_GDDDEN0INT: /* fallthrough */
1401 case SPIDER_NET_GDCDEN0INT: /* fallthrough */
1402 case SPIDER_NET_GDBDEN0INT: /* fallthrough */
1403 case SPIDER_NET_GDADEN0INT:
1404 /* someone has set RX_DMA_EN to 0 */
1405 show_error = 0;
1406 break;
1407
1408 /* RX interrupts */
1409 case SPIDER_NET_GDDFDCINT:
1410 case SPIDER_NET_GDCFDCINT:
1411 case SPIDER_NET_GDBFDCINT:
1412 case SPIDER_NET_GDAFDCINT:
1413 /* case SPIDER_NET_GDNMINT: not used. print a message */
1414 /* case SPIDER_NET_GCNMINT: not used. print a message */
1415 /* case SPIDER_NET_GBNMINT: not used. print a message */
1416 /* case SPIDER_NET_GANMINT: not used. print a message */
1417 /* case SPIDER_NET_GRFNMINT: not used. print a message */
1418 show_error = 0;
1419 break;
1420
1421 /* TX interrupts */
1422 case SPIDER_NET_GDTFDCINT:
1423 show_error = 0;
1424 break;
1425 case SPIDER_NET_GTTEDINT:
1426 show_error = 0;
1427 break;
1428 case SPIDER_NET_GDTDCEINT:
1429 /* chain end. If a descriptor should be sent, kick off
1430 * tx dma
Linas Vepstas98b90402006-10-10 16:08:42 -05001431 if (card->tx_chain.tail != card->tx_chain.head)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001432 spider_net_kick_tx_dma(card);
Linas Vepstas98b90402006-10-10 16:08:42 -05001433 */
1434 show_error = 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001435 break;
1436
1437 /* case SPIDER_NET_G1TMCNTINT: not used. print a message */
1438 /* case SPIDER_NET_GFREECNTINT: not used. print a message */
1439 }
1440
1441 /* check GHIINT1STS ************************************/
1442 if (error_reg1)
1443 for (i = 0; i < 32; i++)
1444 if (error_reg1 & (1<<i))
1445 switch (i)
1446 {
1447 case SPIDER_NET_GTMFLLINT:
Ishizaki Koufc8e13da2007-02-20 16:37:42 -06001448 /* TX RAM full may happen on a usual case.
1449 * Logging is not needed. */
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001450 show_error = 0;
1451 break;
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001452 case SPIDER_NET_GRFDFLLINT: /* fallthrough */
1453 case SPIDER_NET_GRFCFLLINT: /* fallthrough */
1454 case SPIDER_NET_GRFBFLLINT: /* fallthrough */
1455 case SPIDER_NET_GRFAFLLINT: /* fallthrough */
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001456 case SPIDER_NET_GRMFLLINT:
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001457 if (netif_msg_intr(card) && net_ratelimit())
Linas Vepstas5a028872006-12-13 15:08:25 -06001458 pr_err("Spider RX RAM full, incoming packets "
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001459 "might be discarded!\n");
1460 spider_net_rx_irq_off(card);
Linas Vepstas75856172006-12-13 15:10:06 -06001461 netif_rx_schedule(card->netdev);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001462 show_error = 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001463 break;
1464
1465 /* case SPIDER_NET_GTMSHTINT: problem, print a message */
1466 case SPIDER_NET_GDTINVDINT:
1467 /* allrighty. tx from previous descr ok */
1468 show_error = 0;
1469 break;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001470
1471 /* chain end */
1472 case SPIDER_NET_GDDDCEINT: /* fallthrough */
1473 case SPIDER_NET_GDCDCEINT: /* fallthrough */
1474 case SPIDER_NET_GDBDCEINT: /* fallthrough */
1475 case SPIDER_NET_GDADCEINT:
Linas Vepstas5a028872006-12-13 15:08:25 -06001476 if (netif_msg_intr(card) && net_ratelimit())
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001477 pr_err("got descriptor chain end interrupt, "
1478 "restarting DMAC %c.\n",
Linas Vepstas37aad752006-10-10 16:06:53 -05001479 'D'-(i-SPIDER_NET_GDDDCEINT)/3);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001480 spider_net_refill_rx_chain(card);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001481 spider_net_enable_rxdmac(card);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001482 show_error = 0;
1483 break;
1484
1485 /* invalid descriptor */
1486 case SPIDER_NET_GDDINVDINT: /* fallthrough */
1487 case SPIDER_NET_GDCINVDINT: /* fallthrough */
1488 case SPIDER_NET_GDBINVDINT: /* fallthrough */
1489 case SPIDER_NET_GDAINVDINT:
1490 /* could happen when rx chain is full */
1491 spider_net_refill_rx_chain(card);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001492 spider_net_enable_rxdmac(card);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001493 show_error = 0;
1494 break;
1495
1496 /* case SPIDER_NET_GDTRSERINT: problem, print a message */
1497 /* case SPIDER_NET_GDDRSERINT: problem, print a message */
1498 /* case SPIDER_NET_GDCRSERINT: problem, print a message */
1499 /* case SPIDER_NET_GDBRSERINT: problem, print a message */
1500 /* case SPIDER_NET_GDARSERINT: problem, print a message */
1501 /* case SPIDER_NET_GDSERINT: problem, print a message */
1502 /* case SPIDER_NET_GDTPTERINT: problem, print a message */
1503 /* case SPIDER_NET_GDDPTERINT: problem, print a message */
1504 /* case SPIDER_NET_GDCPTERINT: problem, print a message */
1505 /* case SPIDER_NET_GDBPTERINT: problem, print a message */
1506 /* case SPIDER_NET_GDAPTERINT: problem, print a message */
1507 default:
1508 show_error = 1;
1509 break;
1510 }
1511
1512 /* check GHIINT2STS ************************************/
1513 if (error_reg2)
1514 for (i = 0; i < 32; i++)
1515 if (error_reg2 & (1<<i))
1516 switch (i)
1517 {
1518 /* there is nothing we can (want to) do at this time. Log a
1519 * message, we can switch on and off the specific values later on
1520 case SPIDER_NET_GPROPERINT:
1521 case SPIDER_NET_GMCTCRSNGINT:
1522 case SPIDER_NET_GMCTLCOLINT:
1523 case SPIDER_NET_GMCTTMOTINT:
1524 case SPIDER_NET_GMCRCAERINT:
1525 case SPIDER_NET_GMCRCALERINT:
1526 case SPIDER_NET_GMCRALNERINT:
1527 case SPIDER_NET_GMCROVRINT:
1528 case SPIDER_NET_GMCRRNTINT:
1529 case SPIDER_NET_GMCRRXERINT:
1530 case SPIDER_NET_GTITCSERINT:
1531 case SPIDER_NET_GTIFMTERINT:
1532 case SPIDER_NET_GTIPKTRVKINT:
1533 case SPIDER_NET_GTISPINGINT:
1534 case SPIDER_NET_GTISADNGINT:
1535 case SPIDER_NET_GTISPDNGINT:
1536 case SPIDER_NET_GRIFMTERINT:
1537 case SPIDER_NET_GRIPKTRVKINT:
1538 case SPIDER_NET_GRISPINGINT:
1539 case SPIDER_NET_GRISADNGINT:
1540 case SPIDER_NET_GRISPDNGINT:
1541 break;
1542 */
1543 default:
1544 break;
1545 }
1546
Linas Vepstas5a028872006-12-13 15:08:25 -06001547 if ((show_error) && (netif_msg_intr(card)) && net_ratelimit())
Linas Vepstas98b90402006-10-10 16:08:42 -05001548 pr_err("Got error interrupt on %s, GHIINT0STS = 0x%08x, "
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001549 "GHIINT1STS = 0x%08x, GHIINT2STS = 0x%08x\n",
Linas Vepstas98b90402006-10-10 16:08:42 -05001550 card->netdev->name,
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001551 status_reg, error_reg1, error_reg2);
1552
1553 /* clear interrupt sources */
1554 spider_net_write_reg(card, SPIDER_NET_GHIINT1STS, error_reg1);
1555 spider_net_write_reg(card, SPIDER_NET_GHIINT2STS, error_reg2);
1556}
1557
1558/**
1559 * spider_net_interrupt - interrupt handler for spider_net
1560 * @irq: interupt number
1561 * @ptr: pointer to net_device
1562 * @regs: PU registers
1563 *
1564 * returns IRQ_HANDLED, if interrupt was for driver, or IRQ_NONE, if no
1565 * interrupt found raised by card.
1566 *
1567 * This is the interrupt handler, that turns off
1568 * interrupts for this device and makes the stack poll the driver
1569 */
1570static irqreturn_t
David Howells7d12e782006-10-05 14:55:46 +01001571spider_net_interrupt(int irq, void *ptr)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001572{
1573 struct net_device *netdev = ptr;
1574 struct spider_net_card *card = netdev_priv(netdev);
1575 u32 status_reg;
1576
1577 status_reg = spider_net_read_reg(card, SPIDER_NET_GHIINT0STS);
1578
1579 if (!status_reg)
1580 return IRQ_NONE;
1581
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001582 if (status_reg & SPIDER_NET_RXINT ) {
1583 spider_net_rx_irq_off(card);
1584 netif_rx_schedule(netdev);
1585 }
Linas Vepstas68a8c602006-10-10 16:13:05 -05001586 if (status_reg & SPIDER_NET_TXINT)
1587 netif_rx_schedule(netdev);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001588
Kou Ishizakiabdb66b2007-02-20 16:33:41 -06001589 if (status_reg & SPIDER_NET_LINKINT)
1590 spider_net_link_reset(netdev);
1591
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001592 if (status_reg & SPIDER_NET_ERRINT )
1593 spider_net_handle_error_irq(card, status_reg);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001594
1595 /* clear interrupt sources */
1596 spider_net_write_reg(card, SPIDER_NET_GHIINT0STS, status_reg);
1597
1598 return IRQ_HANDLED;
1599}
1600
1601#ifdef CONFIG_NET_POLL_CONTROLLER
1602/**
1603 * spider_net_poll_controller - artificial interrupt for netconsole etc.
1604 * @netdev: interface device structure
1605 *
1606 * see Documentation/networking/netconsole.txt
1607 */
1608static void
1609spider_net_poll_controller(struct net_device *netdev)
1610{
1611 disable_irq(netdev->irq);
David Howells7d12e782006-10-05 14:55:46 +01001612 spider_net_interrupt(netdev->irq, netdev);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001613 enable_irq(netdev->irq);
1614}
1615#endif /* CONFIG_NET_POLL_CONTROLLER */
1616
1617/**
1618 * spider_net_init_card - initializes the card
1619 * @card: card structure
1620 *
1621 * spider_net_init_card initializes the card so that other registers can
1622 * be used
1623 */
1624static void
1625spider_net_init_card(struct spider_net_card *card)
1626{
1627 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
1628 SPIDER_NET_CKRCTRL_STOP_VALUE);
1629
1630 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
1631 SPIDER_NET_CKRCTRL_RUN_VALUE);
Kou Ishizaki3342cf0e2007-02-20 16:36:14 -06001632
1633 /* trigger ETOMOD signal */
1634 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD,
1635 spider_net_read_reg(card, SPIDER_NET_GMACOPEMD) | 0x4);
1636
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001637}
1638
1639/**
1640 * spider_net_enable_card - enables the card by setting all kinds of regs
1641 * @card: card structure
1642 *
1643 * spider_net_enable_card sets a lot of SMMIO registers to enable the device
1644 */
1645static void
1646spider_net_enable_card(struct spider_net_card *card)
1647{
1648 int i;
1649 /* the following array consists of (register),(value) pairs
1650 * that are set in this function. A register of 0 ends the list */
1651 u32 regs[][2] = {
1652 { SPIDER_NET_GRESUMINTNUM, 0 },
1653 { SPIDER_NET_GREINTNUM, 0 },
1654
1655 /* set interrupt frame number registers */
1656 /* clear the single DMA engine registers first */
1657 { SPIDER_NET_GFAFRMNUM, SPIDER_NET_GFXFRAMES_VALUE },
1658 { SPIDER_NET_GFBFRMNUM, SPIDER_NET_GFXFRAMES_VALUE },
1659 { SPIDER_NET_GFCFRMNUM, SPIDER_NET_GFXFRAMES_VALUE },
1660 { SPIDER_NET_GFDFRMNUM, SPIDER_NET_GFXFRAMES_VALUE },
1661 /* then set, what we really need */
1662 { SPIDER_NET_GFFRMNUM, SPIDER_NET_FRAMENUM_VALUE },
1663
1664 /* timer counter registers and stuff */
1665 { SPIDER_NET_GFREECNNUM, 0 },
1666 { SPIDER_NET_GONETIMENUM, 0 },
1667 { SPIDER_NET_GTOUTFRMNUM, 0 },
1668
1669 /* RX mode setting */
1670 { SPIDER_NET_GRXMDSET, SPIDER_NET_RXMODE_VALUE },
1671 /* TX mode setting */
1672 { SPIDER_NET_GTXMDSET, SPIDER_NET_TXMODE_VALUE },
1673 /* IPSEC mode setting */
1674 { SPIDER_NET_GIPSECINIT, SPIDER_NET_IPSECINIT_VALUE },
1675
1676 { SPIDER_NET_GFTRESTRT, SPIDER_NET_RESTART_VALUE },
1677
1678 { SPIDER_NET_GMRWOLCTRL, 0 },
Jens Osterkampb636d172006-05-04 05:59:56 -04001679 { SPIDER_NET_GTESTMD, 0x10000000 },
1680 { SPIDER_NET_GTTQMSK, 0x00400040 },
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001681
1682 { SPIDER_NET_GMACINTEN, 0 },
1683
1684 /* flow control stuff */
1685 { SPIDER_NET_GMACAPAUSE, SPIDER_NET_MACAPAUSE_VALUE },
1686 { SPIDER_NET_GMACTXPAUSE, SPIDER_NET_TXPAUSE_VALUE },
1687
1688 { SPIDER_NET_GMACBSTLMT, SPIDER_NET_BURSTLMT_VALUE },
1689 { 0, 0}
1690 };
1691
1692 i = 0;
1693 while (regs[i][0]) {
1694 spider_net_write_reg(card, regs[i][0], regs[i][1]);
1695 i++;
1696 }
1697
1698 /* clear unicast filter table entries 1 to 14 */
1699 for (i = 1; i <= 14; i++) {
1700 spider_net_write_reg(card,
1701 SPIDER_NET_GMRUAFILnR + i * 8,
1702 0x00080000);
1703 spider_net_write_reg(card,
1704 SPIDER_NET_GMRUAFILnR + i * 8 + 4,
1705 0x00000000);
1706 }
1707
1708 spider_net_write_reg(card, SPIDER_NET_GMRUA0FIL15R, 0x08080000);
1709
1710 spider_net_write_reg(card, SPIDER_NET_ECMODE, SPIDER_NET_ECMODE_VALUE);
1711
1712 /* set chain tail adress for RX chains and
1713 * enable DMA */
1714 spider_net_enable_rxchtails(card);
1715 spider_net_enable_rxdmac(card);
1716
1717 spider_net_write_reg(card, SPIDER_NET_GRXDMAEN, SPIDER_NET_WOL_VALUE);
1718
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001719 spider_net_write_reg(card, SPIDER_NET_GMACLENLMT,
1720 SPIDER_NET_LENLMT_VALUE);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001721 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD,
1722 SPIDER_NET_OPMODE_VALUE);
1723
1724 /* set interrupt mask registers */
1725 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK,
1726 SPIDER_NET_INT0_MASK_VALUE);
1727 spider_net_write_reg(card, SPIDER_NET_GHIINT1MSK,
1728 SPIDER_NET_INT1_MASK_VALUE);
1729 spider_net_write_reg(card, SPIDER_NET_GHIINT2MSK,
1730 SPIDER_NET_INT2_MASK_VALUE);
Jens Osterkampbdd01502006-07-13 11:54:08 +02001731
1732 spider_net_write_reg(card, SPIDER_NET_GDTDMACCNTR,
Linas Vepstas7bd54c82006-11-17 14:39:40 -08001733 SPIDER_NET_GDTBSTA);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001734}
1735
1736/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001737 * spider_net_download_firmware - loads firmware into the adapter
1738 * @card: card structure
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001739 * @firmware_ptr: pointer to firmware data
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001740 *
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001741 * spider_net_download_firmware loads the firmware data into the
1742 * adapter. It assumes the length etc. to be allright.
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001743 */
Arnd Bergmann0d3ea162006-01-12 17:16:41 -05001744static int
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001745spider_net_download_firmware(struct spider_net_card *card,
Jeremy Kerr1a2509c2006-07-12 15:41:03 +10001746 const void *firmware_ptr)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001747{
1748 int sequencer, i;
Jeremy Kerr1a2509c2006-07-12 15:41:03 +10001749 const u32 *fw_ptr = firmware_ptr;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001750
1751 /* stop sequencers */
1752 spider_net_write_reg(card, SPIDER_NET_GSINIT,
1753 SPIDER_NET_STOP_SEQ_VALUE);
1754
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001755 for (sequencer = 0; sequencer < SPIDER_NET_FIRMWARE_SEQS;
1756 sequencer++) {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001757 spider_net_write_reg(card,
1758 SPIDER_NET_GSnPRGADR + sequencer * 8, 0);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001759 for (i = 0; i < SPIDER_NET_FIRMWARE_SEQWORDS; i++) {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001760 spider_net_write_reg(card, SPIDER_NET_GSnPRGDAT +
1761 sequencer * 8, *fw_ptr);
1762 fw_ptr++;
1763 }
1764 }
1765
Arnd Bergmann0d3ea162006-01-12 17:16:41 -05001766 if (spider_net_read_reg(card, SPIDER_NET_GSINIT))
1767 return -EIO;
1768
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001769 spider_net_write_reg(card, SPIDER_NET_GSINIT,
1770 SPIDER_NET_RUN_SEQ_VALUE);
Arnd Bergmann0d3ea162006-01-12 17:16:41 -05001771
1772 return 0;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001773}
1774
1775/**
1776 * spider_net_init_firmware - reads in firmware parts
1777 * @card: card structure
1778 *
1779 * Returns 0 on success, <0 on failure
1780 *
1781 * spider_net_init_firmware opens the sequencer firmware and does some basic
1782 * checks. This function opens and releases the firmware structure. A call
1783 * to download the firmware is performed before the release.
1784 *
1785 * Firmware format
1786 * ===============
1787 * spider_fw.bin is expected to be a file containing 6*1024*4 bytes, 4k being
1788 * the program for each sequencer. Use the command
1789 * tail -q -n +2 Seq_code1_0x088.txt Seq_code2_0x090.txt \
1790 * Seq_code3_0x098.txt Seq_code4_0x0A0.txt Seq_code5_0x0A8.txt \
1791 * Seq_code6_0x0B0.txt | xxd -r -p -c4 > spider_fw.bin
1792 *
1793 * to generate spider_fw.bin, if you have sequencer programs with something
1794 * like the following contents for each sequencer:
1795 * <ONE LINE COMMENT>
1796 * <FIRST 4-BYTES-WORD FOR SEQUENCER>
1797 * <SECOND 4-BYTES-WORD FOR SEQUENCER>
1798 * ...
1799 * <1024th 4-BYTES-WORD FOR SEQUENCER>
1800 */
1801static int
1802spider_net_init_firmware(struct spider_net_card *card)
1803{
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001804 struct firmware *firmware = NULL;
Arnd Bergmann030d6752006-01-12 17:16:42 -05001805 struct device_node *dn;
Jeremy Kerr1a2509c2006-07-12 15:41:03 +10001806 const u8 *fw_prop = NULL;
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001807 int err = -ENOENT;
1808 int fw_size;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001809
Arnd Bergmann030d6752006-01-12 17:16:42 -05001810 if (request_firmware((const struct firmware **)&firmware,
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001811 SPIDER_NET_FIRMWARE_NAME, &card->pdev->dev) == 0) {
1812 if ( (firmware->size != SPIDER_NET_FIRMWARE_LEN) &&
1813 netif_msg_probe(card) ) {
1814 pr_err("Incorrect size of spidernet firmware in " \
1815 "filesystem. Looking in host firmware...\n");
1816 goto try_host_fw;
1817 }
1818 err = spider_net_download_firmware(card, firmware->data);
Arnd Bergmann030d6752006-01-12 17:16:42 -05001819
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001820 release_firmware(firmware);
1821 if (err)
1822 goto try_host_fw;
Arnd Bergmann030d6752006-01-12 17:16:42 -05001823
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001824 goto done;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001825 }
1826
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001827try_host_fw:
1828 dn = pci_device_to_OF_node(card->pdev);
1829 if (!dn)
1830 goto out_err;
1831
Stephen Rothwell40cd3a42007-05-01 13:54:02 +10001832 fw_prop = of_get_property(dn, "firmware", &fw_size);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001833 if (!fw_prop)
1834 goto out_err;
1835
1836 if ( (fw_size != SPIDER_NET_FIRMWARE_LEN) &&
1837 netif_msg_probe(card) ) {
1838 pr_err("Incorrect size of spidernet firmware in " \
1839 "host firmware\n");
1840 goto done;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001841 }
1842
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001843 err = spider_net_download_firmware(card, fw_prop);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001844
Arnd Bergmann11f1a522006-01-12 17:16:44 -05001845done:
1846 return err;
1847out_err:
1848 if (netif_msg_probe(card))
1849 pr_err("Couldn't find spidernet firmware in filesystem " \
1850 "or host firmware\n");
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07001851 return err;
1852}
1853
1854/**
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001855 * spider_net_open - called upon ifonfig up
1856 * @netdev: interface device structure
1857 *
1858 * returns 0 on success, <0 on failure
1859 *
1860 * spider_net_open allocates all the descriptors and memory needed for
1861 * operation, sets up multicast list and enables interrupts
1862 */
1863int
1864spider_net_open(struct net_device *netdev)
1865{
1866 struct spider_net_card *card = netdev_priv(netdev);
1867 int result;
1868
1869 result = spider_net_init_firmware(card);
1870 if (result)
1871 goto init_firmware_failed;
1872
1873 /* start probing with copper */
1874 spider_net_setup_aneg(card);
1875 if (card->phy.def->phy_id)
1876 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER);
1877
1878 result = spider_net_init_chain(card, &card->tx_chain);
1879 if (result)
1880 goto alloc_tx_failed;
1881 card->low_watermark = NULL;
1882
1883 result = spider_net_init_chain(card, &card->rx_chain);
1884 if (result)
1885 goto alloc_rx_failed;
1886
1887 /* Allocate rx skbs */
1888 if (spider_net_alloc_rx_skbs(card))
1889 goto alloc_skbs_failed;
1890
1891 spider_net_set_multi(netdev);
1892
1893 /* further enhancement: setup hw vlan, if needed */
1894
1895 result = -EBUSY;
1896 if (request_irq(netdev->irq, spider_net_interrupt,
1897 IRQF_SHARED, netdev->name, netdev))
1898 goto register_int_failed;
1899
1900 spider_net_enable_card(card);
1901
1902 netif_start_queue(netdev);
1903 netif_carrier_on(netdev);
1904 netif_poll_enable(netdev);
1905
1906 return 0;
1907
1908register_int_failed:
1909 spider_net_free_rx_chain_contents(card);
1910alloc_skbs_failed:
1911 spider_net_free_chain(card, &card->rx_chain);
1912alloc_rx_failed:
1913 spider_net_free_chain(card, &card->tx_chain);
1914alloc_tx_failed:
1915 del_timer_sync(&card->aneg_timer);
1916init_firmware_failed:
1917 return result;
1918}
1919
1920/**
1921 * spider_net_link_phy
1922 * @data: used for pointer to card structure
1923 *
1924 */
1925static void spider_net_link_phy(unsigned long data)
1926{
1927 struct spider_net_card *card = (struct spider_net_card *)data;
1928 struct mii_phy *phy = &card->phy;
1929
1930 /* if link didn't come up after SPIDER_NET_ANEG_TIMEOUT tries, setup phy again */
1931 if (card->aneg_count > SPIDER_NET_ANEG_TIMEOUT) {
1932
1933 pr_info("%s: link is down trying to bring it up\n", card->netdev->name);
1934
Jens Osterkamp4b23a552007-02-20 16:39:13 -06001935 switch (card->medium) {
1936 case BCM54XX_COPPER:
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001937 /* enable fiber with autonegotiation first */
1938 if (phy->def->ops->enable_fiber)
1939 phy->def->ops->enable_fiber(phy, 1);
Jens Osterkamp4b23a552007-02-20 16:39:13 -06001940 card->medium = BCM54XX_FIBER;
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001941 break;
1942
Jens Osterkamp4b23a552007-02-20 16:39:13 -06001943 case BCM54XX_FIBER:
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001944 /* fiber didn't come up, try to disable fiber autoneg */
1945 if (phy->def->ops->enable_fiber)
1946 phy->def->ops->enable_fiber(phy, 0);
Jens Osterkamp4b23a552007-02-20 16:39:13 -06001947 card->medium = BCM54XX_UNKNOWN;
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001948 break;
1949
Jens Osterkamp4b23a552007-02-20 16:39:13 -06001950 case BCM54XX_UNKNOWN:
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001951 /* copper, fiber with and without failed,
1952 * retry from beginning */
1953 spider_net_setup_aneg(card);
Jens Osterkamp4b23a552007-02-20 16:39:13 -06001954 card->medium = BCM54XX_COPPER;
Kou Ishizaki3cf761d2007-02-20 16:34:50 -06001955 break;
1956 }
1957
1958 card->aneg_count = 0;
1959 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER);
1960 return;
1961 }
1962
1963 /* link still not up, try again later */
1964 if (!(phy->def->ops->poll_link(phy))) {
1965 card->aneg_count++;
1966 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER);
1967 return;
1968 }
1969
1970 /* link came up, get abilities */
1971 phy->def->ops->read_link(phy);
1972
1973 spider_net_write_reg(card, SPIDER_NET_GMACST,
1974 spider_net_read_reg(card, SPIDER_NET_GMACST));
1975 spider_net_write_reg(card, SPIDER_NET_GMACINTEN, 0x4);
1976
1977 if (phy->speed == 1000)
1978 spider_net_write_reg(card, SPIDER_NET_GMACMODE, 0x00000001);
1979 else
1980 spider_net_write_reg(card, SPIDER_NET_GMACMODE, 0);
1981
1982 card->aneg_count = 0;
1983
1984 pr_debug("Found %s with %i Mbps, %s-duplex %sautoneg.\n",
1985 phy->def->name, phy->speed, phy->duplex==1 ? "Full" : "Half",
1986 phy->autoneg==1 ? "" : "no ");
1987
1988 return;
1989}
1990
1991/**
1992 * spider_net_setup_phy - setup PHY
1993 * @card: card structure
1994 *
1995 * returns 0 on success, <0 on failure
1996 *
1997 * spider_net_setup_phy is used as part of spider_net_probe.
1998 **/
1999static int
2000spider_net_setup_phy(struct spider_net_card *card)
2001{
2002 struct mii_phy *phy = &card->phy;
2003
2004 spider_net_write_reg(card, SPIDER_NET_GDTDMASEL,
2005 SPIDER_NET_DMASEL_VALUE);
2006 spider_net_write_reg(card, SPIDER_NET_GPCCTRL,
2007 SPIDER_NET_PHY_CTRL_VALUE);
2008
2009 phy->dev = card->netdev;
2010 phy->mdio_read = spider_net_read_phy;
2011 phy->mdio_write = spider_net_write_phy;
2012
2013 for (phy->mii_id = 1; phy->mii_id <= 31; phy->mii_id++) {
2014 unsigned short id;
2015 id = spider_net_read_phy(card->netdev, phy->mii_id, MII_BMSR);
2016 if (id != 0x0000 && id != 0xffff) {
2017 if (!mii_phy_probe(phy, phy->mii_id)) {
2018 pr_info("Found %s.\n", phy->def->name);
2019 break;
2020 }
2021 }
2022 }
2023
2024 return 0;
2025}
2026
2027/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002028 * spider_net_workaround_rxramfull - work around firmware bug
2029 * @card: card structure
2030 *
2031 * no return value
2032 **/
2033static void
2034spider_net_workaround_rxramfull(struct spider_net_card *card)
2035{
2036 int i, sequencer = 0;
2037
2038 /* cancel reset */
2039 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
2040 SPIDER_NET_CKRCTRL_RUN_VALUE);
2041
2042 /* empty sequencer data */
Arnd Bergmann11f1a522006-01-12 17:16:44 -05002043 for (sequencer = 0; sequencer < SPIDER_NET_FIRMWARE_SEQS;
2044 sequencer++) {
Jens Osterkampee962a52006-07-13 11:54:23 +02002045 spider_net_write_reg(card, SPIDER_NET_GSnPRGADR +
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002046 sequencer * 8, 0x0);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05002047 for (i = 0; i < SPIDER_NET_FIRMWARE_SEQWORDS; i++) {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002048 spider_net_write_reg(card, SPIDER_NET_GSnPRGDAT +
2049 sequencer * 8, 0x0);
2050 }
2051 }
2052
2053 /* set sequencer operation */
2054 spider_net_write_reg(card, SPIDER_NET_GSINIT, 0x000000fe);
2055
2056 /* reset */
2057 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
2058 SPIDER_NET_CKRCTRL_STOP_VALUE);
2059}
2060
2061/**
Jens Osterkampbdd01502006-07-13 11:54:08 +02002062 * spider_net_stop - called upon ifconfig down
2063 * @netdev: interface device structure
2064 *
2065 * always returns 0
2066 */
2067int
2068spider_net_stop(struct net_device *netdev)
2069{
2070 struct spider_net_card *card = netdev_priv(netdev);
2071
Jens Osterkampbdd01502006-07-13 11:54:08 +02002072 netif_poll_disable(netdev);
2073 netif_carrier_off(netdev);
2074 netif_stop_queue(netdev);
2075 del_timer_sync(&card->tx_timer);
Kou Ishizakiabdb66b2007-02-20 16:33:41 -06002076 del_timer_sync(&card->aneg_timer);
Jens Osterkampbdd01502006-07-13 11:54:08 +02002077
2078 /* disable/mask all interrupts */
2079 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, 0);
2080 spider_net_write_reg(card, SPIDER_NET_GHIINT1MSK, 0);
2081 spider_net_write_reg(card, SPIDER_NET_GHIINT2MSK, 0);
Kou Ishizakiabdb66b2007-02-20 16:33:41 -06002082 spider_net_write_reg(card, SPIDER_NET_GMACINTEN, 0);
Jens Osterkampbdd01502006-07-13 11:54:08 +02002083
Linas Vepstasd406eaf2007-02-20 16:32:00 -06002084 free_irq(netdev->irq, netdev);
Jens Osterkampbdd01502006-07-13 11:54:08 +02002085
2086 spider_net_write_reg(card, SPIDER_NET_GDTDMACCNTR,
2087 SPIDER_NET_DMA_TX_FEND_VALUE);
2088
2089 /* turn off DMA, force end */
2090 spider_net_disable_rxdmac(card);
2091
2092 /* release chains */
Linas Vepstas9cc7bf72006-10-10 16:14:29 -05002093 spider_net_release_tx_chain(card, 1);
Linas Vepstasd4ed8f82006-12-13 15:06:59 -06002094 spider_net_free_rx_chain_contents(card);
Jens Osterkampbdd01502006-07-13 11:54:08 +02002095
2096 spider_net_free_chain(card, &card->tx_chain);
2097 spider_net_free_chain(card, &card->rx_chain);
2098
2099 return 0;
2100}
2101
2102/**
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002103 * spider_net_tx_timeout_task - task scheduled by the watchdog timeout
2104 * function (to be called not under interrupt status)
2105 * @data: data, is interface device structure
2106 *
2107 * called as task when tx hangs, resets interface (if interface is up)
2108 */
2109static void
David Howellsc4028952006-11-22 14:57:56 +00002110spider_net_tx_timeout_task(struct work_struct *work)
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002111{
David Howellsc4028952006-11-22 14:57:56 +00002112 struct spider_net_card *card =
2113 container_of(work, struct spider_net_card, tx_timeout_task);
2114 struct net_device *netdev = card->netdev;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002115
2116 if (!(netdev->flags & IFF_UP))
2117 goto out;
2118
2119 netif_device_detach(netdev);
2120 spider_net_stop(netdev);
2121
2122 spider_net_workaround_rxramfull(card);
2123 spider_net_init_card(card);
2124
2125 if (spider_net_setup_phy(card))
2126 goto out;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002127
2128 spider_net_open(netdev);
Jens Osterkampbdd01502006-07-13 11:54:08 +02002129 spider_net_kick_tx_dma(card);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002130 netif_device_attach(netdev);
2131
2132out:
2133 atomic_dec(&card->tx_timeout_task_counter);
2134}
2135
2136/**
2137 * spider_net_tx_timeout - called when the tx timeout watchdog kicks in.
2138 * @netdev: interface device structure
2139 *
2140 * called, if tx hangs. Schedules a task that resets the interface
2141 */
2142static void
2143spider_net_tx_timeout(struct net_device *netdev)
2144{
2145 struct spider_net_card *card;
2146
2147 card = netdev_priv(netdev);
2148 atomic_inc(&card->tx_timeout_task_counter);
2149 if (netdev->flags & IFF_UP)
2150 schedule_work(&card->tx_timeout_task);
2151 else
2152 atomic_dec(&card->tx_timeout_task_counter);
Jim Lewis9b6b0b82006-09-22 17:22:53 -07002153 card->spider_stats.tx_timeouts++;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002154}
2155
2156/**
2157 * spider_net_setup_netdev_ops - initialization of net_device operations
2158 * @netdev: net_device structure
2159 *
2160 * fills out function pointers in the net_device structure
2161 */
2162static void
2163spider_net_setup_netdev_ops(struct net_device *netdev)
2164{
2165 netdev->open = &spider_net_open;
2166 netdev->stop = &spider_net_stop;
2167 netdev->hard_start_xmit = &spider_net_xmit;
2168 netdev->get_stats = &spider_net_get_stats;
2169 netdev->set_multicast_list = &spider_net_set_multi;
2170 netdev->set_mac_address = &spider_net_set_mac;
2171 netdev->change_mtu = &spider_net_change_mtu;
2172 netdev->do_ioctl = &spider_net_do_ioctl;
2173 /* tx watchdog */
2174 netdev->tx_timeout = &spider_net_tx_timeout;
2175 netdev->watchdog_timeo = SPIDER_NET_WATCHDOG_TIMEOUT;
2176 /* NAPI */
2177 netdev->poll = &spider_net_poll;
2178 netdev->weight = SPIDER_NET_NAPI_WEIGHT;
2179 /* HW VLAN */
2180 netdev->vlan_rx_register = &spider_net_vlan_rx_reg;
2181 netdev->vlan_rx_add_vid = &spider_net_vlan_rx_add;
2182 netdev->vlan_rx_kill_vid = &spider_net_vlan_rx_kill;
2183#ifdef CONFIG_NET_POLL_CONTROLLER
2184 /* poll controller */
2185 netdev->poll_controller = &spider_net_poll_controller;
2186#endif /* CONFIG_NET_POLL_CONTROLLER */
2187 /* ethtool ops */
2188 netdev->ethtool_ops = &spider_net_ethtool_ops;
2189}
2190
2191/**
2192 * spider_net_setup_netdev - initialization of net_device
2193 * @card: card structure
2194 *
2195 * Returns 0 on success or <0 on failure
2196 *
2197 * spider_net_setup_netdev initializes the net_device structure
2198 **/
2199static int
2200spider_net_setup_netdev(struct spider_net_card *card)
2201{
2202 int result;
2203 struct net_device *netdev = card->netdev;
2204 struct device_node *dn;
2205 struct sockaddr addr;
Jeremy Kerr1a2509c2006-07-12 15:41:03 +10002206 const u8 *mac;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002207
2208 SET_MODULE_OWNER(netdev);
2209 SET_NETDEV_DEV(netdev, &card->pdev->dev);
2210
2211 pci_set_drvdata(card->pdev, netdev);
Arnd Bergmann11f1a522006-01-12 17:16:44 -05002212
Arnd Bergmann11f1a522006-01-12 17:16:44 -05002213 init_timer(&card->tx_timer);
2214 card->tx_timer.function =
2215 (void (*)(unsigned long)) spider_net_cleanup_tx_ring;
2216 card->tx_timer.data = (unsigned long) card;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002217 netdev->irq = card->pdev->irq;
2218
Kou Ishizakiabdb66b2007-02-20 16:33:41 -06002219 card->aneg_count = 0;
2220 init_timer(&card->aneg_timer);
2221 card->aneg_timer.function = spider_net_link_phy;
2222 card->aneg_timer.data = (unsigned long) card;
2223
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002224 card->options.rx_csum = SPIDER_NET_RX_CSUM_DEFAULT;
2225
2226 spider_net_setup_netdev_ops(netdev);
2227
Jens Osterkampbdd01502006-07-13 11:54:08 +02002228 netdev->features = NETIF_F_HW_CSUM | NETIF_F_LLTX;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002229 /* some time: NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX |
2230 * NETIF_F_HW_VLAN_FILTER */
2231
2232 netdev->irq = card->pdev->irq;
2233
2234 dn = pci_device_to_OF_node(card->pdev);
Jens Osterkamp543cec52005-09-06 19:30:54 -07002235 if (!dn)
2236 return -EIO;
2237
Stephen Rothwell40cd3a42007-05-01 13:54:02 +10002238 mac = of_get_property(dn, "local-mac-address", NULL);
Jens Osterkamp543cec52005-09-06 19:30:54 -07002239 if (!mac)
2240 return -EIO;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002241 memcpy(addr.sa_data, mac, ETH_ALEN);
2242
2243 result = spider_net_set_mac(netdev, &addr);
2244 if ((result) && (netif_msg_probe(card)))
2245 pr_err("Failed to set MAC address: %i\n", result);
2246
2247 result = register_netdev(netdev);
2248 if (result) {
2249 if (netif_msg_probe(card))
2250 pr_err("Couldn't register net_device: %i\n",
2251 result);
2252 return result;
2253 }
2254
2255 if (netif_msg_probe(card))
2256 pr_info("Initialized device %s.\n", netdev->name);
2257
2258 return 0;
2259}
2260
2261/**
2262 * spider_net_alloc_card - allocates net_device and card structure
2263 *
2264 * returns the card structure or NULL in case of errors
2265 *
2266 * the card and net_device structures are linked to each other
2267 */
2268static struct spider_net_card *
2269spider_net_alloc_card(void)
2270{
2271 struct net_device *netdev;
2272 struct spider_net_card *card;
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06002273 size_t alloc_size;
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002274
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06002275 alloc_size = sizeof(struct spider_net_card) +
2276 (tx_descriptors + rx_descriptors) * sizeof(struct spider_net_descr);
2277 netdev = alloc_etherdev(alloc_size);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002278 if (!netdev)
2279 return NULL;
2280
2281 card = netdev_priv(netdev);
2282 card->netdev = netdev;
2283 card->msg_enable = SPIDER_NET_DEFAULT_MSG;
David Howellsc4028952006-11-22 14:57:56 +00002284 INIT_WORK(&card->tx_timeout_task, spider_net_tx_timeout_task);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002285 init_waitqueue_head(&card->waitq);
2286 atomic_set(&card->tx_timeout_task_counter, 0);
2287
Linas Vepstas4cb6f9e2007-02-20 16:40:06 -06002288 card->rx_chain.num_desc = rx_descriptors;
2289 card->rx_chain.ring = card->darray;
2290 card->tx_chain.num_desc = tx_descriptors;
2291 card->tx_chain.ring = card->darray + rx_descriptors;
2292
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002293 return card;
2294}
2295
2296/**
2297 * spider_net_undo_pci_setup - releases PCI ressources
2298 * @card: card structure
2299 *
2300 * spider_net_undo_pci_setup releases the mapped regions
2301 */
2302static void
2303spider_net_undo_pci_setup(struct spider_net_card *card)
2304{
2305 iounmap(card->regs);
2306 pci_release_regions(card->pdev);
2307}
2308
2309/**
2310 * spider_net_setup_pci_dev - sets up the device in terms of PCI operations
2311 * @card: card structure
2312 * @pdev: PCI device
2313 *
2314 * Returns the card structure or NULL if any errors occur
2315 *
2316 * spider_net_setup_pci_dev initializes pdev and together with the
2317 * functions called in spider_net_open configures the device so that
2318 * data can be transferred over it
2319 * The net_device structure is attached to the card structure, if the
2320 * function returns without error.
2321 **/
2322static struct spider_net_card *
2323spider_net_setup_pci_dev(struct pci_dev *pdev)
2324{
2325 struct spider_net_card *card;
2326 unsigned long mmio_start, mmio_len;
2327
2328 if (pci_enable_device(pdev)) {
2329 pr_err("Couldn't enable PCI device\n");
2330 return NULL;
2331 }
2332
2333 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
2334 pr_err("Couldn't find proper PCI device base address.\n");
2335 goto out_disable_dev;
2336 }
2337
2338 if (pci_request_regions(pdev, spider_net_driver_name)) {
2339 pr_err("Couldn't obtain PCI resources, aborting.\n");
2340 goto out_disable_dev;
2341 }
2342
2343 pci_set_master(pdev);
2344
2345 card = spider_net_alloc_card();
2346 if (!card) {
2347 pr_err("Couldn't allocate net_device structure, "
2348 "aborting.\n");
2349 goto out_release_regions;
2350 }
2351 card->pdev = pdev;
2352
2353 /* fetch base address and length of first resource */
2354 mmio_start = pci_resource_start(pdev, 0);
2355 mmio_len = pci_resource_len(pdev, 0);
2356
2357 card->netdev->mem_start = mmio_start;
2358 card->netdev->mem_end = mmio_start + mmio_len;
2359 card->regs = ioremap(mmio_start, mmio_len);
2360
2361 if (!card->regs) {
2362 pr_err("Couldn't obtain PCI resources, aborting.\n");
2363 goto out_release_regions;
2364 }
2365
2366 return card;
2367
2368out_release_regions:
2369 pci_release_regions(pdev);
2370out_disable_dev:
2371 pci_disable_device(pdev);
2372 pci_set_drvdata(pdev, NULL);
2373 return NULL;
2374}
2375
2376/**
2377 * spider_net_probe - initialization of a device
2378 * @pdev: PCI device
2379 * @ent: entry in the device id list
2380 *
2381 * Returns 0 on success, <0 on failure
2382 *
2383 * spider_net_probe initializes pdev and registers a net_device
2384 * structure for it. After that, the device can be ifconfig'ed up
2385 **/
2386static int __devinit
2387spider_net_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2388{
2389 int err = -EIO;
2390 struct spider_net_card *card;
2391
2392 card = spider_net_setup_pci_dev(pdev);
2393 if (!card)
2394 goto out;
2395
2396 spider_net_workaround_rxramfull(card);
2397 spider_net_init_card(card);
2398
2399 err = spider_net_setup_phy(card);
2400 if (err)
2401 goto out_undo_pci;
2402
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002403 err = spider_net_setup_netdev(card);
2404 if (err)
2405 goto out_undo_pci;
2406
2407 return 0;
2408
2409out_undo_pci:
2410 spider_net_undo_pci_setup(card);
2411 free_netdev(card->netdev);
2412out:
2413 return err;
2414}
2415
2416/**
2417 * spider_net_remove - removal of a device
2418 * @pdev: PCI device
2419 *
2420 * Returns 0 on success, <0 on failure
2421 *
2422 * spider_net_remove is called to remove the device and unregisters the
2423 * net_device
2424 **/
2425static void __devexit
2426spider_net_remove(struct pci_dev *pdev)
2427{
2428 struct net_device *netdev;
2429 struct spider_net_card *card;
2430
2431 netdev = pci_get_drvdata(pdev);
2432 card = netdev_priv(netdev);
2433
2434 wait_event(card->waitq,
2435 atomic_read(&card->tx_timeout_task_counter) == 0);
2436
2437 unregister_netdev(netdev);
Jens Osterkamp543cec52005-09-06 19:30:54 -07002438
2439 /* switch off card */
2440 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
2441 SPIDER_NET_CKRCTRL_STOP_VALUE);
2442 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
2443 SPIDER_NET_CKRCTRL_RUN_VALUE);
2444
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002445 spider_net_undo_pci_setup(card);
2446 free_netdev(netdev);
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002447}
2448
2449static struct pci_driver spider_net_driver = {
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002450 .name = spider_net_driver_name,
2451 .id_table = spider_net_pci_tbl,
2452 .probe = spider_net_probe,
2453 .remove = __devexit_p(spider_net_remove)
2454};
2455
2456/**
2457 * spider_net_init - init function when the driver is loaded
2458 *
2459 * spider_net_init registers the device driver
2460 */
2461static int __init spider_net_init(void)
2462{
Linas Vepstas90f10842006-10-10 15:56:04 -05002463 printk(KERN_INFO "Spidernet version %s.\n", VERSION);
2464
Jens Osterkampaaec0fa2005-09-05 15:19:29 -07002465 if (rx_descriptors < SPIDER_NET_RX_DESCRIPTORS_MIN) {
2466 rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_MIN;
2467 pr_info("adjusting rx descriptors to %i.\n", rx_descriptors);
2468 }
2469 if (rx_descriptors > SPIDER_NET_RX_DESCRIPTORS_MAX) {
2470 rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_MAX;
2471 pr_info("adjusting rx descriptors to %i.\n", rx_descriptors);
2472 }
2473 if (tx_descriptors < SPIDER_NET_TX_DESCRIPTORS_MIN) {
2474 tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_MIN;
2475 pr_info("adjusting tx descriptors to %i.\n", tx_descriptors);
2476 }
2477 if (tx_descriptors > SPIDER_NET_TX_DESCRIPTORS_MAX) {
2478 tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_MAX;
2479 pr_info("adjusting tx descriptors to %i.\n", tx_descriptors);
2480 }
2481
2482 return pci_register_driver(&spider_net_driver);
2483}
2484
2485/**
2486 * spider_net_cleanup - exit function when driver is unloaded
2487 *
2488 * spider_net_cleanup unregisters the device driver
2489 */
2490static void __exit spider_net_cleanup(void)
2491{
2492 pci_unregister_driver(&spider_net_driver);
2493}
2494
2495module_init(spider_net_init);
2496module_exit(spider_net_cleanup);