?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.17.7
[linux/fpc-iii.git] / drivers / net / sunhme.c
blob9f046cae2f71627baefd9fc7644952854d148c9d
1 /* $Id: sunhme.c,v 1.124 2002/01/15 06:25:51 davem Exp $
2 * sunhme.c: Sparc HME/BigMac 10/100baseT half/full duplex auto switching,
3 * auto carrier detecting ethernet driver. Also known as the
4 * "Happy Meal Ethernet" found on SunSwift SBUS cards.
5 *
6 * Copyright (C) 1996, 1998, 1999, 2002, 2003 David S. Miller (davem@redhat.com)
7 *
8 * Changes :
9 * 2000/11/11 Willy Tarreau <willy AT meta-x.org>
10 * - port to non-sparc architectures. Tested only on x86 and
11 * only currently works with QFE PCI cards.
12 * - ability to specify the MAC address at module load time by passing this
13 * argument : macaddr=0x00,0x10,0x20,0x30,0x40,0x50
14 */
15
16 #include <linux/config.h>
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/types.h>
20 #include <linux/fcntl.h>
21 #include <linux/interrupt.h>
22 #include <linux/ioport.h>
23 #include <linux/in.h>
24 #include <linux/slab.h>
25 #include <linux/string.h>
26 #include <linux/delay.h>
27 #include <linux/init.h>
28 #include <linux/ethtool.h>
29 #include <linux/mii.h>
30 #include <linux/crc32.h>
31 #include <linux/random.h>
32 #include <linux/errno.h>
33 #include <linux/netdevice.h>
34 #include <linux/etherdevice.h>
35 #include <linux/skbuff.h>
36 #include <linux/bitops.h>
37
38 #include <asm/system.h>
39 #include <asm/io.h>
40 #include <asm/dma.h>
41 #include <asm/byteorder.h>
42
43 #ifdef __sparc__
44 #include <asm/idprom.h>
45 #include <asm/sbus.h>
46 #include <asm/openprom.h>
47 #include <asm/oplib.h>
48 #include <asm/auxio.h>
49 #ifndef __sparc_v9__
50 #include <asm/io-unit.h>
51 #endif
52 #endif
53 #include <asm/uaccess.h>
54
55 #include <asm/pgtable.h>
56 #include <asm/irq.h>
57
58 #ifdef CONFIG_PCI
59 #include <linux/pci.h>
60 #ifdef __sparc__
61 #include <asm/pbm.h>
62 #endif
63 #endif
64
65 #include "sunhme.h"
66
67 #define DRV_NAME "sunhme"
68 #define DRV_VERSION "2.02"
69 #define DRV_RELDATE "8/24/03"
70 #define DRV_AUTHOR "David S. Miller (davem@redhat.com)"
71
72 static char version[] =
73 DRV_NAME ".c:v" DRV_VERSION " " DRV_RELDATE " " DRV_AUTHOR "\n";
74
75 MODULE_VERSION(DRV_VERSION);
76 MODULE_AUTHOR(DRV_AUTHOR);
77 MODULE_DESCRIPTION("Sun HappyMealEthernet(HME) 10/100baseT ethernet driver");
78 MODULE_LICENSE("GPL");
79
80 static int macaddr[6];
81
82 /* accept MAC address of the form macaddr=0x08,0x00,0x20,0x30,0x40,0x50 */
83 module_param_array(macaddr, int, NULL, 0);
84 MODULE_PARM_DESC(macaddr, "Happy Meal MAC address to set");
85
86 static struct happy_meal *root_happy_dev;
87
88 #ifdef CONFIG_SBUS
89 static struct quattro *qfe_sbus_list;
90 #endif
91
92 #ifdef CONFIG_PCI
93 static struct quattro *qfe_pci_list;
94 #endif
95
96 #undef HMEDEBUG
97 #undef SXDEBUG
98 #undef RXDEBUG
99 #undef TXDEBUG
100 #undef TXLOGGING
101
102 #ifdef TXLOGGING
103 struct hme_tx_logent {
104 unsigned int tstamp;
105 int tx_new, tx_old;
106 unsigned int action;
107 #define TXLOG_ACTION_IRQ 0x01
108 #define TXLOG_ACTION_TXMIT 0x02
109 #define TXLOG_ACTION_TBUSY 0x04
110 #define TXLOG_ACTION_NBUFS 0x08
111 unsigned int status;
112 };
113 #define TX_LOG_LEN 128
114 static struct hme_tx_logent tx_log[TX_LOG_LEN];
115 static int txlog_cur_entry;
116 static __inline__ void tx_add_log(struct happy_meal *hp, unsigned int a, unsigned int s)
117 {
118 struct hme_tx_logent *tlp;
119 unsigned long flags;
120
121 save_and_cli(flags);
122 tlp = &tx_log[txlog_cur_entry];
123 tlp->tstamp = (unsigned int)jiffies;
124 tlp->tx_new = hp->tx_new;
125 tlp->tx_old = hp->tx_old;
126 tlp->action = a;
127 tlp->status = s;
128 txlog_cur_entry = (txlog_cur_entry + 1) & (TX_LOG_LEN - 1);
129 restore_flags(flags);
130 }
131 static __inline__ void tx_dump_log(void)
132 {
133 int i, this;
134
135 this = txlog_cur_entry;
136 for (i = 0; i < TX_LOG_LEN; i++) {
137 printk("TXLOG[%d]: j[%08x] tx[N(%d)O(%d)] action[%08x] stat[%08x]\n", i,
138 tx_log[this].tstamp,
139 tx_log[this].tx_new, tx_log[this].tx_old,
140 tx_log[this].action, tx_log[this].status);
141 this = (this + 1) & (TX_LOG_LEN - 1);
142 }
143 }
144 static __inline__ void tx_dump_ring(struct happy_meal *hp)
145 {
146 struct hmeal_init_block *hb = hp->happy_block;
147 struct happy_meal_txd *tp = &hb->happy_meal_txd[0];
148 int i;
149
150 for (i = 0; i < TX_RING_SIZE; i+=4) {
151 printk("TXD[%d..%d]: [%08x:%08x] [%08x:%08x] [%08x:%08x] [%08x:%08x]\n",
152 i, i + 4,
153 le32_to_cpu(tp[i].tx_flags), le32_to_cpu(tp[i].tx_addr),
154 le32_to_cpu(tp[i + 1].tx_flags), le32_to_cpu(tp[i + 1].tx_addr),
155 le32_to_cpu(tp[i + 2].tx_flags), le32_to_cpu(tp[i + 2].tx_addr),
156 le32_to_cpu(tp[i + 3].tx_flags), le32_to_cpu(tp[i + 3].tx_addr));
157 }
158 }
159 #else
160 #define tx_add_log(hp, a, s) do { } while(0)
161 #define tx_dump_log() do { } while(0)
162 #define tx_dump_ring(hp) do { } while(0)
163 #endif
164
165 #ifdef HMEDEBUG
166 #define HMD(x) printk x
167 #else
168 #define HMD(x)
169 #endif
170
171 /* #define AUTO_SWITCH_DEBUG */
172
173 #ifdef AUTO_SWITCH_DEBUG
174 #define ASD(x) printk x
175 #else
176 #define ASD(x)
177 #endif
178
179 #define DEFAULT_IPG0 16 /* For lance-mode only */
180 #define DEFAULT_IPG1 8 /* For all modes */
181 #define DEFAULT_IPG2 4 /* For all modes */
182 #define DEFAULT_JAMSIZE 4 /* Toe jam */
183
184 #if defined(CONFIG_PCI) && defined(MODULE)
185 /* This happy_pci_ids is declared __initdata because it is only used
186 as an advisory to depmod. If this is ported to the new PCI interface
187 where it could be referenced at any time due to hot plugging,
188 the __initdata reference should be removed. */
189
190 static struct pci_device_id happymeal_pci_ids[] = {
191 {
192 .vendor = PCI_VENDOR_ID_SUN,
193 .device = PCI_DEVICE_ID_SUN_HAPPYMEAL,
194 .subvendor = PCI_ANY_ID,
195 .subdevice = PCI_ANY_ID,
196 },
197 { } /* Terminating entry */
198 };
199
200 MODULE_DEVICE_TABLE(pci, happymeal_pci_ids);
201
202 #endif
203
204 /* NOTE: In the descriptor writes one _must_ write the address
205 * member _first_. The card must not be allowed to see
206 * the updated descriptor flags until the address is
207 * correct. I've added a write memory barrier between
208 * the two stores so that I can sleep well at night... -DaveM
209 */
210
211 #if defined(CONFIG_SBUS) && defined(CONFIG_PCI)
212 static void sbus_hme_write32(void __iomem *reg, u32 val)
213 {
214 sbus_writel(val, reg);
215 }
216
217 static u32 sbus_hme_read32(void __iomem *reg)
218 {
219 return sbus_readl(reg);
220 }
221
222 static void sbus_hme_write_rxd(struct happy_meal_rxd *rxd, u32 flags, u32 addr)
223 {
224 rxd->rx_addr = addr;
225 wmb();
226 rxd->rx_flags = flags;
227 }
228
229 static void sbus_hme_write_txd(struct happy_meal_txd *txd, u32 flags, u32 addr)
230 {
231 txd->tx_addr = addr;
232 wmb();
233 txd->tx_flags = flags;
234 }
235
236 static u32 sbus_hme_read_desc32(u32 *p)
237 {
238 return *p;
239 }
240
241 static void pci_hme_write32(void __iomem *reg, u32 val)
242 {
243 writel(val, reg);
244 }
245
246 static u32 pci_hme_read32(void __iomem *reg)
247 {
248 return readl(reg);
249 }
250
251 static void pci_hme_write_rxd(struct happy_meal_rxd *rxd, u32 flags, u32 addr)
252 {
253 rxd->rx_addr = cpu_to_le32(addr);
254 wmb();
255 rxd->rx_flags = cpu_to_le32(flags);
256 }
257
258 static void pci_hme_write_txd(struct happy_meal_txd *txd, u32 flags, u32 addr)
259 {
260 txd->tx_addr = cpu_to_le32(addr);
261 wmb();
262 txd->tx_flags = cpu_to_le32(flags);
263 }
264
265 static u32 pci_hme_read_desc32(u32 *p)
266 {
267 return cpu_to_le32p(p);
268 }
269
270 #define hme_write32(__hp, __reg, __val) \
271 ((__hp)->write32((__reg), (__val)))
272 #define hme_read32(__hp, __reg) \
273 ((__hp)->read32(__reg))
274 #define hme_write_rxd(__hp, __rxd, __flags, __addr) \
275 ((__hp)->write_rxd((__rxd), (__flags), (__addr)))
276 #define hme_write_txd(__hp, __txd, __flags, __addr) \
277 ((__hp)->write_txd((__txd), (__flags), (__addr)))
278 #define hme_read_desc32(__hp, __p) \
279 ((__hp)->read_desc32(__p))
280 #define hme_dma_map(__hp, __ptr, __size, __dir) \
281 ((__hp)->dma_map((__hp)->happy_dev, (__ptr), (__size), (__dir)))
282 #define hme_dma_unmap(__hp, __addr, __size, __dir) \
283 ((__hp)->dma_unmap((__hp)->happy_dev, (__addr), (__size), (__dir)))
284 #define hme_dma_sync_for_cpu(__hp, __addr, __size, __dir) \
285 ((__hp)->dma_sync_for_cpu((__hp)->happy_dev, (__addr), (__size), (__dir)))
286 #define hme_dma_sync_for_device(__hp, __addr, __size, __dir) \
287 ((__hp)->dma_sync_for_device((__hp)->happy_dev, (__addr), (__size), (__dir)))
288 #else
289 #ifdef CONFIG_SBUS
290 /* SBUS only compilation */
291 #define hme_write32(__hp, __reg, __val) \
292 sbus_writel((__val), (__reg))
293 #define hme_read32(__hp, __reg) \
294 sbus_readl(__reg)
295 #define hme_write_rxd(__hp, __rxd, __flags, __addr) \
296 do { (__rxd)->rx_addr = (__addr); \
297 wmb(); \
298 (__rxd)->rx_flags = (__flags); \
299 } while(0)
300 #define hme_write_txd(__hp, __txd, __flags, __addr) \
301 do { (__txd)->tx_addr = (__addr); \
302 wmb(); \
303 (__txd)->tx_flags = (__flags); \
304 } while(0)
305 #define hme_read_desc32(__hp, __p) (*(__p))
306 #define hme_dma_map(__hp, __ptr, __size, __dir) \
307 sbus_map_single((__hp)->happy_dev, (__ptr), (__size), (__dir))
308 #define hme_dma_unmap(__hp, __addr, __size, __dir) \
309 sbus_unmap_single((__hp)->happy_dev, (__addr), (__size), (__dir))
310 #define hme_dma_sync_for_cpu(__hp, __addr, __size, __dir) \
311 sbus_dma_sync_single_for_cpu((__hp)->happy_dev, (__addr), (__size), (__dir))
312 #define hme_dma_sync_for_device(__hp, __addr, __size, __dir) \
313 sbus_dma_sync_single_for_device((__hp)->happy_dev, (__addr), (__size), (__dir))
314 #else
315 /* PCI only compilation */
316 #define hme_write32(__hp, __reg, __val) \
317 writel((__val), (__reg))
318 #define hme_read32(__hp, __reg) \
319 readl(__reg)
320 #define hme_write_rxd(__hp, __rxd, __flags, __addr) \
321 do { (__rxd)->rx_addr = cpu_to_le32(__addr); \
322 wmb(); \
323 (__rxd)->rx_flags = cpu_to_le32(__flags); \
324 } while(0)
325 #define hme_write_txd(__hp, __txd, __flags, __addr) \
326 do { (__txd)->tx_addr = cpu_to_le32(__addr); \
327 wmb(); \
328 (__txd)->tx_flags = cpu_to_le32(__flags); \
329 } while(0)
330 #define hme_read_desc32(__hp, __p) cpu_to_le32p(__p)
331 #define hme_dma_map(__hp, __ptr, __size, __dir) \
332 pci_map_single((__hp)->happy_dev, (__ptr), (__size), (__dir))
333 #define hme_dma_unmap(__hp, __addr, __size, __dir) \
334 pci_unmap_single((__hp)->happy_dev, (__addr), (__size), (__dir))
335 #define hme_dma_sync_for_cpu(__hp, __addr, __size, __dir) \
336 pci_dma_sync_single_for_cpu((__hp)->happy_dev, (__addr), (__size), (__dir))
337 #define hme_dma_sync_for_device(__hp, __addr, __size, __dir) \
338 pci_dma_sync_single_for_device((__hp)->happy_dev, (__addr), (__size), (__dir))
339 #endif
340 #endif
341
342
343 #ifdef SBUS_DMA_BIDIRECTIONAL
344 # define DMA_BIDIRECTIONAL SBUS_DMA_BIDIRECTIONAL
345 #else
346 # define DMA_BIDIRECTIONAL 0
347 #endif
348
349 #ifdef SBUS_DMA_FROMDEVICE
350 # define DMA_FROMDEVICE SBUS_DMA_FROMDEVICE
351 #else
352 # define DMA_TODEVICE 1
353 #endif
354
355 #ifdef SBUS_DMA_TODEVICE
356 # define DMA_TODEVICE SBUS_DMA_TODEVICE
357 #else
358 # define DMA_FROMDEVICE 2
359 #endif
360
361
362 /* Oh yes, the MIF BitBang is mighty fun to program. BitBucket is more like it. */
363 static void BB_PUT_BIT(struct happy_meal *hp, void __iomem *tregs, int bit)
364 {
365 hme_write32(hp, tregs + TCVR_BBDATA, bit);
366 hme_write32(hp, tregs + TCVR_BBCLOCK, 0);
367 hme_write32(hp, tregs + TCVR_BBCLOCK, 1);
368 }
369
370 #if 0
371 static u32 BB_GET_BIT(struct happy_meal *hp, void __iomem *tregs, int internal)
372 {
373 u32 ret;
374
375 hme_write32(hp, tregs + TCVR_BBCLOCK, 0);
376 hme_write32(hp, tregs + TCVR_BBCLOCK, 1);
377 ret = hme_read32(hp, tregs + TCVR_CFG);
378 if (internal)
379 ret &= TCV_CFG_MDIO0;
380 else
381 ret &= TCV_CFG_MDIO1;
382
383 return ret;
384 }
385 #endif
386
387 static u32 BB_GET_BIT2(struct happy_meal *hp, void __iomem *tregs, int internal)
388 {
389 u32 retval;
390
391 hme_write32(hp, tregs + TCVR_BBCLOCK, 0);
392 udelay(1);
393 retval = hme_read32(hp, tregs + TCVR_CFG);
394 if (internal)
395 retval &= TCV_CFG_MDIO0;
396 else
397 retval &= TCV_CFG_MDIO1;
398 hme_write32(hp, tregs + TCVR_BBCLOCK, 1);
399
400 return retval;
401 }
402
403 #define TCVR_FAILURE 0x80000000 /* Impossible MIF read value */
404
405 static int happy_meal_bb_read(struct happy_meal *hp,
406 void __iomem *tregs, int reg)
407 {
408 u32 tmp;
409 int retval = 0;
410 int i;
411
412 ASD(("happy_meal_bb_read: reg=%d ", reg));
413
414 /* Enable the MIF BitBang outputs. */
415 hme_write32(hp, tregs + TCVR_BBOENAB, 1);
416
417 /* Force BitBang into the idle state. */
418 for (i = 0; i < 32; i++)
419 BB_PUT_BIT(hp, tregs, 1);
420
421 /* Give it the read sequence. */
422 BB_PUT_BIT(hp, tregs, 0);
423 BB_PUT_BIT(hp, tregs, 1);
424 BB_PUT_BIT(hp, tregs, 1);
425 BB_PUT_BIT(hp, tregs, 0);
426
427 /* Give it the PHY address. */
428 tmp = hp->paddr & 0xff;
429 for (i = 4; i >= 0; i--)
430 BB_PUT_BIT(hp, tregs, ((tmp >> i) & 1));
431
432 /* Tell it what register we want to read. */
433 tmp = (reg & 0xff);
434 for (i = 4; i >= 0; i--)
435 BB_PUT_BIT(hp, tregs, ((tmp >> i) & 1));
436
437 /* Close down the MIF BitBang outputs. */
438 hme_write32(hp, tregs + TCVR_BBOENAB, 0);
439
440 /* Now read in the value. */
441 (void) BB_GET_BIT2(hp, tregs, (hp->tcvr_type == internal));
442 for (i = 15; i >= 0; i--)
443 retval |= BB_GET_BIT2(hp, tregs, (hp->tcvr_type == internal));
444 (void) BB_GET_BIT2(hp, tregs, (hp->tcvr_type == internal));
445 (void) BB_GET_BIT2(hp, tregs, (hp->tcvr_type == internal));
446 (void) BB_GET_BIT2(hp, tregs, (hp->tcvr_type == internal));
447 ASD(("value=%x\n", retval));
448 return retval;
449 }
450
451 static void happy_meal_bb_write(struct happy_meal *hp,
452 void __iomem *tregs, int reg,
453 unsigned short value)
454 {
455 u32 tmp;
456 int i;
457
458 ASD(("happy_meal_bb_write: reg=%d value=%x\n", reg, value));
459
460 /* Enable the MIF BitBang outputs. */
461 hme_write32(hp, tregs + TCVR_BBOENAB, 1);
462
463 /* Force BitBang into the idle state. */
464 for (i = 0; i < 32; i++)
465 BB_PUT_BIT(hp, tregs, 1);
466
467 /* Give it write sequence. */
468 BB_PUT_BIT(hp, tregs, 0);
469 BB_PUT_BIT(hp, tregs, 1);
470 BB_PUT_BIT(hp, tregs, 0);
471 BB_PUT_BIT(hp, tregs, 1);
472
473 /* Give it the PHY address. */
474 tmp = (hp->paddr & 0xff);
475 for (i = 4; i >= 0; i--)
476 BB_PUT_BIT(hp, tregs, ((tmp >> i) & 1));
477
478 /* Tell it what register we will be writing. */
479 tmp = (reg & 0xff);
480 for (i = 4; i >= 0; i--)
481 BB_PUT_BIT(hp, tregs, ((tmp >> i) & 1));
482
483 /* Tell it to become ready for the bits. */
484 BB_PUT_BIT(hp, tregs, 1);
485 BB_PUT_BIT(hp, tregs, 0);
486
487 for (i = 15; i >= 0; i--)
488 BB_PUT_BIT(hp, tregs, ((value >> i) & 1));
489
490 /* Close down the MIF BitBang outputs. */
491 hme_write32(hp, tregs + TCVR_BBOENAB, 0);
492 }
493
494 #define TCVR_READ_TRIES 16
495
496 static int happy_meal_tcvr_read(struct happy_meal *hp,
497 void __iomem *tregs, int reg)
498 {
499 int tries = TCVR_READ_TRIES;
500 int retval;
501
502 ASD(("happy_meal_tcvr_read: reg=0x%02x ", reg));
503 if (hp->tcvr_type == none) {
504 ASD(("no transceiver, value=TCVR_FAILURE\n"));
505 return TCVR_FAILURE;
506 }
507
508 if (!(hp->happy_flags & HFLAG_FENABLE)) {
509 ASD(("doing bit bang\n"));
510 return happy_meal_bb_read(hp, tregs, reg);
511 }
512
513 hme_write32(hp, tregs + TCVR_FRAME,
514 (FRAME_READ | (hp->paddr << 23) | ((reg & 0xff) << 18)));
515 while (!(hme_read32(hp, tregs + TCVR_FRAME) & 0x10000) && --tries)
516 udelay(20);
517 if (!tries) {
518 printk(KERN_ERR "happy meal: Aieee, transceiver MIF read bolixed\n");
519 return TCVR_FAILURE;
520 }
521 retval = hme_read32(hp, tregs + TCVR_FRAME) & 0xffff;
522 ASD(("value=%04x\n", retval));
523 return retval;
524 }
525
526 #define TCVR_WRITE_TRIES 16
527
528 static void happy_meal_tcvr_write(struct happy_meal *hp,
529 void __iomem *tregs, int reg,
530 unsigned short value)
531 {
532 int tries = TCVR_WRITE_TRIES;
533
534 ASD(("happy_meal_tcvr_write: reg=0x%02x value=%04x\n", reg, value));
535
536 /* Welcome to Sun Microsystems, can I take your order please? */
537 if (!(hp->happy_flags & HFLAG_FENABLE)) {
538 happy_meal_bb_write(hp, tregs, reg, value);
539 return;
540 }
541
542 /* Would you like fries with that? */
543 hme_write32(hp, tregs + TCVR_FRAME,
544 (FRAME_WRITE | (hp->paddr << 23) |
545 ((reg & 0xff) << 18) | (value & 0xffff)));
546 while (!(hme_read32(hp, tregs + TCVR_FRAME) & 0x10000) && --tries)
547 udelay(20);
548
549 /* Anything else? */
550 if (!tries)
551 printk(KERN_ERR "happy meal: Aieee, transceiver MIF write bolixed\n");
552
553 /* Fifty-two cents is your change, have a nice day. */
554 }
555
556 /* Auto negotiation. The scheme is very simple. We have a timer routine
557 * that keeps watching the auto negotiation process as it progresses.
558 * The DP83840 is first told to start doing it's thing, we set up the time
559 * and place the timer state machine in it's initial state.
560 *
561 * Here the timer peeks at the DP83840 status registers at each click to see
562 * if the auto negotiation has completed, we assume here that the DP83840 PHY
563 * will time out at some point and just tell us what (didn't) happen. For
564 * complete coverage we only allow so many of the ticks at this level to run,
565 * when this has expired we print a warning message and try another strategy.
566 * This "other" strategy is to force the interface into various speed/duplex
567 * configurations and we stop when we see a link-up condition before the
568 * maximum number of "peek" ticks have occurred.
569 *
570 * Once a valid link status has been detected we configure the BigMAC and
571 * the rest of the Happy Meal to speak the most efficient protocol we could
572 * get a clean link for. The priority for link configurations, highest first
573 * is:
574 * 100 Base-T Full Duplex
575 * 100 Base-T Half Duplex
576 * 10 Base-T Full Duplex
577 * 10 Base-T Half Duplex
578 *
579 * We start a new timer now, after a successful auto negotiation status has
580 * been detected. This timer just waits for the link-up bit to get set in
581 * the BMCR of the DP83840. When this occurs we print a kernel log message
582 * describing the link type in use and the fact that it is up.
583 *
584 * If a fatal error of some sort is signalled and detected in the interrupt
585 * service routine, and the chip is reset, or the link is ifconfig'd down
586 * and then back up, this entire process repeats itself all over again.
587 */
588 static int try_next_permutation(struct happy_meal *hp, void __iomem *tregs)
589 {
590 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
591
592 /* Downgrade from full to half duplex. Only possible
593 * via ethtool.
594 */
595 if (hp->sw_bmcr & BMCR_FULLDPLX) {
596 hp->sw_bmcr &= ~(BMCR_FULLDPLX);
597 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
598 return 0;
599 }
600
601 /* Downgrade from 100 to 10. */
602 if (hp->sw_bmcr & BMCR_SPEED100) {
603 hp->sw_bmcr &= ~(BMCR_SPEED100);
604 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
605 return 0;
606 }
607
608 /* We've tried everything. */
609 return -1;
610 }
611
612 static void display_link_mode(struct happy_meal *hp, void __iomem *tregs)
613 {
614 printk(KERN_INFO "%s: Link is up using ", hp->dev->name);
615 if (hp->tcvr_type == external)
616 printk("external ");
617 else
618 printk("internal ");
619 printk("transceiver at ");
620 hp->sw_lpa = happy_meal_tcvr_read(hp, tregs, MII_LPA);
621 if (hp->sw_lpa & (LPA_100HALF | LPA_100FULL)) {
622 if (hp->sw_lpa & LPA_100FULL)
623 printk("100Mb/s, Full Duplex.\n");
624 else
625 printk("100Mb/s, Half Duplex.\n");
626 } else {
627 if (hp->sw_lpa & LPA_10FULL)
628 printk("10Mb/s, Full Duplex.\n");
629 else
630 printk("10Mb/s, Half Duplex.\n");
631 }
632 }
633
634 static void display_forced_link_mode(struct happy_meal *hp, void __iomem *tregs)
635 {
636 printk(KERN_INFO "%s: Link has been forced up using ", hp->dev->name);
637 if (hp->tcvr_type == external)
638 printk("external ");
639 else
640 printk("internal ");
641 printk("transceiver at ");
642 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
643 if (hp->sw_bmcr & BMCR_SPEED100)
644 printk("100Mb/s, ");
645 else
646 printk("10Mb/s, ");
647 if (hp->sw_bmcr & BMCR_FULLDPLX)
648 printk("Full Duplex.\n");
649 else
650 printk("Half Duplex.\n");
651 }
652
653 static int set_happy_link_modes(struct happy_meal *hp, void __iomem *tregs)
654 {
655 int full;
656
657 /* All we care about is making sure the bigmac tx_cfg has a
658 * proper duplex setting.
659 */
660 if (hp->timer_state == arbwait) {
661 hp->sw_lpa = happy_meal_tcvr_read(hp, tregs, MII_LPA);
662 if (!(hp->sw_lpa & (LPA_10HALF | LPA_10FULL | LPA_100HALF | LPA_100FULL)))
663 goto no_response;
664 if (hp->sw_lpa & LPA_100FULL)
665 full = 1;
666 else if (hp->sw_lpa & LPA_100HALF)
667 full = 0;
668 else if (hp->sw_lpa & LPA_10FULL)
669 full = 1;
670 else
671 full = 0;
672 } else {
673 /* Forcing a link mode. */
674 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
675 if (hp->sw_bmcr & BMCR_FULLDPLX)
676 full = 1;
677 else
678 full = 0;
679 }
680
681 /* Before changing other bits in the tx_cfg register, and in
682 * general any of other the TX config registers too, you
683 * must:
684 * 1) Clear Enable
685 * 2) Poll with reads until that bit reads back as zero
686 * 3) Make TX configuration changes
687 * 4) Set Enable once more
688 */
689 hme_write32(hp, hp->bigmacregs + BMAC_TXCFG,
690 hme_read32(hp, hp->bigmacregs + BMAC_TXCFG) &
691 ~(BIGMAC_TXCFG_ENABLE));
692 while (hme_read32(hp, hp->bigmacregs + BMAC_TXCFG) & BIGMAC_TXCFG_ENABLE)
693 barrier();
694 if (full) {
695 hp->happy_flags |= HFLAG_FULL;
696 hme_write32(hp, hp->bigmacregs + BMAC_TXCFG,
697 hme_read32(hp, hp->bigmacregs + BMAC_TXCFG) |
698 BIGMAC_TXCFG_FULLDPLX);
699 } else {
700 hp->happy_flags &= ~(HFLAG_FULL);
701 hme_write32(hp, hp->bigmacregs + BMAC_TXCFG,
702 hme_read32(hp, hp->bigmacregs + BMAC_TXCFG) &
703 ~(BIGMAC_TXCFG_FULLDPLX));
704 }
705 hme_write32(hp, hp->bigmacregs + BMAC_TXCFG,
706 hme_read32(hp, hp->bigmacregs + BMAC_TXCFG) |
707 BIGMAC_TXCFG_ENABLE);
708 return 0;
709 no_response:
710 return 1;
711 }
712
713 static int happy_meal_init(struct happy_meal *hp);
714
715 static int is_lucent_phy(struct happy_meal *hp)
716 {
717 void __iomem *tregs = hp->tcvregs;
718 unsigned short mr2, mr3;
719 int ret = 0;
720
721 mr2 = happy_meal_tcvr_read(hp, tregs, 2);
722 mr3 = happy_meal_tcvr_read(hp, tregs, 3);
723 if ((mr2 & 0xffff) == 0x0180 &&
724 ((mr3 & 0xffff) >> 10) == 0x1d)
725 ret = 1;
726
727 return ret;
728 }
729
730 static void happy_meal_timer(unsigned long data)
731 {
732 struct happy_meal *hp = (struct happy_meal *) data;
733 void __iomem *tregs = hp->tcvregs;
734 int restart_timer = 0;
735
736 spin_lock_irq(&hp->happy_lock);
737
738 hp->timer_ticks++;
739 switch(hp->timer_state) {
740 case arbwait:
741 /* Only allow for 5 ticks, thats 10 seconds and much too
742 * long to wait for arbitration to complete.
743 */
744 if (hp->timer_ticks >= 10) {
745 /* Enter force mode. */
746 do_force_mode:
747 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
748 printk(KERN_NOTICE "%s: Auto-Negotiation unsuccessful, trying force link mode\n",
749 hp->dev->name);
750 hp->sw_bmcr = BMCR_SPEED100;
751 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
752
753 if (!is_lucent_phy(hp)) {
754 /* OK, seems we need do disable the transceiver for the first
755 * tick to make sure we get an accurate link state at the
756 * second tick.
757 */
758 hp->sw_csconfig = happy_meal_tcvr_read(hp, tregs, DP83840_CSCONFIG);
759 hp->sw_csconfig &= ~(CSCONFIG_TCVDISAB);
760 happy_meal_tcvr_write(hp, tregs, DP83840_CSCONFIG, hp->sw_csconfig);
761 }
762 hp->timer_state = ltrywait;
763 hp->timer_ticks = 0;
764 restart_timer = 1;
765 } else {
766 /* Anything interesting happen? */
767 hp->sw_bmsr = happy_meal_tcvr_read(hp, tregs, MII_BMSR);
768 if (hp->sw_bmsr & BMSR_ANEGCOMPLETE) {
769 int ret;
770
771 /* Just what we've been waiting for... */
772 ret = set_happy_link_modes(hp, tregs);
773 if (ret) {
774 /* Ooops, something bad happened, go to force
775 * mode.
776 *
777 * XXX Broken hubs which don't support 802.3u
778 * XXX auto-negotiation make this happen as well.
779 */
780 goto do_force_mode;
781 }
782
783 /* Success, at least so far, advance our state engine. */
784 hp->timer_state = lupwait;
785 restart_timer = 1;
786 } else {
787 restart_timer = 1;
788 }
789 }
790 break;
791
792 case lupwait:
793 /* Auto negotiation was successful and we are awaiting a
794 * link up status. I have decided to let this timer run
795 * forever until some sort of error is signalled, reporting
796 * a message to the user at 10 second intervals.
797 */
798 hp->sw_bmsr = happy_meal_tcvr_read(hp, tregs, MII_BMSR);
799 if (hp->sw_bmsr & BMSR_LSTATUS) {
800 /* Wheee, it's up, display the link mode in use and put
801 * the timer to sleep.
802 */
803 display_link_mode(hp, tregs);
804 hp->timer_state = asleep;
805 restart_timer = 0;
806 } else {
807 if (hp->timer_ticks >= 10) {
808 printk(KERN_NOTICE "%s: Auto negotiation successful, link still "
809 "not completely up.\n", hp->dev->name);
810 hp->timer_ticks = 0;
811 restart_timer = 1;
812 } else {
813 restart_timer = 1;
814 }
815 }
816 break;
817
818 case ltrywait:
819 /* Making the timeout here too long can make it take
820 * annoyingly long to attempt all of the link mode
821 * permutations, but then again this is essentially
822 * error recovery code for the most part.
823 */
824 hp->sw_bmsr = happy_meal_tcvr_read(hp, tregs, MII_BMSR);
825 hp->sw_csconfig = happy_meal_tcvr_read(hp, tregs, DP83840_CSCONFIG);
826 if (hp->timer_ticks == 1) {
827 if (!is_lucent_phy(hp)) {
828 /* Re-enable transceiver, we'll re-enable the transceiver next
829 * tick, then check link state on the following tick.
830 */
831 hp->sw_csconfig |= CSCONFIG_TCVDISAB;
832 happy_meal_tcvr_write(hp, tregs,
833 DP83840_CSCONFIG, hp->sw_csconfig);
834 }
835 restart_timer = 1;
836 break;
837 }
838 if (hp->timer_ticks == 2) {
839 if (!is_lucent_phy(hp)) {
840 hp->sw_csconfig &= ~(CSCONFIG_TCVDISAB);
841 happy_meal_tcvr_write(hp, tregs,
842 DP83840_CSCONFIG, hp->sw_csconfig);
843 }
844 restart_timer = 1;
845 break;
846 }
847 if (hp->sw_bmsr & BMSR_LSTATUS) {
848 /* Force mode selection success. */
849 display_forced_link_mode(hp, tregs);
850 set_happy_link_modes(hp, tregs); /* XXX error? then what? */
851 hp->timer_state = asleep;
852 restart_timer = 0;
853 } else {
854 if (hp->timer_ticks >= 4) { /* 6 seconds or so... */
855 int ret;
856
857 ret = try_next_permutation(hp, tregs);
858 if (ret == -1) {
859 /* Aieee, tried them all, reset the
860 * chip and try all over again.
861 */
862
863 /* Let the user know... */
864 printk(KERN_NOTICE "%s: Link down, cable problem?\n",
865 hp->dev->name);
866
867 ret = happy_meal_init(hp);
868 if (ret) {
869 /* ho hum... */
870 printk(KERN_ERR "%s: Error, cannot re-init the "
871 "Happy Meal.\n", hp->dev->name);
872 }
873 goto out;
874 }
875 if (!is_lucent_phy(hp)) {
876 hp->sw_csconfig = happy_meal_tcvr_read(hp, tregs,
877 DP83840_CSCONFIG);
878 hp->sw_csconfig |= CSCONFIG_TCVDISAB;
879 happy_meal_tcvr_write(hp, tregs,
880 DP83840_CSCONFIG, hp->sw_csconfig);
881 }
882 hp->timer_ticks = 0;
883 restart_timer = 1;
884 } else {
885 restart_timer = 1;
886 }
887 }
888 break;
889
890 case asleep:
891 default:
892 /* Can't happens.... */
893 printk(KERN_ERR "%s: Aieee, link timer is asleep but we got one anyways!\n",
894 hp->dev->name);
895 restart_timer = 0;
896 hp->timer_ticks = 0;
897 hp->timer_state = asleep; /* foo on you */
898 break;
899 };
900
901 if (restart_timer) {
902 hp->happy_timer.expires = jiffies + ((12 * HZ)/10); /* 1.2 sec. */
903 add_timer(&hp->happy_timer);
904 }
905
906 out:
907 spin_unlock_irq(&hp->happy_lock);
908 }
909
910 #define TX_RESET_TRIES 32
911 #define RX_RESET_TRIES 32
912
913 /* hp->happy_lock must be held */
914 static void happy_meal_tx_reset(struct happy_meal *hp, void __iomem *bregs)
915 {
916 int tries = TX_RESET_TRIES;
917
918 HMD(("happy_meal_tx_reset: reset, "));
919
920 /* Would you like to try our SMCC Delux? */
921 hme_write32(hp, bregs + BMAC_TXSWRESET, 0);
922 while ((hme_read32(hp, bregs + BMAC_TXSWRESET) & 1) && --tries)
923 udelay(20);
924
925 /* Lettuce, tomato, buggy hardware (no extra charge)? */
926 if (!tries)
927 printk(KERN_ERR "happy meal: Transceiver BigMac ATTACK!");
928
929 /* Take care. */
930 HMD(("done\n"));
931 }
932
933 /* hp->happy_lock must be held */
934 static void happy_meal_rx_reset(struct happy_meal *hp, void __iomem *bregs)
935 {
936 int tries = RX_RESET_TRIES;
937
938 HMD(("happy_meal_rx_reset: reset, "));
939
940 /* We have a special on GNU/Viking hardware bugs today. */
941 hme_write32(hp, bregs + BMAC_RXSWRESET, 0);
942 while ((hme_read32(hp, bregs + BMAC_RXSWRESET) & 1) && --tries)
943 udelay(20);
944
945 /* Will that be all? */
946 if (!tries)
947 printk(KERN_ERR "happy meal: Receiver BigMac ATTACK!");
948
949 /* Don't forget your vik_1137125_wa. Have a nice day. */
950 HMD(("done\n"));
951 }
952
953 #define STOP_TRIES 16
954
955 /* hp->happy_lock must be held */
956 static void happy_meal_stop(struct happy_meal *hp, void __iomem *gregs)
957 {
958 int tries = STOP_TRIES;
959
960 HMD(("happy_meal_stop: reset, "));
961
962 /* We're consolidating our STB products, it's your lucky day. */
963 hme_write32(hp, gregs + GREG_SWRESET, GREG_RESET_ALL);
964 while (hme_read32(hp, gregs + GREG_SWRESET) && --tries)
965 udelay(20);
966
967 /* Come back next week when we are "Sun Microelectronics". */
968 if (!tries)
969 printk(KERN_ERR "happy meal: Fry guys.");
970
971 /* Remember: "Different name, same old buggy as shit hardware." */
972 HMD(("done\n"));
973 }
974
975 /* hp->happy_lock must be held */
976 static void happy_meal_get_counters(struct happy_meal *hp, void __iomem *bregs)
977 {
978 struct net_device_stats *stats = &hp->net_stats;
979
980 stats->rx_crc_errors += hme_read32(hp, bregs + BMAC_RCRCECTR);
981 hme_write32(hp, bregs + BMAC_RCRCECTR, 0);
982
983 stats->rx_frame_errors += hme_read32(hp, bregs + BMAC_UNALECTR);
984 hme_write32(hp, bregs + BMAC_UNALECTR, 0);
985
986 stats->rx_length_errors += hme_read32(hp, bregs + BMAC_GLECTR);
987 hme_write32(hp, bregs + BMAC_GLECTR, 0);
988
989 stats->tx_aborted_errors += hme_read32(hp, bregs + BMAC_EXCTR);
990
991 stats->collisions +=
992 (hme_read32(hp, bregs + BMAC_EXCTR) +
993 hme_read32(hp, bregs + BMAC_LTCTR));
994 hme_write32(hp, bregs + BMAC_EXCTR, 0);
995 hme_write32(hp, bregs + BMAC_LTCTR, 0);
996 }
997
998 /* hp->happy_lock must be held */
999 static void happy_meal_poll_stop(struct happy_meal *hp, void __iomem *tregs)
1000 {
1001 ASD(("happy_meal_poll_stop: "));
1002
1003 /* If polling disabled or not polling already, nothing to do. */
1004 if ((hp->happy_flags & (HFLAG_POLLENABLE | HFLAG_POLL)) !=
1005 (HFLAG_POLLENABLE | HFLAG_POLL)) {
1006 HMD(("not polling, return\n"));
1007 return;
1008 }
1009
1010 /* Shut up the MIF. */
1011 ASD(("were polling, mif ints off, "));
1012 hme_write32(hp, tregs + TCVR_IMASK, 0xffff);
1013
1014 /* Turn off polling. */
1015 ASD(("polling off, "));
1016 hme_write32(hp, tregs + TCVR_CFG,
1017 hme_read32(hp, tregs + TCVR_CFG) & ~(TCV_CFG_PENABLE));
1018
1019 /* We are no longer polling. */
1020 hp->happy_flags &= ~(HFLAG_POLL);
1021
1022 /* Let the bits set. */
1023 udelay(200);
1024 ASD(("done\n"));
1025 }
1026
1027 /* Only Sun can take such nice parts and fuck up the programming interface
1028 * like this. Good job guys...
1029 */
1030 #define TCVR_RESET_TRIES 16 /* It should reset quickly */
1031 #define TCVR_UNISOLATE_TRIES 32 /* Dis-isolation can take longer. */
1032
1033 /* hp->happy_lock must be held */
1034 static int happy_meal_tcvr_reset(struct happy_meal *hp, void __iomem *tregs)
1035 {
1036 u32 tconfig;
1037 int result, tries = TCVR_RESET_TRIES;
1038
1039 tconfig = hme_read32(hp, tregs + TCVR_CFG);
1040 ASD(("happy_meal_tcvr_reset: tcfg<%08lx> ", tconfig));
1041 if (hp->tcvr_type == external) {
1042 ASD(("external<"));
1043 hme_write32(hp, tregs + TCVR_CFG, tconfig & ~(TCV_CFG_PSELECT));
1044 hp->tcvr_type = internal;
1045 hp->paddr = TCV_PADDR_ITX;
1046 ASD(("ISOLATE,"));
1047 happy_meal_tcvr_write(hp, tregs, MII_BMCR,
1048 (BMCR_LOOPBACK|BMCR_PDOWN|BMCR_ISOLATE));
1049 result = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1050 if (result == TCVR_FAILURE) {
1051 ASD(("phyread_fail>\n"));
1052 return -1;
1053 }
1054 ASD(("phyread_ok,PSELECT>"));
1055 hme_write32(hp, tregs + TCVR_CFG, tconfig | TCV_CFG_PSELECT);
1056 hp->tcvr_type = external;
1057 hp->paddr = TCV_PADDR_ETX;
1058 } else {
1059 if (tconfig & TCV_CFG_MDIO1) {
1060 ASD(("internal<PSELECT,"));
1061 hme_write32(hp, tregs + TCVR_CFG, (tconfig | TCV_CFG_PSELECT));
1062 ASD(("ISOLATE,"));
1063 happy_meal_tcvr_write(hp, tregs, MII_BMCR,
1064 (BMCR_LOOPBACK|BMCR_PDOWN|BMCR_ISOLATE));
1065 result = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1066 if (result == TCVR_FAILURE) {
1067 ASD(("phyread_fail>\n"));
1068 return -1;
1069 }
1070 ASD(("phyread_ok,~PSELECT>"));
1071 hme_write32(hp, tregs + TCVR_CFG, (tconfig & ~(TCV_CFG_PSELECT)));
1072 hp->tcvr_type = internal;
1073 hp->paddr = TCV_PADDR_ITX;
1074 }
1075 }
1076
1077 ASD(("BMCR_RESET "));
1078 happy_meal_tcvr_write(hp, tregs, MII_BMCR, BMCR_RESET);
1079
1080 while (--tries) {
1081 result = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1082 if (result == TCVR_FAILURE)
1083 return -1;
1084 hp->sw_bmcr = result;
1085 if (!(result & BMCR_RESET))
1086 break;
1087 udelay(20);
1088 }
1089 if (!tries) {
1090 ASD(("BMCR RESET FAILED!\n"));
1091 return -1;
1092 }
1093 ASD(("RESET_OK\n"));
1094
1095 /* Get fresh copies of the PHY registers. */
1096 hp->sw_bmsr = happy_meal_tcvr_read(hp, tregs, MII_BMSR);
1097 hp->sw_physid1 = happy_meal_tcvr_read(hp, tregs, MII_PHYSID1);
1098 hp->sw_physid2 = happy_meal_tcvr_read(hp, tregs, MII_PHYSID2);
1099 hp->sw_advertise = happy_meal_tcvr_read(hp, tregs, MII_ADVERTISE);
1100
1101 ASD(("UNISOLATE"));
1102 hp->sw_bmcr &= ~(BMCR_ISOLATE);
1103 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
1104
1105 tries = TCVR_UNISOLATE_TRIES;
1106 while (--tries) {
1107 result = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1108 if (result == TCVR_FAILURE)
1109 return -1;
1110 if (!(result & BMCR_ISOLATE))
1111 break;
1112 udelay(20);
1113 }
1114 if (!tries) {
1115 ASD((" FAILED!\n"));
1116 return -1;
1117 }
1118 ASD((" SUCCESS and CSCONFIG_DFBYPASS\n"));
1119 if (!is_lucent_phy(hp)) {
1120 result = happy_meal_tcvr_read(hp, tregs,
1121 DP83840_CSCONFIG);
1122 happy_meal_tcvr_write(hp, tregs,
1123 DP83840_CSCONFIG, (result | CSCONFIG_DFBYPASS));
1124 }
1125 return 0;
1126 }
1127
1128 /* Figure out whether we have an internal or external transceiver.
1129 *
1130 * hp->happy_lock must be held
1131 */
1132 static void happy_meal_transceiver_check(struct happy_meal *hp, void __iomem *tregs)
1133 {
1134 unsigned long tconfig = hme_read32(hp, tregs + TCVR_CFG);
1135
1136 ASD(("happy_meal_transceiver_check: tcfg=%08lx ", tconfig));
1137 if (hp->happy_flags & HFLAG_POLL) {
1138 /* If we are polling, we must stop to get the transceiver type. */
1139 ASD(("<polling> "));
1140 if (hp->tcvr_type == internal) {
1141 if (tconfig & TCV_CFG_MDIO1) {
1142 ASD(("<internal> <poll stop> "));
1143 happy_meal_poll_stop(hp, tregs);
1144 hp->paddr = TCV_PADDR_ETX;
1145 hp->tcvr_type = external;
1146 ASD(("<external>\n"));
1147 tconfig &= ~(TCV_CFG_PENABLE);
1148 tconfig |= TCV_CFG_PSELECT;
1149 hme_write32(hp, tregs + TCVR_CFG, tconfig);
1150 }
1151 } else {
1152 if (hp->tcvr_type == external) {
1153 ASD(("<external> "));
1154 if (!(hme_read32(hp, tregs + TCVR_STATUS) >> 16)) {
1155 ASD(("<poll stop> "));
1156 happy_meal_poll_stop(hp, tregs);
1157 hp->paddr = TCV_PADDR_ITX;
1158 hp->tcvr_type = internal;
1159 ASD(("<internal>\n"));
1160 hme_write32(hp, tregs + TCVR_CFG,
1161 hme_read32(hp, tregs + TCVR_CFG) &
1162 ~(TCV_CFG_PSELECT));
1163 }
1164 ASD(("\n"));
1165 } else {
1166 ASD(("<none>\n"));
1167 }
1168 }
1169 } else {
1170 u32 reread = hme_read32(hp, tregs + TCVR_CFG);
1171
1172 /* Else we can just work off of the MDIO bits. */
1173 ASD(("<not polling> "));
1174 if (reread & TCV_CFG_MDIO1) {
1175 hme_write32(hp, tregs + TCVR_CFG, tconfig | TCV_CFG_PSELECT);
1176 hp->paddr = TCV_PADDR_ETX;
1177 hp->tcvr_type = external;
1178 ASD(("<external>\n"));
1179 } else {
1180 if (reread & TCV_CFG_MDIO0) {
1181 hme_write32(hp, tregs + TCVR_CFG,
1182 tconfig & ~(TCV_CFG_PSELECT));
1183 hp->paddr = TCV_PADDR_ITX;
1184 hp->tcvr_type = internal;
1185 ASD(("<internal>\n"));
1186 } else {
1187 printk(KERN_ERR "happy meal: Transceiver and a coke please.");
1188 hp->tcvr_type = none; /* Grrr... */
1189 ASD(("<none>\n"));
1190 }
1191 }
1192 }
1193 }
1194
1195 /* The receive ring buffers are a bit tricky to get right. Here goes...
1196 *
1197 * The buffers we dma into must be 64 byte aligned. So we use a special
1198 * alloc_skb() routine for the happy meal to allocate 64 bytes more than
1199 * we really need.
1200 *
1201 * We use skb_reserve() to align the data block we get in the skb. We
1202 * also program the etxregs->cfg register to use an offset of 2. This
1203 * imperical constant plus the ethernet header size will always leave
1204 * us with a nicely aligned ip header once we pass things up to the
1205 * protocol layers.
1206 *
1207 * The numbers work out to:
1208 *
1209 * Max ethernet frame size 1518
1210 * Ethernet header size 14
1211 * Happy Meal base offset 2
1212 *
1213 * Say a skb data area is at 0xf001b010, and its size alloced is
1214 * (ETH_FRAME_LEN + 64 + 2) = (1514 + 64 + 2) = 1580 bytes.
1215 *
1216 * First our alloc_skb() routine aligns the data base to a 64 byte
1217 * boundary. We now have 0xf001b040 as our skb data address. We
1218 * plug this into the receive descriptor address.
1219 *
1220 * Next, we skb_reserve() 2 bytes to account for the Happy Meal offset.
1221 * So now the data we will end up looking at starts at 0xf001b042. When
1222 * the packet arrives, we will check out the size received and subtract
1223 * this from the skb->length. Then we just pass the packet up to the
1224 * protocols as is, and allocate a new skb to replace this slot we have
1225 * just received from.
1226 *
1227 * The ethernet layer will strip the ether header from the front of the
1228 * skb we just sent to it, this leaves us with the ip header sitting
1229 * nicely aligned at 0xf001b050. Also, for tcp and udp packets the
1230 * Happy Meal has even checksummed the tcp/udp data for us. The 16
1231 * bit checksum is obtained from the low bits of the receive descriptor
1232 * flags, thus:
1233 *
1234 * skb->csum = rxd->rx_flags & 0xffff;
1235 * skb->ip_summed = CHECKSUM_HW;
1236 *
1237 * before sending off the skb to the protocols, and we are good as gold.
1238 */
1239 static void happy_meal_clean_rings(struct happy_meal *hp)
1240 {
1241 int i;
1242
1243 for (i = 0; i < RX_RING_SIZE; i++) {
1244 if (hp->rx_skbs[i] != NULL) {
1245 struct sk_buff *skb = hp->rx_skbs[i];
1246 struct happy_meal_rxd *rxd;
1247 u32 dma_addr;
1248
1249 rxd = &hp->happy_block->happy_meal_rxd[i];
1250 dma_addr = hme_read_desc32(hp, &rxd->rx_addr);
1251 hme_dma_unmap(hp, dma_addr, RX_BUF_ALLOC_SIZE, DMA_FROMDEVICE);
1252 dev_kfree_skb_any(skb);
1253 hp->rx_skbs[i] = NULL;
1254 }
1255 }
1256
1257 for (i = 0; i < TX_RING_SIZE; i++) {
1258 if (hp->tx_skbs[i] != NULL) {
1259 struct sk_buff *skb = hp->tx_skbs[i];
1260 struct happy_meal_txd *txd;
1261 u32 dma_addr;
1262 int frag;
1263
1264 hp->tx_skbs[i] = NULL;
1265
1266 for (frag = 0; frag <= skb_shinfo(skb)->nr_frags; frag++) {
1267 txd = &hp->happy_block->happy_meal_txd[i];
1268 dma_addr = hme_read_desc32(hp, &txd->tx_addr);
1269 hme_dma_unmap(hp, dma_addr,
1270 (hme_read_desc32(hp, &txd->tx_flags)
1271 & TXFLAG_SIZE),
1272 DMA_TODEVICE);
1273
1274 if (frag != skb_shinfo(skb)->nr_frags)
1275 i++;
1276 }
1277
1278 dev_kfree_skb_any(skb);
1279 }
1280 }
1281 }
1282
1283 /* hp->happy_lock must be held */
1284 static void happy_meal_init_rings(struct happy_meal *hp)
1285 {
1286 struct hmeal_init_block *hb = hp->happy_block;
1287 struct net_device *dev = hp->dev;
1288 int i;
1289
1290 HMD(("happy_meal_init_rings: counters to zero, "));
1291 hp->rx_new = hp->rx_old = hp->tx_new = hp->tx_old = 0;
1292
1293 /* Free any skippy bufs left around in the rings. */
1294 HMD(("clean, "));
1295 happy_meal_clean_rings(hp);
1296
1297 /* Now get new skippy bufs for the receive ring. */
1298 HMD(("init rxring, "));
1299 for (i = 0; i < RX_RING_SIZE; i++) {
1300 struct sk_buff *skb;
1301
1302 skb = happy_meal_alloc_skb(RX_BUF_ALLOC_SIZE, GFP_ATOMIC);
1303 if (!skb) {
1304 hme_write_rxd(hp, &hb->happy_meal_rxd[i], 0, 0);
1305 continue;
1306 }
1307 hp->rx_skbs[i] = skb;
1308 skb->dev = dev;
1309
1310 /* Because we reserve afterwards. */
1311 skb_put(skb, (ETH_FRAME_LEN + RX_OFFSET));
1312 hme_write_rxd(hp, &hb->happy_meal_rxd[i],
1313 (RXFLAG_OWN | ((RX_BUF_ALLOC_SIZE - RX_OFFSET) << 16)),
1314 hme_dma_map(hp, skb->data, RX_BUF_ALLOC_SIZE, DMA_FROMDEVICE));
1315 skb_reserve(skb, RX_OFFSET);
1316 }
1317
1318 HMD(("init txring, "));
1319 for (i = 0; i < TX_RING_SIZE; i++)
1320 hme_write_txd(hp, &hb->happy_meal_txd[i], 0, 0);
1321
1322 HMD(("done\n"));
1323 }
1324
1325 /* hp->happy_lock must be held */
1326 static void happy_meal_begin_auto_negotiation(struct happy_meal *hp,
1327 void __iomem *tregs,
1328 struct ethtool_cmd *ep)
1329 {
1330 int timeout;
1331
1332 /* Read all of the registers we are interested in now. */
1333 hp->sw_bmsr = happy_meal_tcvr_read(hp, tregs, MII_BMSR);
1334 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1335 hp->sw_physid1 = happy_meal_tcvr_read(hp, tregs, MII_PHYSID1);
1336 hp->sw_physid2 = happy_meal_tcvr_read(hp, tregs, MII_PHYSID2);
1337
1338 /* XXX Check BMSR_ANEGCAPABLE, should not be necessary though. */
1339
1340 hp->sw_advertise = happy_meal_tcvr_read(hp, tregs, MII_ADVERTISE);
1341 if (ep == NULL || ep->autoneg == AUTONEG_ENABLE) {
1342 /* Advertise everything we can support. */
1343 if (hp->sw_bmsr & BMSR_10HALF)
1344 hp->sw_advertise |= (ADVERTISE_10HALF);
1345 else
1346 hp->sw_advertise &= ~(ADVERTISE_10HALF);
1347
1348 if (hp->sw_bmsr & BMSR_10FULL)
1349 hp->sw_advertise |= (ADVERTISE_10FULL);
1350 else
1351 hp->sw_advertise &= ~(ADVERTISE_10FULL);
1352 if (hp->sw_bmsr & BMSR_100HALF)
1353 hp->sw_advertise |= (ADVERTISE_100HALF);
1354 else
1355 hp->sw_advertise &= ~(ADVERTISE_100HALF);
1356 if (hp->sw_bmsr & BMSR_100FULL)
1357 hp->sw_advertise |= (ADVERTISE_100FULL);
1358 else
1359 hp->sw_advertise &= ~(ADVERTISE_100FULL);
1360 happy_meal_tcvr_write(hp, tregs, MII_ADVERTISE, hp->sw_advertise);
1361
1362 /* XXX Currently no Happy Meal cards I know off support 100BaseT4,
1363 * XXX and this is because the DP83840 does not support it, changes
1364 * XXX would need to be made to the tx/rx logic in the driver as well
1365 * XXX so I completely skip checking for it in the BMSR for now.
1366 */
1367
1368 #ifdef AUTO_SWITCH_DEBUG
1369 ASD(("%s: Advertising [ ", hp->dev->name));
1370 if (hp->sw_advertise & ADVERTISE_10HALF)
1371 ASD(("10H "));
1372 if (hp->sw_advertise & ADVERTISE_10FULL)
1373 ASD(("10F "));
1374 if (hp->sw_advertise & ADVERTISE_100HALF)
1375 ASD(("100H "));
1376 if (hp->sw_advertise & ADVERTISE_100FULL)
1377 ASD(("100F "));
1378 #endif
1379
1380 /* Enable Auto-Negotiation, this is usually on already... */
1381 hp->sw_bmcr |= BMCR_ANENABLE;
1382 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
1383
1384 /* Restart it to make sure it is going. */
1385 hp->sw_bmcr |= BMCR_ANRESTART;
1386 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
1387
1388 /* BMCR_ANRESTART self clears when the process has begun. */
1389
1390 timeout = 64; /* More than enough. */
1391 while (--timeout) {
1392 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1393 if (!(hp->sw_bmcr & BMCR_ANRESTART))
1394 break; /* got it. */
1395 udelay(10);
1396 }
1397 if (!timeout) {
1398 printk(KERN_ERR "%s: Happy Meal would not start auto negotiation "
1399 "BMCR=0x%04x\n", hp->dev->name, hp->sw_bmcr);
1400 printk(KERN_NOTICE "%s: Performing force link detection.\n",
1401 hp->dev->name);
1402 goto force_link;
1403 } else {
1404 hp->timer_state = arbwait;
1405 }
1406 } else {
1407 force_link:
1408 /* Force the link up, trying first a particular mode.
1409 * Either we are here at the request of ethtool or
1410 * because the Happy Meal would not start to autoneg.
1411 */
1412
1413 /* Disable auto-negotiation in BMCR, enable the duplex and
1414 * speed setting, init the timer state machine, and fire it off.
1415 */
1416 if (ep == NULL || ep->autoneg == AUTONEG_ENABLE) {
1417 hp->sw_bmcr = BMCR_SPEED100;
1418 } else {
1419 if (ep->speed == SPEED_100)
1420 hp->sw_bmcr = BMCR_SPEED100;
1421 else
1422 hp->sw_bmcr = 0;
1423 if (ep->duplex == DUPLEX_FULL)
1424 hp->sw_bmcr |= BMCR_FULLDPLX;
1425 }
1426 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
1427
1428 if (!is_lucent_phy(hp)) {
1429 /* OK, seems we need do disable the transceiver for the first
1430 * tick to make sure we get an accurate link state at the
1431 * second tick.
1432 */
1433 hp->sw_csconfig = happy_meal_tcvr_read(hp, tregs,
1434 DP83840_CSCONFIG);
1435 hp->sw_csconfig &= ~(CSCONFIG_TCVDISAB);
1436 happy_meal_tcvr_write(hp, tregs, DP83840_CSCONFIG,
1437 hp->sw_csconfig);
1438 }
1439 hp->timer_state = ltrywait;
1440 }
1441
1442 hp->timer_ticks = 0;
1443 hp->happy_timer.expires = jiffies + (12 * HZ)/10; /* 1.2 sec. */
1444 hp->happy_timer.data = (unsigned long) hp;
1445 hp->happy_timer.function = &happy_meal_timer;
1446 add_timer(&hp->happy_timer);
1447 }
1448
1449 /* hp->happy_lock must be held */
1450 static int happy_meal_init(struct happy_meal *hp)
1451 {
1452 void __iomem *gregs = hp->gregs;
1453 void __iomem *etxregs = hp->etxregs;
1454 void __iomem *erxregs = hp->erxregs;
1455 void __iomem *bregs = hp->bigmacregs;
1456 void __iomem *tregs = hp->tcvregs;
1457 u32 regtmp, rxcfg;
1458 unsigned char *e = &hp->dev->dev_addr[0];
1459
1460 /* If auto-negotiation timer is running, kill it. */
1461 del_timer(&hp->happy_timer);
1462
1463 HMD(("happy_meal_init: happy_flags[%08x] ",
1464 hp->happy_flags));
1465 if (!(hp->happy_flags & HFLAG_INIT)) {
1466 HMD(("set HFLAG_INIT, "));
1467 hp->happy_flags |= HFLAG_INIT;
1468 happy_meal_get_counters(hp, bregs);
1469 }
1470
1471 /* Stop polling. */
1472 HMD(("to happy_meal_poll_stop\n"));
1473 happy_meal_poll_stop(hp, tregs);
1474
1475 /* Stop transmitter and receiver. */
1476 HMD(("happy_meal_init: to happy_meal_stop\n"));
1477 happy_meal_stop(hp, gregs);
1478
1479 /* Alloc and reset the tx/rx descriptor chains. */
1480 HMD(("happy_meal_init: to happy_meal_init_rings\n"));
1481 happy_meal_init_rings(hp);
1482
1483 /* Shut up the MIF. */
1484 HMD(("happy_meal_init: Disable all MIF irqs (old[%08x]), ",
1485 hme_read32(hp, tregs + TCVR_IMASK)));
1486 hme_write32(hp, tregs + TCVR_IMASK, 0xffff);
1487
1488 /* See if we can enable the MIF frame on this card to speak to the DP83840. */
1489 if (hp->happy_flags & HFLAG_FENABLE) {
1490 HMD(("use frame old[%08x], ",
1491 hme_read32(hp, tregs + TCVR_CFG)));
1492 hme_write32(hp, tregs + TCVR_CFG,
1493 hme_read32(hp, tregs + TCVR_CFG) & ~(TCV_CFG_BENABLE));
1494 } else {
1495 HMD(("use bitbang old[%08x], ",
1496 hme_read32(hp, tregs + TCVR_CFG)));
1497 hme_write32(hp, tregs + TCVR_CFG,
1498 hme_read32(hp, tregs + TCVR_CFG) | TCV_CFG_BENABLE);
1499 }
1500
1501 /* Check the state of the transceiver. */
1502 HMD(("to happy_meal_transceiver_check\n"));
1503 happy_meal_transceiver_check(hp, tregs);
1504
1505 /* Put the Big Mac into a sane state. */
1506 HMD(("happy_meal_init: "));
1507 switch(hp->tcvr_type) {
1508 case none:
1509 /* Cannot operate if we don't know the transceiver type! */
1510 HMD(("AAIEEE no transceiver type, EAGAIN"));
1511 return -EAGAIN;
1512
1513 case internal:
1514 /* Using the MII buffers. */
1515 HMD(("internal, using MII, "));
1516 hme_write32(hp, bregs + BMAC_XIFCFG, 0);
1517 break;
1518
1519 case external:
1520 /* Not using the MII, disable it. */
1521 HMD(("external, disable MII, "));
1522 hme_write32(hp, bregs + BMAC_XIFCFG, BIGMAC_XCFG_MIIDISAB);
1523 break;
1524 };
1525
1526 if (happy_meal_tcvr_reset(hp, tregs))
1527 return -EAGAIN;
1528
1529 /* Reset the Happy Meal Big Mac transceiver and the receiver. */
1530 HMD(("tx/rx reset, "));
1531 happy_meal_tx_reset(hp, bregs);
1532 happy_meal_rx_reset(hp, bregs);
1533
1534 /* Set jam size and inter-packet gaps to reasonable defaults. */
1535 HMD(("jsize/ipg1/ipg2, "));
1536 hme_write32(hp, bregs + BMAC_JSIZE, DEFAULT_JAMSIZE);
1537 hme_write32(hp, bregs + BMAC_IGAP1, DEFAULT_IPG1);
1538 hme_write32(hp, bregs + BMAC_IGAP2, DEFAULT_IPG2);
1539
1540 /* Load up the MAC address and random seed. */
1541 HMD(("rseed/macaddr, "));
1542
1543 /* The docs recommend to use the 10LSB of our MAC here. */
1544 hme_write32(hp, bregs + BMAC_RSEED, ((e[5] | e[4]<<8)&0x3ff));
1545
1546 hme_write32(hp, bregs + BMAC_MACADDR2, ((e[4] << 8) | e[5]));
1547 hme_write32(hp, bregs + BMAC_MACADDR1, ((e[2] << 8) | e[3]));
1548 hme_write32(hp, bregs + BMAC_MACADDR0, ((e[0] << 8) | e[1]));
1549
1550 HMD(("htable, "));
1551 if ((hp->dev->flags & IFF_ALLMULTI) ||
1552 (hp->dev->mc_count > 64)) {
1553 hme_write32(hp, bregs + BMAC_HTABLE0, 0xffff);
1554 hme_write32(hp, bregs + BMAC_HTABLE1, 0xffff);
1555 hme_write32(hp, bregs + BMAC_HTABLE2, 0xffff);
1556 hme_write32(hp, bregs + BMAC_HTABLE3, 0xffff);
1557 } else if ((hp->dev->flags & IFF_PROMISC) == 0) {
1558 u16 hash_table[4];
1559 struct dev_mc_list *dmi = hp->dev->mc_list;
1560 char *addrs;
1561 int i;
1562 u32 crc;
1563
1564 for (i = 0; i < 4; i++)
1565 hash_table[i] = 0;
1566
1567 for (i = 0; i < hp->dev->mc_count; i++) {
1568 addrs = dmi->dmi_addr;
1569 dmi = dmi->next;
1570
1571 if (!(*addrs & 1))
1572 continue;
1573
1574 crc = ether_crc_le(6, addrs);
1575 crc >>= 26;
1576 hash_table[crc >> 4] |= 1 << (crc & 0xf);
1577 }
1578 hme_write32(hp, bregs + BMAC_HTABLE0, hash_table[0]);
1579 hme_write32(hp, bregs + BMAC_HTABLE1, hash_table[1]);
1580 hme_write32(hp, bregs + BMAC_HTABLE2, hash_table[2]);
1581 hme_write32(hp, bregs + BMAC_HTABLE3, hash_table[3]);
1582 } else {
1583 hme_write32(hp, bregs + BMAC_HTABLE3, 0);
1584 hme_write32(hp, bregs + BMAC_HTABLE2, 0);
1585 hme_write32(hp, bregs + BMAC_HTABLE1, 0);
1586 hme_write32(hp, bregs + BMAC_HTABLE0, 0);
1587 }
1588
1589 /* Set the RX and TX ring ptrs. */
1590 HMD(("ring ptrs rxr[%08x] txr[%08x]\n",
1591 ((__u32)hp->hblock_dvma + hblock_offset(happy_meal_rxd, 0)),
1592 ((__u32)hp->hblock_dvma + hblock_offset(happy_meal_txd, 0))));
1593 hme_write32(hp, erxregs + ERX_RING,
1594 ((__u32)hp->hblock_dvma + hblock_offset(happy_meal_rxd, 0)));
1595 hme_write32(hp, etxregs + ETX_RING,
1596 ((__u32)hp->hblock_dvma + hblock_offset(happy_meal_txd, 0)));
1597
1598 /* Parity issues in the ERX unit of some HME revisions can cause some
1599 * registers to not be written unless their parity is even. Detect such
1600 * lost writes and simply rewrite with a low bit set (which will be ignored
1601 * since the rxring needs to be 2K aligned).
1602 */
1603 if (hme_read32(hp, erxregs + ERX_RING) !=
1604 ((__u32)hp->hblock_dvma + hblock_offset(happy_meal_rxd, 0)))
1605 hme_write32(hp, erxregs + ERX_RING,
1606 ((__u32)hp->hblock_dvma + hblock_offset(happy_meal_rxd, 0))
1607 | 0x4);
1608
1609 /* Set the supported burst sizes. */
1610 HMD(("happy_meal_init: old[%08x] bursts<",
1611 hme_read32(hp, gregs + GREG_CFG)));
1612
1613 #ifndef __sparc__
1614 /* It is always PCI and can handle 64byte bursts. */
1615 hme_write32(hp, gregs + GREG_CFG, GREG_CFG_BURST64);
1616 #else
1617 if ((hp->happy_bursts & DMA_BURST64) &&
1618 ((hp->happy_flags & HFLAG_PCI) != 0
1619 #ifdef CONFIG_SBUS
1620 || sbus_can_burst64(hp->happy_dev)
1621 #endif
1622 || 0)) {
1623 u32 gcfg = GREG_CFG_BURST64;
1624
1625 /* I have no idea if I should set the extended
1626 * transfer mode bit for Cheerio, so for now I
1627 * do not. -DaveM
1628 */
1629 #ifdef CONFIG_SBUS
1630 if ((hp->happy_flags & HFLAG_PCI) == 0 &&
1631 sbus_can_dma_64bit(hp->happy_dev)) {
1632 sbus_set_sbus64(hp->happy_dev,
1633 hp->happy_bursts);
1634 gcfg |= GREG_CFG_64BIT;
1635 }
1636 #endif
1637
1638 HMD(("64>"));
1639 hme_write32(hp, gregs + GREG_CFG, gcfg);
1640 } else if (hp->happy_bursts & DMA_BURST32) {
1641 HMD(("32>"));
1642 hme_write32(hp, gregs + GREG_CFG, GREG_CFG_BURST32);
1643 } else if (hp->happy_bursts & DMA_BURST16) {
1644 HMD(("16>"));
1645 hme_write32(hp, gregs + GREG_CFG, GREG_CFG_BURST16);
1646 } else {
1647 HMD(("XXX>"));
1648 hme_write32(hp, gregs + GREG_CFG, 0);
1649 }
1650 #endif /* __sparc__ */
1651
1652 /* Turn off interrupts we do not want to hear. */
1653 HMD((", enable global interrupts, "));
1654 hme_write32(hp, gregs + GREG_IMASK,
1655 (GREG_IMASK_GOTFRAME | GREG_IMASK_RCNTEXP |
1656 GREG_IMASK_SENTFRAME | GREG_IMASK_TXPERR));
1657
1658 /* Set the transmit ring buffer size. */
1659 HMD(("tx rsize=%d oreg[%08x], ", (int)TX_RING_SIZE,
1660 hme_read32(hp, etxregs + ETX_RSIZE)));
1661 hme_write32(hp, etxregs + ETX_RSIZE, (TX_RING_SIZE >> ETX_RSIZE_SHIFT) - 1);
1662
1663 /* Enable transmitter DVMA. */
1664 HMD(("tx dma enable old[%08x], ",
1665 hme_read32(hp, etxregs + ETX_CFG)));
1666 hme_write32(hp, etxregs + ETX_CFG,
1667 hme_read32(hp, etxregs + ETX_CFG) | ETX_CFG_DMAENABLE);
1668
1669 /* This chip really rots, for the receiver sometimes when you
1670 * write to its control registers not all the bits get there
1671 * properly. I cannot think of a sane way to provide complete
1672 * coverage for this hardware bug yet.
1673 */
1674 HMD(("erx regs bug old[%08x]\n",
1675 hme_read32(hp, erxregs + ERX_CFG)));
1676 hme_write32(hp, erxregs + ERX_CFG, ERX_CFG_DEFAULT(RX_OFFSET));
1677 regtmp = hme_read32(hp, erxregs + ERX_CFG);
1678 hme_write32(hp, erxregs + ERX_CFG, ERX_CFG_DEFAULT(RX_OFFSET));
1679 if (hme_read32(hp, erxregs + ERX_CFG) != ERX_CFG_DEFAULT(RX_OFFSET)) {
1680 printk(KERN_ERR "happy meal: Eieee, rx config register gets greasy fries.\n");
1681 printk(KERN_ERR "happy meal: Trying to set %08x, reread gives %08x\n",
1682 ERX_CFG_DEFAULT(RX_OFFSET), regtmp);
1683 /* XXX Should return failure here... */
1684 }
1685
1686 /* Enable Big Mac hash table filter. */
1687 HMD(("happy_meal_init: enable hash rx_cfg_old[%08x], ",
1688 hme_read32(hp, bregs + BMAC_RXCFG)));
1689 rxcfg = BIGMAC_RXCFG_HENABLE | BIGMAC_RXCFG_REJME;
1690 if (hp->dev->flags & IFF_PROMISC)
1691 rxcfg |= BIGMAC_RXCFG_PMISC;
1692 hme_write32(hp, bregs + BMAC_RXCFG, rxcfg);
1693
1694 /* Let the bits settle in the chip. */
1695 udelay(10);
1696
1697 /* Ok, configure the Big Mac transmitter. */
1698 HMD(("BIGMAC init, "));
1699 regtmp = 0;
1700 if (hp->happy_flags & HFLAG_FULL)
1701 regtmp |= BIGMAC_TXCFG_FULLDPLX;
1702
1703 /* Don't turn on the "don't give up" bit for now. It could cause hme
1704 * to deadlock with the PHY if a Jabber occurs.
1705 */
1706 hme_write32(hp, bregs + BMAC_TXCFG, regtmp /*| BIGMAC_TXCFG_DGIVEUP*/);
1707
1708 /* Give up after 16 TX attempts. */
1709 hme_write32(hp, bregs + BMAC_ALIMIT, 16);
1710
1711 /* Enable the output drivers no matter what. */
1712 regtmp = BIGMAC_XCFG_ODENABLE;
1713
1714 /* If card can do lance mode, enable it. */
1715 if (hp->happy_flags & HFLAG_LANCE)
1716 regtmp |= (DEFAULT_IPG0 << 5) | BIGMAC_XCFG_LANCE;
1717
1718 /* Disable the MII buffers if using external transceiver. */
1719 if (hp->tcvr_type == external)
1720 regtmp |= BIGMAC_XCFG_MIIDISAB;
1721
1722 HMD(("XIF config old[%08x], ",
1723 hme_read32(hp, bregs + BMAC_XIFCFG)));
1724 hme_write32(hp, bregs + BMAC_XIFCFG, regtmp);
1725
1726 /* Start things up. */
1727 HMD(("tx old[%08x] and rx [%08x] ON!\n",
1728 hme_read32(hp, bregs + BMAC_TXCFG),
1729 hme_read32(hp, bregs + BMAC_RXCFG)));
1730 hme_write32(hp, bregs + BMAC_TXCFG,
1731 hme_read32(hp, bregs + BMAC_TXCFG) | BIGMAC_TXCFG_ENABLE);
1732 hme_write32(hp, bregs + BMAC_RXCFG,
1733 hme_read32(hp, bregs + BMAC_RXCFG) | BIGMAC_RXCFG_ENABLE);
1734
1735 /* Get the autonegotiation started, and the watch timer ticking. */
1736 happy_meal_begin_auto_negotiation(hp, tregs, NULL);
1737
1738 /* Success. */
1739 return 0;
1740 }
1741
1742 /* hp->happy_lock must be held */
1743 static void happy_meal_set_initial_advertisement(struct happy_meal *hp)
1744 {
1745 void __iomem *tregs = hp->tcvregs;
1746 void __iomem *bregs = hp->bigmacregs;
1747 void __iomem *gregs = hp->gregs;
1748
1749 happy_meal_stop(hp, gregs);
1750 hme_write32(hp, tregs + TCVR_IMASK, 0xffff);
1751 if (hp->happy_flags & HFLAG_FENABLE)
1752 hme_write32(hp, tregs + TCVR_CFG,
1753 hme_read32(hp, tregs + TCVR_CFG) & ~(TCV_CFG_BENABLE));
1754 else
1755 hme_write32(hp, tregs + TCVR_CFG,
1756 hme_read32(hp, tregs + TCVR_CFG) | TCV_CFG_BENABLE);
1757 happy_meal_transceiver_check(hp, tregs);
1758 switch(hp->tcvr_type) {
1759 case none:
1760 return;
1761 case internal:
1762 hme_write32(hp, bregs + BMAC_XIFCFG, 0);
1763 break;
1764 case external:
1765 hme_write32(hp, bregs + BMAC_XIFCFG, BIGMAC_XCFG_MIIDISAB);
1766 break;
1767 };
1768 if (happy_meal_tcvr_reset(hp, tregs))
1769 return;
1770
1771 /* Latch PHY registers as of now. */
1772 hp->sw_bmsr = happy_meal_tcvr_read(hp, tregs, MII_BMSR);
1773 hp->sw_advertise = happy_meal_tcvr_read(hp, tregs, MII_ADVERTISE);
1774
1775 /* Advertise everything we can support. */
1776 if (hp->sw_bmsr & BMSR_10HALF)
1777 hp->sw_advertise |= (ADVERTISE_10HALF);
1778 else
1779 hp->sw_advertise &= ~(ADVERTISE_10HALF);
1780
1781 if (hp->sw_bmsr & BMSR_10FULL)
1782 hp->sw_advertise |= (ADVERTISE_10FULL);
1783 else
1784 hp->sw_advertise &= ~(ADVERTISE_10FULL);
1785 if (hp->sw_bmsr & BMSR_100HALF)
1786 hp->sw_advertise |= (ADVERTISE_100HALF);
1787 else
1788 hp->sw_advertise &= ~(ADVERTISE_100HALF);
1789 if (hp->sw_bmsr & BMSR_100FULL)
1790 hp->sw_advertise |= (ADVERTISE_100FULL);
1791 else
1792 hp->sw_advertise &= ~(ADVERTISE_100FULL);
1793
1794 /* Update the PHY advertisement register. */
1795 happy_meal_tcvr_write(hp, tregs, MII_ADVERTISE, hp->sw_advertise);
1796 }
1797
1798 /* Once status is latched (by happy_meal_interrupt) it is cleared by
1799 * the hardware, so we cannot re-read it and get a correct value.
1800 *
1801 * hp->happy_lock must be held
1802 */
1803 static int happy_meal_is_not_so_happy(struct happy_meal *hp, u32 status)
1804 {
1805 int reset = 0;
1806
1807 /* Only print messages for non-counter related interrupts. */
1808 if (status & (GREG_STAT_STSTERR | GREG_STAT_TFIFO_UND |
1809 GREG_STAT_MAXPKTERR | GREG_STAT_RXERR |
1810 GREG_STAT_RXPERR | GREG_STAT_RXTERR | GREG_STAT_EOPERR |
1811 GREG_STAT_MIFIRQ | GREG_STAT_TXEACK | GREG_STAT_TXLERR |
1812 GREG_STAT_TXPERR | GREG_STAT_TXTERR | GREG_STAT_SLVERR |
1813 GREG_STAT_SLVPERR))
1814 printk(KERN_ERR "%s: Error interrupt for happy meal, status = %08x\n",
1815 hp->dev->name, status);
1816
1817 if (status & GREG_STAT_RFIFOVF) {
1818 /* Receive FIFO overflow is harmless and the hardware will take
1819 care of it, just some packets are lost. Who cares. */
1820 printk(KERN_DEBUG "%s: Happy Meal receive FIFO overflow.\n", hp->dev->name);
1821 }
1822
1823 if (status & GREG_STAT_STSTERR) {
1824 /* BigMAC SQE link test failed. */
1825 printk(KERN_ERR "%s: Happy Meal BigMAC SQE test failed.\n", hp->dev->name);
1826 reset = 1;
1827 }
1828
1829 if (status & GREG_STAT_TFIFO_UND) {
1830 /* Transmit FIFO underrun, again DMA error likely. */
1831 printk(KERN_ERR "%s: Happy Meal transmitter FIFO underrun, DMA error.\n",
1832 hp->dev->name);
1833 reset = 1;
1834 }
1835
1836 if (status & GREG_STAT_MAXPKTERR) {
1837 /* Driver error, tried to transmit something larger
1838 * than ethernet max mtu.
1839 */
1840 printk(KERN_ERR "%s: Happy Meal MAX Packet size error.\n", hp->dev->name);
1841 reset = 1;
1842 }
1843
1844 if (status & GREG_STAT_NORXD) {
1845 /* This is harmless, it just means the system is
1846 * quite loaded and the incoming packet rate was
1847 * faster than the interrupt handler could keep up
1848 * with.
1849 */
1850 printk(KERN_INFO "%s: Happy Meal out of receive "
1851 "descriptors, packet dropped.\n",
1852 hp->dev->name);
1853 }
1854
1855 if (status & (GREG_STAT_RXERR|GREG_STAT_RXPERR|GREG_STAT_RXTERR)) {
1856 /* All sorts of DMA receive errors. */
1857 printk(KERN_ERR "%s: Happy Meal rx DMA errors [ ", hp->dev->name);
1858 if (status & GREG_STAT_RXERR)
1859 printk("GenericError ");
1860 if (status & GREG_STAT_RXPERR)
1861 printk("ParityError ");
1862 if (status & GREG_STAT_RXTERR)
1863 printk("RxTagBotch ");
1864 printk("]\n");
1865 reset = 1;
1866 }
1867
1868 if (status & GREG_STAT_EOPERR) {
1869 /* Driver bug, didn't set EOP bit in tx descriptor given
1870 * to the happy meal.
1871 */
1872 printk(KERN_ERR "%s: EOP not set in happy meal transmit descriptor!\n",
1873 hp->dev->name);
1874 reset = 1;
1875 }
1876
1877 if (status & GREG_STAT_MIFIRQ) {
1878 /* MIF signalled an interrupt, were we polling it? */
1879 printk(KERN_ERR "%s: Happy Meal MIF interrupt.\n", hp->dev->name);
1880 }
1881
1882 if (status &
1883 (GREG_STAT_TXEACK|GREG_STAT_TXLERR|GREG_STAT_TXPERR|GREG_STAT_TXTERR)) {
1884 /* All sorts of transmit DMA errors. */
1885 printk(KERN_ERR "%s: Happy Meal tx DMA errors [ ", hp->dev->name);
1886 if (status & GREG_STAT_TXEACK)
1887 printk("GenericError ");
1888 if (status & GREG_STAT_TXLERR)
1889 printk("LateError ");
1890 if (status & GREG_STAT_TXPERR)
1891 printk("ParityErro ");
1892 if (status & GREG_STAT_TXTERR)
1893 printk("TagBotch ");
1894 printk("]\n");
1895 reset = 1;
1896 }
1897
1898 if (status & (GREG_STAT_SLVERR|GREG_STAT_SLVPERR)) {
1899 /* Bus or parity error when cpu accessed happy meal registers
1900 * or it's internal FIFO's. Should never see this.
1901 */
1902 printk(KERN_ERR "%s: Happy Meal register access SBUS slave (%s) error.\n",
1903 hp->dev->name,
1904 (status & GREG_STAT_SLVPERR) ? "parity" : "generic");
1905 reset = 1;
1906 }
1907
1908 if (reset) {
1909 printk(KERN_NOTICE "%s: Resetting...\n", hp->dev->name);
1910 happy_meal_init(hp);
1911 return 1;
1912 }
1913 return 0;
1914 }
1915
1916 /* hp->happy_lock must be held */
1917 static void happy_meal_mif_interrupt(struct happy_meal *hp)
1918 {
1919 void __iomem *tregs = hp->tcvregs;
1920
1921 printk(KERN_INFO "%s: Link status change.\n", hp->dev->name);
1922 hp->sw_bmcr = happy_meal_tcvr_read(hp, tregs, MII_BMCR);
1923 hp->sw_lpa = happy_meal_tcvr_read(hp, tregs, MII_LPA);
1924
1925 /* Use the fastest transmission protocol possible. */
1926 if (hp->sw_lpa & LPA_100FULL) {
1927 printk(KERN_INFO "%s: Switching to 100Mbps at full duplex.", hp->dev->name);
1928 hp->sw_bmcr |= (BMCR_FULLDPLX | BMCR_SPEED100);
1929 } else if (hp->sw_lpa & LPA_100HALF) {
1930 printk(KERN_INFO "%s: Switching to 100MBps at half duplex.", hp->dev->name);
1931 hp->sw_bmcr |= BMCR_SPEED100;
1932 } else if (hp->sw_lpa & LPA_10FULL) {
1933 printk(KERN_INFO "%s: Switching to 10MBps at full duplex.", hp->dev->name);
1934 hp->sw_bmcr |= BMCR_FULLDPLX;
1935 } else {
1936 printk(KERN_INFO "%s: Using 10Mbps at half duplex.", hp->dev->name);
1937 }
1938 happy_meal_tcvr_write(hp, tregs, MII_BMCR, hp->sw_bmcr);
1939
1940 /* Finally stop polling and shut up the MIF. */
1941 happy_meal_poll_stop(hp, tregs);
1942 }
1943
1944 #ifdef TXDEBUG
1945 #define TXD(x) printk x
1946 #else
1947 #define TXD(x)
1948 #endif
1949
1950 /* hp->happy_lock must be held */
1951 static void happy_meal_tx(struct happy_meal *hp)
1952 {
1953 struct happy_meal_txd *txbase = &hp->happy_block->happy_meal_txd[0];
1954 struct happy_meal_txd *this;
1955 struct net_device *dev = hp->dev;
1956 int elem;
1957
1958 elem = hp->tx_old;
1959 TXD(("TX<"));
1960 while (elem != hp->tx_new) {
1961 struct sk_buff *skb;
1962 u32 flags, dma_addr, dma_len;
1963 int frag;
1964
1965 TXD(("[%d]", elem));
1966 this = &txbase[elem];
1967 flags = hme_read_desc32(hp, &this->tx_flags);
1968 if (flags & TXFLAG_OWN)
1969 break;
1970 skb = hp->tx_skbs[elem];
1971 if (skb_shinfo(skb)->nr_frags) {
1972 int last;
1973
1974 last = elem + skb_shinfo(skb)->nr_frags;
1975 last &= (TX_RING_SIZE - 1);
1976 flags = hme_read_desc32(hp, &txbase[last].tx_flags);
1977 if (flags & TXFLAG_OWN)
1978 break;
1979 }
1980 hp->tx_skbs[elem] = NULL;
1981 hp->net_stats.tx_bytes += skb->len;
1982
1983 for (frag = 0; frag <= skb_shinfo(skb)->nr_frags; frag++) {
1984 dma_addr = hme_read_desc32(hp, &this->tx_addr);
1985 dma_len = hme_read_desc32(hp, &this->tx_flags);
1986
1987 dma_len &= TXFLAG_SIZE;
1988 hme_dma_unmap(hp, dma_addr, dma_len, DMA_TODEVICE);
1989
1990 elem = NEXT_TX(elem);
1991 this = &txbase[elem];
1992 }
1993
1994 dev_kfree_skb_irq(skb);
1995 hp->net_stats.tx_packets++;
1996 }
1997 hp->tx_old = elem;
1998 TXD((">"));
1999
2000 if (netif_queue_stopped(dev) &&
2001 TX_BUFFS_AVAIL(hp) > (MAX_SKB_FRAGS + 1))
2002 netif_wake_queue(dev);
2003 }
2004
2005 #ifdef RXDEBUG
2006 #define RXD(x) printk x
2007 #else
2008 #define RXD(x)
2009 #endif
2010
2011 /* Originally I used to handle the allocation failure by just giving back just
2012 * that one ring buffer to the happy meal. Problem is that usually when that
2013 * condition is triggered, the happy meal expects you to do something reasonable
2014 * with all of the packets it has DMA'd in. So now I just drop the entire
2015 * ring when we cannot get a new skb and give them all back to the happy meal,
2016 * maybe things will be "happier" now.
2017 *
2018 * hp->happy_lock must be held
2019 */
2020 static void happy_meal_rx(struct happy_meal *hp, struct net_device *dev)
2021 {
2022 struct happy_meal_rxd *rxbase = &hp->happy_block->happy_meal_rxd[0];
2023 struct happy_meal_rxd *this;
2024 int elem = hp->rx_new, drops = 0;
2025 u32 flags;
2026
2027 RXD(("RX<"));
2028 this = &rxbase[elem];
2029 while (!((flags = hme_read_desc32(hp, &this->rx_flags)) & RXFLAG_OWN)) {
2030 struct sk_buff *skb;
2031 int len = flags >> 16;
2032 u16 csum = flags & RXFLAG_CSUM;
2033 u32 dma_addr = hme_read_desc32(hp, &this->rx_addr);
2034
2035 RXD(("[%d ", elem));
2036
2037 /* Check for errors. */
2038 if ((len < ETH_ZLEN) || (flags & RXFLAG_OVERFLOW)) {
2039 RXD(("ERR(%08x)]", flags));
2040 hp->net_stats.rx_errors++;
2041 if (len < ETH_ZLEN)
2042 hp->net_stats.rx_length_errors++;
2043 if (len & (RXFLAG_OVERFLOW >> 16)) {
2044 hp->net_stats.rx_over_errors++;
2045 hp->net_stats.rx_fifo_errors++;
2046 }
2047
2048 /* Return it to the Happy meal. */
2049 drop_it:
2050 hp->net_stats.rx_dropped++;
2051 hme_write_rxd(hp, this,
2052 (RXFLAG_OWN|((RX_BUF_ALLOC_SIZE-RX_OFFSET)<<16)),
2053 dma_addr);
2054 goto next;
2055 }
2056 skb = hp->rx_skbs[elem];
2057 if (len > RX_COPY_THRESHOLD) {
2058 struct sk_buff *new_skb;
2059
2060 /* Now refill the entry, if we can. */
2061 new_skb = happy_meal_alloc_skb(RX_BUF_ALLOC_SIZE, GFP_ATOMIC);
2062 if (new_skb == NULL) {
2063 drops++;
2064 goto drop_it;
2065 }
2066 hme_dma_unmap(hp, dma_addr, RX_BUF_ALLOC_SIZE, DMA_FROMDEVICE);
2067 hp->rx_skbs[elem] = new_skb;
2068 new_skb->dev = dev;
2069 skb_put(new_skb, (ETH_FRAME_LEN + RX_OFFSET));
2070 hme_write_rxd(hp, this,
2071 (RXFLAG_OWN|((RX_BUF_ALLOC_SIZE-RX_OFFSET)<<16)),
2072 hme_dma_map(hp, new_skb->data, RX_BUF_ALLOC_SIZE, DMA_FROMDEVICE));
2073 skb_reserve(new_skb, RX_OFFSET);
2074
2075 /* Trim the original skb for the netif. */
2076 skb_trim(skb, len);
2077 } else {
2078 struct sk_buff *copy_skb = dev_alloc_skb(len + 2);
2079
2080 if (copy_skb == NULL) {
2081 drops++;
2082 goto drop_it;
2083 }
2084
2085 copy_skb->dev = dev;
2086 skb_reserve(copy_skb, 2);
2087 skb_put(copy_skb, len);
2088 hme_dma_sync_for_cpu(hp, dma_addr, len, DMA_FROMDEVICE);
2089 memcpy(copy_skb->data, skb->data, len);
2090 hme_dma_sync_for_device(hp, dma_addr, len, DMA_FROMDEVICE);
2091
2092 /* Reuse original ring buffer. */
2093 hme_write_rxd(hp, this,
2094 (RXFLAG_OWN|((RX_BUF_ALLOC_SIZE-RX_OFFSET)<<16)),
2095 dma_addr);
2096
2097 skb = copy_skb;
2098 }
2099
2100 /* This card is _fucking_ hot... */
2101 skb->csum = ntohs(csum ^ 0xffff);
2102 skb->ip_summed = CHECKSUM_HW;
2103
2104 RXD(("len=%d csum=%4x]", len, csum));
2105 skb->protocol = eth_type_trans(skb, dev);
2106 netif_rx(skb);
2107
2108 dev->last_rx = jiffies;
2109 hp->net_stats.rx_packets++;
2110 hp->net_stats.rx_bytes += len;
2111 next:
2112 elem = NEXT_RX(elem);
2113 this = &rxbase[elem];
2114 }
2115 hp->rx_new = elem;
2116 if (drops)
2117 printk(KERN_INFO "%s: Memory squeeze, deferring packet.\n", hp->dev->name);
2118 RXD((">"));
2119 }
2120
2121 static irqreturn_t happy_meal_interrupt(int irq, void *dev_id, struct pt_regs *regs)
2122 {
2123 struct net_device *dev = (struct net_device *) dev_id;
2124 struct happy_meal *hp = dev->priv;
2125 u32 happy_status = hme_read32(hp, hp->gregs + GREG_STAT);
2126
2127 HMD(("happy_meal_interrupt: status=%08x ", happy_status));
2128
2129 spin_lock(&hp->happy_lock);
2130
2131 if (happy_status & GREG_STAT_ERRORS) {
2132 HMD(("ERRORS "));
2133 if (happy_meal_is_not_so_happy(hp, /* un- */ happy_status))
2134 goto out;
2135 }
2136
2137 if (happy_status & GREG_STAT_MIFIRQ) {
2138 HMD(("MIFIRQ "));
2139 happy_meal_mif_interrupt(hp);
2140 }
2141
2142 if (happy_status & GREG_STAT_TXALL) {
2143 HMD(("TXALL "));
2144 happy_meal_tx(hp);
2145 }
2146
2147 if (happy_status & GREG_STAT_RXTOHOST) {
2148 HMD(("RXTOHOST "));
2149 happy_meal_rx(hp, dev);
2150 }
2151
2152 HMD(("done\n"));
2153 out:
2154 spin_unlock(&hp->happy_lock);
2155
2156 return IRQ_HANDLED;
2157 }
2158
2159 #ifdef CONFIG_SBUS
2160 static irqreturn_t quattro_sbus_interrupt(int irq, void *cookie, struct pt_regs *ptregs)
2161 {
2162 struct quattro *qp = (struct quattro *) cookie;
2163 int i;
2164
2165 for (i = 0; i < 4; i++) {
2166 struct net_device *dev = qp->happy_meals[i];
2167 struct happy_meal *hp = dev->priv;
2168 u32 happy_status = hme_read32(hp, hp->gregs + GREG_STAT);
2169
2170 HMD(("quattro_interrupt: status=%08x ", happy_status));
2171
2172 if (!(happy_status & (GREG_STAT_ERRORS |
2173 GREG_STAT_MIFIRQ |
2174 GREG_STAT_TXALL |
2175 GREG_STAT_RXTOHOST)))
2176 continue;
2177
2178 spin_lock(&hp->happy_lock);
2179
2180 if (happy_status & GREG_STAT_ERRORS) {
2181 HMD(("ERRORS "));
2182 if (happy_meal_is_not_so_happy(hp, happy_status))
2183 goto next;
2184 }
2185
2186 if (happy_status & GREG_STAT_MIFIRQ) {
2187 HMD(("MIFIRQ "));
2188 happy_meal_mif_interrupt(hp);
2189 }
2190
2191 if (happy_status & GREG_STAT_TXALL) {
2192 HMD(("TXALL "));
2193 happy_meal_tx(hp);
2194 }
2195
2196 if (happy_status & GREG_STAT_RXTOHOST) {
2197 HMD(("RXTOHOST "));
2198 happy_meal_rx(hp, dev);
2199 }
2200
2201 next:
2202 spin_unlock(&hp->happy_lock);
2203 }
2204 HMD(("done\n"));
2205
2206 return IRQ_HANDLED;
2207 }
2208 #endif
2209
2210 static int happy_meal_open(struct net_device *dev)
2211 {
2212 struct happy_meal *hp = dev->priv;
2213 int res;
2214
2215 HMD(("happy_meal_open: "));
2216
2217 /* On SBUS Quattro QFE cards, all hme interrupts are concentrated
2218 * into a single source which we register handling at probe time.
2219 */
2220 if ((hp->happy_flags & (HFLAG_QUATTRO|HFLAG_PCI)) != HFLAG_QUATTRO) {
2221 if (request_irq(dev->irq, &happy_meal_interrupt,
2222 SA_SHIRQ, dev->name, (void *)dev)) {
2223 HMD(("EAGAIN\n"));
2224 #ifdef __sparc__
2225 printk(KERN_ERR "happy_meal(SBUS): Can't order irq %s to go.\n",
2226 __irq_itoa(dev->irq));
2227 #else
2228 printk(KERN_ERR "happy_meal(SBUS): Can't order irq %d to go.\n",
2229 dev->irq);
2230 #endif
2231
2232 return -EAGAIN;
2233 }
2234 }
2235
2236 HMD(("to happy_meal_init\n"));
2237
2238 spin_lock_irq(&hp->happy_lock);
2239 res = happy_meal_init(hp);
2240 spin_unlock_irq(&hp->happy_lock);
2241
2242 if (res && ((hp->happy_flags & (HFLAG_QUATTRO|HFLAG_PCI)) != HFLAG_QUATTRO))
2243 free_irq(dev->irq, dev);
2244 return res;
2245 }
2246
2247 static int happy_meal_close(struct net_device *dev)
2248 {
2249 struct happy_meal *hp = dev->priv;
2250
2251 spin_lock_irq(&hp->happy_lock);
2252 happy_meal_stop(hp, hp->gregs);
2253 happy_meal_clean_rings(hp);
2254
2255 /* If auto-negotiation timer is running, kill it. */
2256 del_timer(&hp->happy_timer);
2257
2258 spin_unlock_irq(&hp->happy_lock);
2259
2260 /* On Quattro QFE cards, all hme interrupts are concentrated
2261 * into a single source which we register handling at probe
2262 * time and never unregister.
2263 */
2264 if ((hp->happy_flags & (HFLAG_QUATTRO|HFLAG_PCI)) != HFLAG_QUATTRO)
2265 free_irq(dev->irq, dev);
2266
2267 return 0;
2268 }
2269
2270 #ifdef SXDEBUG
2271 #define SXD(x) printk x
2272 #else
2273 #define SXD(x)
2274 #endif
2275
2276 static void happy_meal_tx_timeout(struct net_device *dev)
2277 {
2278 struct happy_meal *hp = dev->priv;
2279
2280 printk (KERN_ERR "%s: transmit timed out, resetting\n", dev->name);
2281 tx_dump_log();
2282 printk (KERN_ERR "%s: Happy Status %08x TX[%08x:%08x]\n", dev->name,
2283 hme_read32(hp, hp->gregs + GREG_STAT),
2284 hme_read32(hp, hp->etxregs + ETX_CFG),
2285 hme_read32(hp, hp->bigmacregs + BMAC_TXCFG));
2286
2287 spin_lock_irq(&hp->happy_lock);
2288 happy_meal_init(hp);
2289 spin_unlock_irq(&hp->happy_lock);
2290
2291 netif_wake_queue(dev);
2292 }
2293
2294 static int happy_meal_start_xmit(struct sk_buff *skb, struct net_device *dev)
2295 {
2296 struct happy_meal *hp = dev->priv;
2297 int entry;
2298 u32 tx_flags;
2299
2300 tx_flags = TXFLAG_OWN;
2301 if (skb->ip_summed == CHECKSUM_HW) {
2302 u32 csum_start_off, csum_stuff_off;
2303
2304 csum_start_off = (u32) (skb->h.raw - skb->data);
2305 csum_stuff_off = (u32) ((skb->h.raw + skb->csum) - skb->data);
2306
2307 tx_flags = (TXFLAG_OWN | TXFLAG_CSENABLE |
2308 ((csum_start_off << 14) & TXFLAG_CSBUFBEGIN) |
2309 ((csum_stuff_off << 20) & TXFLAG_CSLOCATION));
2310 }
2311
2312 spin_lock_irq(&hp->happy_lock);
2313
2314 if (TX_BUFFS_AVAIL(hp) <= (skb_shinfo(skb)->nr_frags + 1)) {
2315 netif_stop_queue(dev);
2316 spin_unlock_irq(&hp->happy_lock);
2317 printk(KERN_ERR "%s: BUG! Tx Ring full when queue awake!\n",
2318 dev->name);
2319 return 1;
2320 }
2321
2322 entry = hp->tx_new;
2323 SXD(("SX<l[%d]e[%d]>", len, entry));
2324 hp->tx_skbs[entry] = skb;
2325
2326 if (skb_shinfo(skb)->nr_frags == 0) {
2327 u32 mapping, len;
2328
2329 len = skb->len;
2330 mapping = hme_dma_map(hp, skb->data, len, DMA_TODEVICE);
2331 tx_flags |= (TXFLAG_SOP | TXFLAG_EOP);
2332 hme_write_txd(hp, &hp->happy_block->happy_meal_txd[entry],
2333 (tx_flags | (len & TXFLAG_SIZE)),
2334 mapping);
2335 entry = NEXT_TX(entry);
2336 } else {
2337 u32 first_len, first_mapping;
2338 int frag, first_entry = entry;
2339
2340 /* We must give this initial chunk to the device last.
2341 * Otherwise we could race with the device.
2342 */
2343 first_len = skb_headlen(skb);
2344 first_mapping = hme_dma_map(hp, skb->data, first_len, DMA_TODEVICE);
2345 entry = NEXT_TX(entry);
2346
2347 for (frag = 0; frag < skb_shinfo(skb)->nr_frags; frag++) {
2348 skb_frag_t *this_frag = &skb_shinfo(skb)->frags[frag];
2349 u32 len, mapping, this_txflags;
2350
2351 len = this_frag->size;
2352 mapping = hme_dma_map(hp,
2353 ((void *) page_address(this_frag->page) +
2354 this_frag->page_offset),
2355 len, DMA_TODEVICE);
2356 this_txflags = tx_flags;
2357 if (frag == skb_shinfo(skb)->nr_frags - 1)
2358 this_txflags |= TXFLAG_EOP;
2359 hme_write_txd(hp, &hp->happy_block->happy_meal_txd[entry],
2360 (this_txflags | (len & TXFLAG_SIZE)),
2361 mapping);
2362 entry = NEXT_TX(entry);
2363 }
2364 hme_write_txd(hp, &hp->happy_block->happy_meal_txd[first_entry],
2365 (tx_flags | TXFLAG_SOP | (first_len & TXFLAG_SIZE)),
2366 first_mapping);
2367 }
2368
2369 hp->tx_new = entry;
2370
2371 if (TX_BUFFS_AVAIL(hp) <= (MAX_SKB_FRAGS + 1))
2372 netif_stop_queue(dev);
2373
2374 /* Get it going. */
2375 hme_write32(hp, hp->etxregs + ETX_PENDING, ETX_TP_DMAWAKEUP);
2376
2377 spin_unlock_irq(&hp->happy_lock);
2378
2379 dev->trans_start = jiffies;
2380
2381 tx_add_log(hp, TXLOG_ACTION_TXMIT, 0);
2382 return 0;
2383 }
2384
2385 static struct net_device_stats *happy_meal_get_stats(struct net_device *dev)
2386 {
2387 struct happy_meal *hp = dev->priv;
2388
2389 spin_lock_irq(&hp->happy_lock);
2390 happy_meal_get_counters(hp, hp->bigmacregs);
2391 spin_unlock_irq(&hp->happy_lock);
2392
2393 return &hp->net_stats;
2394 }
2395
2396 static void happy_meal_set_multicast(struct net_device *dev)
2397 {
2398 struct happy_meal *hp = dev->priv;
2399 void __iomem *bregs = hp->bigmacregs;
2400 struct dev_mc_list *dmi = dev->mc_list;
2401 char *addrs;
2402 int i;
2403 u32 crc;
2404
2405 spin_lock_irq(&hp->happy_lock);
2406
2407 netif_stop_queue(dev);
2408
2409 if ((dev->flags & IFF_ALLMULTI) || (dev->mc_count > 64)) {
2410 hme_write32(hp, bregs + BMAC_HTABLE0, 0xffff);
2411 hme_write32(hp, bregs + BMAC_HTABLE1, 0xffff);
2412 hme_write32(hp, bregs + BMAC_HTABLE2, 0xffff);
2413 hme_write32(hp, bregs + BMAC_HTABLE3, 0xffff);
2414 } else if (dev->flags & IFF_PROMISC) {
2415 hme_write32(hp, bregs + BMAC_RXCFG,
2416 hme_read32(hp, bregs + BMAC_RXCFG) | BIGMAC_RXCFG_PMISC);
2417 } else {
2418 u16 hash_table[4];
2419
2420 for (i = 0; i < 4; i++)
2421 hash_table[i] = 0;
2422
2423 for (i = 0; i < dev->mc_count; i++) {
2424 addrs = dmi->dmi_addr;
2425 dmi = dmi->next;
2426
2427 if (!(*addrs & 1))
2428 continue;
2429
2430 crc = ether_crc_le(6, addrs);
2431 crc >>= 26;
2432 hash_table[crc >> 4] |= 1 << (crc & 0xf);
2433 }
2434 hme_write32(hp, bregs + BMAC_HTABLE0, hash_table[0]);
2435 hme_write32(hp, bregs + BMAC_HTABLE1, hash_table[1]);
2436 hme_write32(hp, bregs + BMAC_HTABLE2, hash_table[2]);
2437 hme_write32(hp, bregs + BMAC_HTABLE3, hash_table[3]);
2438 }
2439
2440 netif_wake_queue(dev);
2441
2442 spin_unlock_irq(&hp->happy_lock);
2443 }
2444
2445 /* Ethtool support... */
2446 static int hme_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2447 {
2448 struct happy_meal *hp = dev->priv;
2449
2450 cmd->supported =
2451 (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
2452 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
2453 SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII);
2454
2455 /* XXX hardcoded stuff for now */
2456 cmd->port = PORT_TP; /* XXX no MII support */
2457 cmd->transceiver = XCVR_INTERNAL; /* XXX no external xcvr support */
2458 cmd->phy_address = 0; /* XXX fixed PHYAD */
2459
2460 /* Record PHY settings. */
2461 spin_lock_irq(&hp->happy_lock);
2462 hp->sw_bmcr = happy_meal_tcvr_read(hp, hp->tcvregs, MII_BMCR);
2463 hp->sw_lpa = happy_meal_tcvr_read(hp, hp->tcvregs, MII_LPA);
2464 spin_unlock_irq(&hp->happy_lock);
2465
2466 if (hp->sw_bmcr & BMCR_ANENABLE) {
2467 cmd->autoneg = AUTONEG_ENABLE;
2468 cmd->speed =
2469 (hp->sw_lpa & (LPA_100HALF | LPA_100FULL)) ?
2470 SPEED_100 : SPEED_10;
2471 if (cmd->speed == SPEED_100)
2472 cmd->duplex =
2473 (hp->sw_lpa & (LPA_100FULL)) ?
2474 DUPLEX_FULL : DUPLEX_HALF;
2475 else
2476 cmd->duplex =
2477 (hp->sw_lpa & (LPA_10FULL)) ?
2478 DUPLEX_FULL : DUPLEX_HALF;
2479 } else {
2480 cmd->autoneg = AUTONEG_DISABLE;
2481 cmd->speed =
2482 (hp->sw_bmcr & BMCR_SPEED100) ?
2483 SPEED_100 : SPEED_10;
2484 cmd->duplex =
2485 (hp->sw_bmcr & BMCR_FULLDPLX) ?
2486 DUPLEX_FULL : DUPLEX_HALF;
2487 }
2488 return 0;
2489 }
2490
2491 static int hme_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2492 {
2493 struct happy_meal *hp = dev->priv;
2494
2495 /* Verify the settings we care about. */
2496 if (cmd->autoneg != AUTONEG_ENABLE &&
2497 cmd->autoneg != AUTONEG_DISABLE)
2498 return -EINVAL;
2499 if (cmd->autoneg == AUTONEG_DISABLE &&
2500 ((cmd->speed != SPEED_100 &&
2501 cmd->speed != SPEED_10) ||
2502 (cmd->duplex != DUPLEX_HALF &&
2503 cmd->duplex != DUPLEX_FULL)))
2504 return -EINVAL;
2505
2506 /* Ok, do it to it. */
2507 spin_lock_irq(&hp->happy_lock);
2508 del_timer(&hp->happy_timer);
2509 happy_meal_begin_auto_negotiation(hp, hp->tcvregs, cmd);
2510 spin_unlock_irq(&hp->happy_lock);
2511
2512 return 0;
2513 }
2514
2515 static void hme_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
2516 {
2517 struct happy_meal *hp = dev->priv;
2518
2519 strcpy(info->driver, "sunhme");
2520 strcpy(info->version, "2.02");
2521 if (hp->happy_flags & HFLAG_PCI) {
2522 struct pci_dev *pdev = hp->happy_dev;
2523 strcpy(info->bus_info, pci_name(pdev));
2524 }
2525 #ifdef CONFIG_SBUS
2526 else {
2527 struct sbus_dev *sdev = hp->happy_dev;
2528 sprintf(info->bus_info, "SBUS:%d",
2529 sdev->slot);
2530 }
2531 #endif
2532 }
2533
2534 static u32 hme_get_link(struct net_device *dev)
2535 {
2536 struct happy_meal *hp = dev->priv;
2537
2538 spin_lock_irq(&hp->happy_lock);
2539 hp->sw_bmcr = happy_meal_tcvr_read(hp, hp->tcvregs, MII_BMCR);
2540 spin_unlock_irq(&hp->happy_lock);
2541
2542 return (hp->sw_bmsr & BMSR_LSTATUS);
2543 }
2544
2545 static struct ethtool_ops hme_ethtool_ops = {
2546 .get_settings = hme_get_settings,
2547 .set_settings = hme_set_settings,
2548 .get_drvinfo = hme_get_drvinfo,
2549 .get_link = hme_get_link,
2550 };
2551
2552 static int hme_version_printed;
2553
2554 #ifdef CONFIG_SBUS
2555 void __init quattro_get_ranges(struct quattro *qp)
2556 {
2557 struct sbus_dev *sdev = qp->quattro_dev;
2558 int err;
2559
2560 err = prom_getproperty(sdev->prom_node,
2561 "ranges",
2562 (char *)&qp->ranges[0],
2563 sizeof(qp->ranges));
2564 if (err == 0 || err == -1) {
2565 qp->nranges = 0;
2566 return;
2567 }
2568 qp->nranges = (err / sizeof(struct linux_prom_ranges));
2569 }
2570
2571 static void __init quattro_apply_ranges(struct quattro *qp, struct happy_meal *hp)
2572 {
2573 struct sbus_dev *sdev = hp->happy_dev;
2574 int rng;
2575
2576 for (rng = 0; rng < qp->nranges; rng++) {
2577 struct linux_prom_ranges *rngp = &qp->ranges[rng];
2578 int reg;
2579
2580 for (reg = 0; reg < 5; reg++) {
2581 if (sdev->reg_addrs[reg].which_io ==
2582 rngp->ot_child_space)
2583 break;
2584 }
2585 if (reg == 5)
2586 continue;
2587
2588 sdev->reg_addrs[reg].which_io = rngp->ot_parent_space;
2589 sdev->reg_addrs[reg].phys_addr += rngp->ot_parent_base;
2590 }
2591 }
2592
2593 /* Given a happy meal sbus device, find it's quattro parent.
2594 * If none exist, allocate and return a new one.
2595 *
2596 * Return NULL on failure.
2597 */
2598 static struct quattro * __init quattro_sbus_find(struct sbus_dev *goal_sdev)
2599 {
2600 struct sbus_bus *sbus;
2601 struct sbus_dev *sdev;
2602 struct quattro *qp;
2603 int i;
2604
2605 if (qfe_sbus_list == NULL)
2606 goto found;
2607
2608 for (qp = qfe_sbus_list; qp != NULL; qp = qp->next) {
2609 for (i = 0, sdev = qp->quattro_dev;
2610 (sdev != NULL) && (i < 4);
2611 sdev = sdev->next, i++) {
2612 if (sdev == goal_sdev)
2613 return qp;
2614 }
2615 }
2616 for_each_sbus(sbus) {
2617 for_each_sbusdev(sdev, sbus) {
2618 if (sdev == goal_sdev)
2619 goto found;
2620 }
2621 }
2622
2623 /* Cannot find quattro parent, fail. */
2624 return NULL;
2625
2626 found:
2627 qp = kmalloc(sizeof(struct quattro), GFP_KERNEL);
2628 if (qp != NULL) {
2629 int i;
2630
2631 for (i = 0; i < 4; i++)
2632 qp->happy_meals[i] = NULL;
2633
2634 qp->quattro_dev = goal_sdev;
2635 qp->next = qfe_sbus_list;
2636 qfe_sbus_list = qp;
2637 quattro_get_ranges(qp);
2638 }
2639 return qp;
2640 }
2641
2642 /* After all quattro cards have been probed, we call these functions
2643 * to register the IRQ handlers.
2644 */
2645 static void __init quattro_sbus_register_irqs(void)
2646 {
2647 struct quattro *qp;
2648
2649 for (qp = qfe_sbus_list; qp != NULL; qp = qp->next) {
2650 struct sbus_dev *sdev = qp->quattro_dev;
2651 int err;
2652
2653 err = request_irq(sdev->irqs[0],
2654 quattro_sbus_interrupt,
2655 SA_SHIRQ, "Quattro",
2656 qp);
2657 if (err != 0) {
2658 printk(KERN_ERR "Quattro: Fatal IRQ registery error %d.\n", err);
2659 panic("QFE request irq");
2660 }
2661 }
2662 }
2663 #endif /* CONFIG_SBUS */
2664
2665 #ifdef CONFIG_PCI
2666 static struct quattro * __init quattro_pci_find(struct pci_dev *pdev)
2667 {
2668 struct pci_dev *bdev = pdev->bus->self;
2669 struct quattro *qp;
2670
2671 if (!bdev) return NULL;
2672 for (qp = qfe_pci_list; qp != NULL; qp = qp->next) {
2673 struct pci_dev *qpdev = qp->quattro_dev;
2674
2675 if (qpdev == bdev)
2676 return qp;
2677 }
2678 qp = kmalloc(sizeof(struct quattro), GFP_KERNEL);
2679 if (qp != NULL) {
2680 int i;
2681
2682 for (i = 0; i < 4; i++)
2683 qp->happy_meals[i] = NULL;
2684
2685 qp->quattro_dev = bdev;
2686 qp->next = qfe_pci_list;
2687 qfe_pci_list = qp;
2688
2689 /* No range tricks necessary on PCI. */
2690 qp->nranges = 0;
2691 }
2692 return qp;
2693 }
2694 #endif /* CONFIG_PCI */
2695
2696 #ifdef CONFIG_SBUS
2697 static int __init happy_meal_sbus_init(struct sbus_dev *sdev, int is_qfe)
2698 {
2699 struct quattro *qp = NULL;
2700 struct happy_meal *hp;
2701 struct net_device *dev;
2702 int i, qfe_slot = -1;
2703 int err = -ENODEV;
2704
2705 if (is_qfe) {
2706 qp = quattro_sbus_find(sdev);
2707 if (qp == NULL)
2708 goto err_out;
2709 for (qfe_slot = 0; qfe_slot < 4; qfe_slot++)
2710 if (qp->happy_meals[qfe_slot] == NULL)
2711 break;
2712 if (qfe_slot == 4)
2713 goto err_out;
2714 }
2715
2716 err = -ENOMEM;
2717 dev = alloc_etherdev(sizeof(struct happy_meal));
2718 if (!dev)
2719 goto err_out;
2720 SET_MODULE_OWNER(dev);
2721
2722 if (hme_version_printed++ == 0)
2723 printk(KERN_INFO "%s", version);
2724
2725 /* If user did not specify a MAC address specifically, use
2726 * the Quattro local-mac-address property...
2727 */
2728 for (i = 0; i < 6; i++) {
2729 if (macaddr[i] != 0)
2730 break;
2731 }
2732 if (i < 6) { /* a mac address was given */
2733 for (i = 0; i < 6; i++)
2734 dev->dev_addr[i] = macaddr[i];
2735 macaddr[5]++;
2736 } else if (qfe_slot != -1 &&
2737 prom_getproplen(sdev->prom_node,
2738 "local-mac-address") == 6) {
2739 prom_getproperty(sdev->prom_node, "local-mac-address",
2740 dev->dev_addr, 6);
2741 } else {
2742 memcpy(dev->dev_addr, idprom->id_ethaddr, 6);
2743 }
2744
2745 hp = dev->priv;
2746
2747 hp->happy_dev = sdev;
2748
2749 spin_lock_init(&hp->happy_lock);
2750
2751 err = -ENODEV;
2752 if (sdev->num_registers != 5) {
2753 printk(KERN_ERR "happymeal: Device does not have 5 regs, it has %d.\n",
2754 sdev->num_registers);
2755 printk(KERN_ERR "happymeal: Would you like that for here or to go?\n");
2756 goto err_out_free_netdev;
2757 }
2758
2759 if (qp != NULL) {
2760 hp->qfe_parent = qp;
2761 hp->qfe_ent = qfe_slot;
2762 qp->happy_meals[qfe_slot] = dev;
2763 quattro_apply_ranges(qp, hp);
2764 }
2765
2766 hp->gregs = sbus_ioremap(&sdev->resource[0], 0,
2767 GREG_REG_SIZE, "HME Global Regs");
2768 if (!hp->gregs) {
2769 printk(KERN_ERR "happymeal: Cannot map Happy Meal global registers.\n");
2770 goto err_out_free_netdev;
2771 }
2772
2773 hp->etxregs = sbus_ioremap(&sdev->resource[1], 0,
2774 ETX_REG_SIZE, "HME TX Regs");
2775 if (!hp->etxregs) {
2776 printk(KERN_ERR "happymeal: Cannot map Happy Meal MAC Transmit registers.\n");
2777 goto err_out_iounmap;
2778 }
2779
2780 hp->erxregs = sbus_ioremap(&sdev->resource[2], 0,
2781 ERX_REG_SIZE, "HME RX Regs");
2782 if (!hp->erxregs) {
2783 printk(KERN_ERR "happymeal: Cannot map Happy Meal MAC Receive registers.\n");
2784 goto err_out_iounmap;
2785 }
2786
2787 hp->bigmacregs = sbus_ioremap(&sdev->resource[3], 0,
2788 BMAC_REG_SIZE, "HME BIGMAC Regs");
2789 if (!hp->bigmacregs) {
2790 printk(KERN_ERR "happymeal: Cannot map Happy Meal BIGMAC registers.\n");
2791 goto err_out_iounmap;
2792 }
2793
2794 hp->tcvregs = sbus_ioremap(&sdev->resource[4], 0,
2795 TCVR_REG_SIZE, "HME Tranceiver Regs");
2796 if (!hp->tcvregs) {
2797 printk(KERN_ERR "happymeal: Cannot map Happy Meal Tranceiver registers.\n");
2798 goto err_out_iounmap;
2799 }
2800
2801 hp->hm_revision = prom_getintdefault(sdev->prom_node, "hm-rev", 0xff);
2802 if (hp->hm_revision == 0xff)
2803 hp->hm_revision = 0xa0;
2804
2805 /* Now enable the feature flags we can. */
2806 if (hp->hm_revision == 0x20 || hp->hm_revision == 0x21)
2807 hp->happy_flags = HFLAG_20_21;
2808 else if (hp->hm_revision != 0xa0)
2809 hp->happy_flags = HFLAG_NOT_A0;
2810
2811 if (qp != NULL)
2812 hp->happy_flags |= HFLAG_QUATTRO;
2813
2814 /* Get the supported DVMA burst sizes from our Happy SBUS. */
2815 hp->happy_bursts = prom_getintdefault(sdev->bus->prom_node,
2816 "burst-sizes", 0x00);
2817
2818 hp->happy_block = sbus_alloc_consistent(hp->happy_dev,
2819 PAGE_SIZE,
2820 &hp->hblock_dvma);
2821 err = -ENOMEM;
2822 if (!hp->happy_block) {
2823 printk(KERN_ERR "happymeal: Cannot allocate descriptors.\n");
2824 goto err_out_iounmap;
2825 }
2826
2827 /* Force check of the link first time we are brought up. */
2828 hp->linkcheck = 0;
2829
2830 /* Force timer state to 'asleep' with count of zero. */
2831 hp->timer_state = asleep;
2832 hp->timer_ticks = 0;
2833
2834 init_timer(&hp->happy_timer);
2835
2836 hp->dev = dev;
2837 dev->open = &happy_meal_open;
2838 dev->stop = &happy_meal_close;
2839 dev->hard_start_xmit = &happy_meal_start_xmit;
2840 dev->get_stats = &happy_meal_get_stats;
2841 dev->set_multicast_list = &happy_meal_set_multicast;
2842 dev->tx_timeout = &happy_meal_tx_timeout;
2843 dev->watchdog_timeo = 5*HZ;
2844 dev->ethtool_ops = &hme_ethtool_ops;
2845
2846 /* Happy Meal can do it all... except VLAN. */
2847 dev->features |= NETIF_F_SG | NETIF_F_HW_CSUM | NETIF_F_VLAN_CHALLENGED;
2848
2849 dev->irq = sdev->irqs[0];
2850
2851 #if defined(CONFIG_SBUS) && defined(CONFIG_PCI)
2852 /* Hook up PCI register/dma accessors. */
2853 hp->read_desc32 = sbus_hme_read_desc32;
2854 hp->write_txd = sbus_hme_write_txd;
2855 hp->write_rxd = sbus_hme_write_rxd;
2856 hp->dma_map = (u32 (*)(void *, void *, long, int))sbus_map_single;
2857 hp->dma_unmap = (void (*)(void *, u32, long, int))sbus_unmap_single;
2858 hp->dma_sync_for_cpu = (void (*)(void *, u32, long, int))
2859 sbus_dma_sync_single_for_cpu;
2860 hp->dma_sync_for_device = (void (*)(void *, u32, long, int))
2861 sbus_dma_sync_single_for_device;
2862 hp->read32 = sbus_hme_read32;
2863 hp->write32 = sbus_hme_write32;
2864 #endif
2865
2866 /* Grrr, Happy Meal comes up by default not advertising
2867 * full duplex 100baseT capabilities, fix this.
2868 */
2869 spin_lock_irq(&hp->happy_lock);
2870 happy_meal_set_initial_advertisement(hp);
2871 spin_unlock_irq(&hp->happy_lock);
2872
2873 if (register_netdev(hp->dev)) {
2874 printk(KERN_ERR "happymeal: Cannot register net device, "
2875 "aborting.\n");
2876 goto err_out_free_consistent;
2877 }
2878
2879 if (qfe_slot != -1)
2880 printk(KERN_INFO "%s: Quattro HME slot %d (SBUS) 10/100baseT Ethernet ",
2881 dev->name, qfe_slot);
2882 else
2883 printk(KERN_INFO "%s: HAPPY MEAL (SBUS) 10/100baseT Ethernet ",
2884 dev->name);
2885
2886 for (i = 0; i < 6; i++)
2887 printk("%2.2x%c",
2888 dev->dev_addr[i], i == 5 ? ' ' : ':');
2889 printk("\n");
2890
2891 /* We are home free at this point, link us in to the happy
2892 * device list.
2893 */
2894 hp->next_module = root_happy_dev;
2895 root_happy_dev = hp;
2896
2897 return 0;
2898
2899 err_out_free_consistent:
2900 sbus_free_consistent(hp->happy_dev,
2901 PAGE_SIZE,
2902 hp->happy_block,
2903 hp->hblock_dvma);
2904
2905 err_out_iounmap:
2906 if (hp->gregs)
2907 sbus_iounmap(hp->gregs, GREG_REG_SIZE);
2908 if (hp->etxregs)
2909 sbus_iounmap(hp->etxregs, ETX_REG_SIZE);
2910 if (hp->erxregs)
2911 sbus_iounmap(hp->erxregs, ERX_REG_SIZE);
2912 if (hp->bigmacregs)
2913 sbus_iounmap(hp->bigmacregs, BMAC_REG_SIZE);
2914 if (hp->tcvregs)
2915 sbus_iounmap(hp->tcvregs, TCVR_REG_SIZE);
2916
2917 err_out_free_netdev:
2918 free_netdev(dev);
2919
2920 err_out:
2921 return err;
2922 }
2923 #endif
2924
2925 #ifdef CONFIG_PCI
2926 #ifndef __sparc__
2927 static int is_quattro_p(struct pci_dev *pdev)
2928 {
2929 struct pci_dev *busdev = pdev->bus->self;
2930 struct list_head *tmp;
2931 int n_hmes;
2932
2933 if (busdev == NULL ||
2934 busdev->vendor != PCI_VENDOR_ID_DEC ||
2935 busdev->device != PCI_DEVICE_ID_DEC_21153)
2936 return 0;
2937
2938 n_hmes = 0;
2939 tmp = pdev->bus->devices.next;
2940 while (tmp != &pdev->bus->devices) {
2941 struct pci_dev *this_pdev = pci_dev_b(tmp);
2942
2943 if (this_pdev->vendor == PCI_VENDOR_ID_SUN &&
2944 this_pdev->device == PCI_DEVICE_ID_SUN_HAPPYMEAL)
2945 n_hmes++;
2946
2947 tmp = tmp->next;
2948 }
2949
2950 if (n_hmes != 4)
2951 return 0;
2952
2953 return 1;
2954 }
2955
2956 /* Fetch MAC address from vital product data of PCI ROM. */
2957 static int find_eth_addr_in_vpd(void __iomem *rom_base, int len, int index, unsigned char *dev_addr)
2958 {
2959 int this_offset;
2960
2961 for (this_offset = 0x20; this_offset < len; this_offset++) {
2962 void __iomem *p = rom_base + this_offset;
2963
2964 if (readb(p + 0) != 0x90 ||
2965 readb(p + 1) != 0x00 ||
2966 readb(p + 2) != 0x09 ||
2967 readb(p + 3) != 0x4e ||
2968 readb(p + 4) != 0x41 ||
2969 readb(p + 5) != 0x06)
2970 continue;
2971
2972 this_offset += 6;
2973 p += 6;
2974
2975 if (index == 0) {
2976 int i;
2977
2978 for (i = 0; i < 6; i++)
2979 dev_addr[i] = readb(p + i);
2980 return 1;
2981 }
2982 index--;
2983 }
2984 return 0;
2985 }
2986
2987 static void get_hme_mac_nonsparc(struct pci_dev *pdev, unsigned char *dev_addr)
2988 {
2989 size_t size;
2990 void __iomem *p = pci_map_rom(pdev, &size);
2991
2992 if (p) {
2993 int index = 0;
2994 int found;
2995
2996 if (is_quattro_p(pdev))
2997 index = PCI_SLOT(pdev->devfn);
2998
2999 found = readb(p) == 0x55 &&
3000 readb(p + 1) == 0xaa &&
3001 find_eth_addr_in_vpd(p, (64 * 1024), index, dev_addr);
3002 pci_unmap_rom(pdev, p);
3003 if (found)
3004 return;
3005 }
3006
3007 /* Sun MAC prefix then 3 random bytes. */
3008 dev_addr[0] = 0x08;
3009 dev_addr[1] = 0x00;
3010 dev_addr[2] = 0x20;
3011 get_random_bytes(&dev_addr[3], 3);
3012 return;
3013 }
3014 #endif /* !(__sparc__) */
3015
3016 static int __init happy_meal_pci_init(struct pci_dev *pdev)
3017 {
3018 struct quattro *qp = NULL;
3019 #ifdef __sparc__
3020 struct pcidev_cookie *pcp;
3021 int node;
3022 #endif
3023 struct happy_meal *hp;
3024 struct net_device *dev;
3025 void __iomem *hpreg_base;
3026 unsigned long hpreg_res;
3027 int i, qfe_slot = -1;
3028 char prom_name[64];
3029 int err;
3030
3031 /* Now make sure pci_dev cookie is there. */
3032 #ifdef __sparc__
3033 pcp = pdev->sysdata;
3034 if (pcp == NULL || pcp->prom_node == -1) {
3035 printk(KERN_ERR "happymeal(PCI): Some PCI device info missing\n");
3036 return -ENODEV;
3037 }
3038 node = pcp->prom_node;
3039
3040 prom_getstring(node, "name", prom_name, sizeof(prom_name));
3041 #else
3042 if (is_quattro_p(pdev))
3043 strcpy(prom_name, "SUNW,qfe");
3044 else
3045 strcpy(prom_name, "SUNW,hme");
3046 #endif
3047
3048 err = -ENODEV;
3049 if (!strcmp(prom_name, "SUNW,qfe") || !strcmp(prom_name, "qfe")) {
3050 qp = quattro_pci_find(pdev);
3051 if (qp == NULL)
3052 goto err_out;
3053 for (qfe_slot = 0; qfe_slot < 4; qfe_slot++)
3054 if (qp->happy_meals[qfe_slot] == NULL)
3055 break;
3056 if (qfe_slot == 4)
3057 goto err_out;
3058 }
3059
3060 dev = alloc_etherdev(sizeof(struct happy_meal));
3061 err = -ENOMEM;
3062 if (!dev)
3063 goto err_out;
3064 SET_MODULE_OWNER(dev);
3065 SET_NETDEV_DEV(dev, &pdev->dev);
3066
3067 if (hme_version_printed++ == 0)
3068 printk(KERN_INFO "%s", version);
3069
3070 dev->base_addr = (long) pdev;
3071
3072 hp = (struct happy_meal *)dev->priv;
3073 memset(hp, 0, sizeof(*hp));
3074
3075 hp->happy_dev = pdev;
3076
3077 spin_lock_init(&hp->happy_lock);
3078
3079 if (qp != NULL) {
3080 hp->qfe_parent = qp;
3081 hp->qfe_ent = qfe_slot;
3082 qp->happy_meals[qfe_slot] = dev;
3083 }
3084
3085 hpreg_res = pci_resource_start(pdev, 0);
3086 err = -ENODEV;
3087 if ((pci_resource_flags(pdev, 0) & IORESOURCE_IO) != 0) {
3088 printk(KERN_ERR "happymeal(PCI): Cannot find proper PCI device base address.\n");
3089 goto err_out_clear_quattro;
3090 }
3091 if (pci_request_regions(pdev, DRV_NAME)) {
3092 printk(KERN_ERR "happymeal(PCI): Cannot obtain PCI resources, "
3093 "aborting.\n");
3094 goto err_out_clear_quattro;
3095 }
3096
3097 if ((hpreg_base = ioremap(hpreg_res, 0x8000)) == 0) {
3098 printk(KERN_ERR "happymeal(PCI): Unable to remap card memory.\n");
3099 goto err_out_free_res;
3100 }
3101
3102 for (i = 0; i < 6; i++) {
3103 if (macaddr[i] != 0)
3104 break;
3105 }
3106 if (i < 6) { /* a mac address was given */
3107 for (i = 0; i < 6; i++)
3108 dev->dev_addr[i] = macaddr[i];
3109 macaddr[5]++;
3110 } else {
3111 #ifdef __sparc__
3112 if (qfe_slot != -1 &&
3113 prom_getproplen(node, "local-mac-address") == 6) {
3114 prom_getproperty(node, "local-mac-address",
3115 dev->dev_addr, 6);
3116 } else {
3117 memcpy(dev->dev_addr, idprom->id_ethaddr, 6);
3118 }
3119 #else
3120 get_hme_mac_nonsparc(pdev, &dev->dev_addr[0]);
3121 #endif
3122 }
3123
3124 /* Layout registers. */
3125 hp->gregs = (hpreg_base + 0x0000UL);
3126 hp->etxregs = (hpreg_base + 0x2000UL);
3127 hp->erxregs = (hpreg_base + 0x4000UL);
3128 hp->bigmacregs = (hpreg_base + 0x6000UL);
3129 hp->tcvregs = (hpreg_base + 0x7000UL);
3130
3131 #ifdef __sparc__
3132 hp->hm_revision = prom_getintdefault(node, "hm-rev", 0xff);
3133 if (hp->hm_revision == 0xff) {
3134 unsigned char prev;
3135
3136 pci_read_config_byte(pdev, PCI_REVISION_ID, &prev);
3137 hp->hm_revision = 0xc0 | (prev & 0x0f);
3138 }
3139 #else
3140 /* works with this on non-sparc hosts */
3141 hp->hm_revision = 0x20;
3142 #endif
3143
3144 /* Now enable the feature flags we can. */
3145 if (hp->hm_revision == 0x20 || hp->hm_revision == 0x21)
3146 hp->happy_flags = HFLAG_20_21;
3147 else if (hp->hm_revision != 0xa0 && hp->hm_revision != 0xc0)
3148 hp->happy_flags = HFLAG_NOT_A0;
3149
3150 if (qp != NULL)
3151 hp->happy_flags |= HFLAG_QUATTRO;
3152
3153 /* And of course, indicate this is PCI. */
3154 hp->happy_flags |= HFLAG_PCI;
3155
3156 #ifdef __sparc__
3157 /* Assume PCI happy meals can handle all burst sizes. */
3158 hp->happy_bursts = DMA_BURSTBITS;
3159 #endif
3160
3161 hp->happy_block = (struct hmeal_init_block *)
3162 pci_alloc_consistent(pdev, PAGE_SIZE, &hp->hblock_dvma);
3163
3164 err = -ENODEV;
3165 if (!hp->happy_block) {
3166 printk(KERN_ERR "happymeal(PCI): Cannot get hme init block.\n");
3167 goto err_out_iounmap;
3168 }
3169
3170 hp->linkcheck = 0;
3171 hp->timer_state = asleep;
3172 hp->timer_ticks = 0;
3173
3174 init_timer(&hp->happy_timer);
3175
3176 hp->dev = dev;
3177 dev->open = &happy_meal_open;
3178 dev->stop = &happy_meal_close;
3179 dev->hard_start_xmit = &happy_meal_start_xmit;
3180 dev->get_stats = &happy_meal_get_stats;
3181 dev->set_multicast_list = &happy_meal_set_multicast;
3182 dev->tx_timeout = &happy_meal_tx_timeout;
3183 dev->watchdog_timeo = 5*HZ;
3184 dev->ethtool_ops = &hme_ethtool_ops;
3185 dev->irq = pdev->irq;
3186 dev->dma = 0;
3187
3188 /* Happy Meal can do it all... */
3189 dev->features |= NETIF_F_SG | NETIF_F_HW_CSUM;
3190
3191 #if defined(CONFIG_SBUS) && defined(CONFIG_PCI)
3192 /* Hook up PCI register/dma accessors. */
3193 hp->read_desc32 = pci_hme_read_desc32;
3194 hp->write_txd = pci_hme_write_txd;
3195 hp->write_rxd = pci_hme_write_rxd;
3196 hp->dma_map = (u32 (*)(void *, void *, long, int))pci_map_single;
3197 hp->dma_unmap = (void (*)(void *, u32, long, int))pci_unmap_single;
3198 hp->dma_sync_for_cpu = (void (*)(void *, u32, long, int))
3199 pci_dma_sync_single_for_cpu;
3200 hp->dma_sync_for_device = (void (*)(void *, u32, long, int))
3201 pci_dma_sync_single_for_device;
3202 hp->read32 = pci_hme_read32;
3203 hp->write32 = pci_hme_write32;
3204 #endif
3205
3206 /* Grrr, Happy Meal comes up by default not advertising
3207 * full duplex 100baseT capabilities, fix this.
3208 */
3209 spin_lock_irq(&hp->happy_lock);
3210 happy_meal_set_initial_advertisement(hp);
3211 spin_unlock_irq(&hp->happy_lock);
3212
3213 if (register_netdev(hp->dev)) {
3214 printk(KERN_ERR "happymeal(PCI): Cannot register net device, "
3215 "aborting.\n");
3216 goto err_out_iounmap;
3217 }
3218
3219 if (!qfe_slot) {
3220 struct pci_dev *qpdev = qp->quattro_dev;
3221
3222 prom_name[0] = 0;
3223 if (!strncmp(dev->name, "eth", 3)) {
3224 int i = simple_strtoul(dev->name + 3, NULL, 10);
3225 sprintf(prom_name, "-%d", i + 3);
3226 }
3227 printk(KERN_INFO "%s%s: Quattro HME (PCI/CheerIO) 10/100baseT Ethernet ", dev->name, prom_name);
3228 if (qpdev->vendor == PCI_VENDOR_ID_DEC &&
3229 qpdev->device == PCI_DEVICE_ID_DEC_21153)
3230 printk("DEC 21153 PCI Bridge\n");
3231 else
3232 printk("unknown bridge %04x.%04x\n",
3233 qpdev->vendor, qpdev->device);
3234 }
3235
3236 if (qfe_slot != -1)
3237 printk(KERN_INFO "%s: Quattro HME slot %d (PCI/CheerIO) 10/100baseT Ethernet ",
3238 dev->name, qfe_slot);
3239 else
3240 printk(KERN_INFO "%s: HAPPY MEAL (PCI/CheerIO) 10/100BaseT Ethernet ",
3241 dev->name);
3242
3243 for (i = 0; i < 6; i++)
3244 printk("%2.2x%c", dev->dev_addr[i], i == 5 ? ' ' : ':');
3245
3246 printk("\n");
3247
3248 /* We are home free at this point, link us in to the happy
3249 * device list.
3250 */
3251 hp->next_module = root_happy_dev;
3252 root_happy_dev = hp;
3253
3254 return 0;
3255
3256 err_out_iounmap:
3257 iounmap(hp->gregs);
3258
3259 err_out_free_res:
3260 pci_release_regions(pdev);
3261
3262 err_out_clear_quattro:
3263 if (qp != NULL)
3264 qp->happy_meals[qfe_slot] = NULL;
3265
3266 free_netdev(dev);
3267
3268 err_out:
3269 return err;
3270 }
3271 #endif
3272
3273 #ifdef CONFIG_SBUS
3274 static int __init happy_meal_sbus_probe(void)
3275 {
3276 struct sbus_bus *sbus;
3277 struct sbus_dev *sdev;
3278 int cards = 0;
3279 char model[128];
3280
3281 for_each_sbus(sbus) {
3282 for_each_sbusdev(sdev, sbus) {
3283 char *name = sdev->prom_name;
3284
3285 if (!strcmp(name, "SUNW,hme")) {
3286 cards++;
3287 prom_getstring(sdev->prom_node, "model",
3288 model, sizeof(model));
3289 if (!strcmp(model, "SUNW,sbus-qfe"))
3290 happy_meal_sbus_init(sdev, 1);
3291 else
3292 happy_meal_sbus_init(sdev, 0);
3293 } else if (!strcmp(name, "qfe") ||
3294 !strcmp(name, "SUNW,qfe")) {
3295 cards++;
3296 happy_meal_sbus_init(sdev, 1);
3297 }
3298 }
3299 }
3300 if (cards != 0)
3301 quattro_sbus_register_irqs();
3302 return cards;
3303 }
3304 #endif
3305
3306 #ifdef CONFIG_PCI
3307 static int __init happy_meal_pci_probe(void)
3308 {
3309 struct pci_dev *pdev = NULL;
3310 int cards = 0;
3311
3312 while ((pdev = pci_find_device(PCI_VENDOR_ID_SUN,
3313 PCI_DEVICE_ID_SUN_HAPPYMEAL, pdev)) != NULL) {
3314 if (pci_enable_device(pdev))
3315 continue;
3316 pci_set_master(pdev);
3317 cards++;
3318 happy_meal_pci_init(pdev);
3319 }
3320 return cards;
3321 }
3322 #endif
3323
3324 static int __init happy_meal_probe(void)
3325 {
3326 static int called = 0;
3327 int cards;
3328
3329 root_happy_dev = NULL;
3330
3331 if (called)
3332 return -ENODEV;
3333 called++;
3334
3335 cards = 0;
3336 #ifdef CONFIG_SBUS
3337 cards += happy_meal_sbus_probe();
3338 #endif
3339 #ifdef CONFIG_PCI
3340 cards += happy_meal_pci_probe();
3341 #endif
3342 if (!cards)
3343 return -ENODEV;
3344 return 0;
3345 }
3346
3347
3348 static void __exit happy_meal_cleanup_module(void)
3349 {
3350 #ifdef CONFIG_SBUS
3351 struct quattro *last_seen_qfe = NULL;
3352 #endif
3353
3354 while (root_happy_dev) {
3355 struct happy_meal *hp = root_happy_dev;
3356 struct happy_meal *next = root_happy_dev->next_module;
3357 struct net_device *dev = hp->dev;
3358
3359 /* Unregister netdev before unmapping registers as this
3360 * call can end up trying to access those registers.
3361 */
3362 unregister_netdev(dev);
3363
3364 #ifdef CONFIG_SBUS
3365 if (!(hp->happy_flags & HFLAG_PCI)) {
3366 if (hp->happy_flags & HFLAG_QUATTRO) {
3367 if (hp->qfe_parent != last_seen_qfe) {
3368 free_irq(dev->irq, hp->qfe_parent);
3369 last_seen_qfe = hp->qfe_parent;
3370 }
3371 }
3372
3373 sbus_iounmap(hp->gregs, GREG_REG_SIZE);
3374 sbus_iounmap(hp->etxregs, ETX_REG_SIZE);
3375 sbus_iounmap(hp->erxregs, ERX_REG_SIZE);
3376 sbus_iounmap(hp->bigmacregs, BMAC_REG_SIZE);
3377 sbus_iounmap(hp->tcvregs, TCVR_REG_SIZE);
3378 sbus_free_consistent(hp->happy_dev,
3379 PAGE_SIZE,
3380 hp->happy_block,
3381 hp->hblock_dvma);
3382 }
3383 #endif
3384 #ifdef CONFIG_PCI
3385 if ((hp->happy_flags & HFLAG_PCI)) {
3386 pci_free_consistent(hp->happy_dev,
3387 PAGE_SIZE,
3388 hp->happy_block,
3389 hp->hblock_dvma);
3390 iounmap(hp->gregs);
3391 pci_release_regions(hp->happy_dev);
3392 }
3393 #endif
3394 free_netdev(dev);
3395
3396 root_happy_dev = next;
3397 }
3398
3399 /* Now cleanup the quattro lists. */
3400 #ifdef CONFIG_SBUS
3401 while (qfe_sbus_list) {
3402 struct quattro *qfe = qfe_sbus_list;
3403 struct quattro *next = qfe->next;
3404
3405 kfree(qfe);
3406
3407 qfe_sbus_list = next;
3408 }
3409 #endif
3410 #ifdef CONFIG_PCI
3411 while (qfe_pci_list) {
3412 struct quattro *qfe = qfe_pci_list;
3413 struct quattro *next = qfe->next;
3414
3415 kfree(qfe);
3416
3417 qfe_pci_list = next;
3418 }
3419 #endif
3420 }
3421
3422 module_init(happy_meal_probe);
3423 module_exit(happy_meal_cleanup_module);
Linux with added FPC-III support