blob: 1f25263dc7ebb8f90066d7388bbd297bd8d82b26 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
5 *
6 * Driver for SGI's IOC3 based Ethernet cards as found in the PCI card.
7 *
Ralf Baechlebbfb86c2007-07-25 12:31:57 +01008 * Copyright (C) 1999, 2000, 01, 03, 06 Ralf Baechle
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 * Copyright (C) 1995, 1999, 2000, 2001 by Silicon Graphics, Inc.
10 *
11 * References:
12 * o IOC3 ASIC specification 4.51, 1996-04-18
13 * o IEEE 802.3 specification, 2000 edition
14 * o DP38840A Specification, National Semiconductor, March 1997
15 *
16 * To do:
17 *
18 * o Handle allocation failures in ioc3_alloc_skb() more gracefully.
19 * o Handle allocation failures in ioc3_init_rings().
20 * o Use prefetching for large packets. What is a good lower limit for
21 * prefetching?
22 * o We're probably allocating a bit too much memory.
23 * o Use hardware checksums.
24 * o Convert to using a IOC3 meta driver.
25 * o Which PHYs might possibly be attached to the IOC3 in real live,
26 * which workarounds are required for them? Do we ever have Lucent's?
27 * o For the 2.5 branch kill the mii-tool ioctls.
28 */
29
30#define IOC3_NAME "ioc3-eth"
Andy Gospodarekd5b20692006-09-11 17:39:18 -040031#define IOC3_VERSION "2.6.3-4"
Linus Torvalds1da177e2005-04-16 15:20:36 -070032
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/init.h>
34#include <linux/delay.h>
35#include <linux/kernel.h>
36#include <linux/mm.h>
37#include <linux/errno.h>
38#include <linux/module.h>
39#include <linux/pci.h>
40#include <linux/crc32.h>
41#include <linux/mii.h>
42#include <linux/in.h>
43#include <linux/ip.h>
44#include <linux/tcp.h>
45#include <linux/udp.h>
Matthias Gehre910638a2006-03-28 01:56:48 -080046#include <linux/dma-mapping.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
48#ifdef CONFIG_SERIAL_8250
Ralf Baechle15a93802005-11-08 23:10:51 +000049#include <linux/serial_core.h>
50#include <linux/serial_8250.h>
Ralf Baechle0491d1f32007-08-26 18:51:22 +010051#include <linux/serial_reg.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070052#endif
53
54#include <linux/netdevice.h>
55#include <linux/etherdevice.h>
56#include <linux/ethtool.h>
57#include <linux/skbuff.h>
58#include <net/ip.h>
59
60#include <asm/byteorder.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070061#include <asm/io.h>
62#include <asm/pgtable.h>
63#include <asm/uaccess.h>
64#include <asm/sn/types.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070065#include <asm/sn/ioc3.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070066#include <asm/pci/bridge.h>
67
68/*
69 * 64 RX buffers. This is tunable in the range of 16 <= x < 512. The
70 * value must be a power of two.
71 */
72#define RX_BUFFS 64
73
74#define ETCSR_FD ((17<<ETCSR_IPGR2_SHIFT) | (11<<ETCSR_IPGR1_SHIFT) | 21)
75#define ETCSR_HD ((21<<ETCSR_IPGR2_SHIFT) | (21<<ETCSR_IPGR1_SHIFT) | 21)
76
77/* Private per NIC data of the driver. */
78struct ioc3_private {
79 struct ioc3 *regs;
80 unsigned long *rxr; /* pointer to receiver ring */
81 struct ioc3_etxd *txr;
82 struct sk_buff *rx_skbs[512];
83 struct sk_buff *tx_skbs[128];
84 struct net_device_stats stats;
85 int rx_ci; /* RX consumer index */
86 int rx_pi; /* RX producer index */
87 int tx_ci; /* TX consumer index */
88 int tx_pi; /* TX producer index */
89 int txqlen;
90 u32 emcr, ehar_h, ehar_l;
91 spinlock_t ioc3_lock;
92 struct mii_if_info mii;
Ralf Baechlebbfb86c2007-07-25 12:31:57 +010093 unsigned long flags;
94#define IOC3_FLAG_RX_CHECKSUMS 1
95
Linus Torvalds1da177e2005-04-16 15:20:36 -070096 struct pci_dev *pdev;
97
98 /* Members used by autonegotiation */
99 struct timer_list ioc3_timer;
100};
101
102static inline struct net_device *priv_netdev(struct ioc3_private *dev)
103{
104 return (void *)dev - ((sizeof(struct net_device) + 31) & ~31);
105}
106
107static int ioc3_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
108static void ioc3_set_multicast_list(struct net_device *dev);
109static int ioc3_start_xmit(struct sk_buff *skb, struct net_device *dev);
110static void ioc3_timeout(struct net_device *dev);
111static inline unsigned int ioc3_hash(const unsigned char *addr);
112static inline void ioc3_stop(struct ioc3_private *ip);
113static void ioc3_init(struct net_device *dev);
114
115static const char ioc3_str[] = "IOC3 Ethernet";
Jeff Garzik7282d492006-09-13 14:30:00 -0400116static const struct ethtool_ops ioc3_ethtool_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
118/* We use this to acquire receive skb's that we can DMA directly into. */
119
120#define IOC3_CACHELINE 128UL
121
122static inline unsigned long aligned_rx_skb_addr(unsigned long addr)
123{
124 return (~addr + 1) & (IOC3_CACHELINE - 1UL);
125}
126
127static inline struct sk_buff * ioc3_alloc_skb(unsigned long length,
128 unsigned int gfp_mask)
129{
130 struct sk_buff *skb;
131
132 skb = alloc_skb(length + IOC3_CACHELINE - 1, gfp_mask);
133 if (likely(skb)) {
134 int offset = aligned_rx_skb_addr((unsigned long) skb->data);
135 if (offset)
136 skb_reserve(skb, offset);
137 }
138
139 return skb;
140}
141
142static inline unsigned long ioc3_map(void *ptr, unsigned long vdev)
143{
144#ifdef CONFIG_SGI_IP27
Ralf Baechled955d902006-06-17 18:57:39 +0100145 vdev <<= 57; /* Shift to PCI64_ATTR_VIRTUAL */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146
147 return vdev | (0xaUL << PCI64_ATTR_TARG_SHFT) | PCI64_ATTR_PREF |
148 ((unsigned long)ptr & TO_PHYS_MASK);
149#else
150 return virt_to_bus(ptr);
151#endif
152}
153
154/* BEWARE: The IOC3 documentation documents the size of rx buffers as
155 1644 while it's actually 1664. This one was nasty to track down ... */
156#define RX_OFFSET 10
157#define RX_BUF_ALLOC_SIZE (1664 + RX_OFFSET + IOC3_CACHELINE)
158
159/* DMA barrier to separate cached and uncached accesses. */
160#define BARRIER() \
161 __asm__("sync" ::: "memory")
162
163
164#define IOC3_SIZE 0x100000
165
166/*
167 * IOC3 is a big endian device
168 *
169 * Unorthodox but makes the users of these macros more readable - the pointer
170 * to the IOC3's memory mapped registers is expected as struct ioc3 * ioc3
171 * in the environment.
172 */
173#define ioc3_r_mcr() be32_to_cpu(ioc3->mcr)
174#define ioc3_w_mcr(v) do { ioc3->mcr = cpu_to_be32(v); } while (0)
175#define ioc3_w_gpcr_s(v) do { ioc3->gpcr_s = cpu_to_be32(v); } while (0)
176#define ioc3_r_emcr() be32_to_cpu(ioc3->emcr)
177#define ioc3_w_emcr(v) do { ioc3->emcr = cpu_to_be32(v); } while (0)
178#define ioc3_r_eisr() be32_to_cpu(ioc3->eisr)
179#define ioc3_w_eisr(v) do { ioc3->eisr = cpu_to_be32(v); } while (0)
180#define ioc3_r_eier() be32_to_cpu(ioc3->eier)
181#define ioc3_w_eier(v) do { ioc3->eier = cpu_to_be32(v); } while (0)
182#define ioc3_r_ercsr() be32_to_cpu(ioc3->ercsr)
183#define ioc3_w_ercsr(v) do { ioc3->ercsr = cpu_to_be32(v); } while (0)
184#define ioc3_r_erbr_h() be32_to_cpu(ioc3->erbr_h)
185#define ioc3_w_erbr_h(v) do { ioc3->erbr_h = cpu_to_be32(v); } while (0)
186#define ioc3_r_erbr_l() be32_to_cpu(ioc3->erbr_l)
187#define ioc3_w_erbr_l(v) do { ioc3->erbr_l = cpu_to_be32(v); } while (0)
188#define ioc3_r_erbar() be32_to_cpu(ioc3->erbar)
189#define ioc3_w_erbar(v) do { ioc3->erbar = cpu_to_be32(v); } while (0)
190#define ioc3_r_ercir() be32_to_cpu(ioc3->ercir)
191#define ioc3_w_ercir(v) do { ioc3->ercir = cpu_to_be32(v); } while (0)
192#define ioc3_r_erpir() be32_to_cpu(ioc3->erpir)
193#define ioc3_w_erpir(v) do { ioc3->erpir = cpu_to_be32(v); } while (0)
194#define ioc3_r_ertr() be32_to_cpu(ioc3->ertr)
195#define ioc3_w_ertr(v) do { ioc3->ertr = cpu_to_be32(v); } while (0)
196#define ioc3_r_etcsr() be32_to_cpu(ioc3->etcsr)
197#define ioc3_w_etcsr(v) do { ioc3->etcsr = cpu_to_be32(v); } while (0)
198#define ioc3_r_ersr() be32_to_cpu(ioc3->ersr)
199#define ioc3_w_ersr(v) do { ioc3->ersr = cpu_to_be32(v); } while (0)
200#define ioc3_r_etcdc() be32_to_cpu(ioc3->etcdc)
201#define ioc3_w_etcdc(v) do { ioc3->etcdc = cpu_to_be32(v); } while (0)
202#define ioc3_r_ebir() be32_to_cpu(ioc3->ebir)
203#define ioc3_w_ebir(v) do { ioc3->ebir = cpu_to_be32(v); } while (0)
204#define ioc3_r_etbr_h() be32_to_cpu(ioc3->etbr_h)
205#define ioc3_w_etbr_h(v) do { ioc3->etbr_h = cpu_to_be32(v); } while (0)
206#define ioc3_r_etbr_l() be32_to_cpu(ioc3->etbr_l)
207#define ioc3_w_etbr_l(v) do { ioc3->etbr_l = cpu_to_be32(v); } while (0)
208#define ioc3_r_etcir() be32_to_cpu(ioc3->etcir)
209#define ioc3_w_etcir(v) do { ioc3->etcir = cpu_to_be32(v); } while (0)
210#define ioc3_r_etpir() be32_to_cpu(ioc3->etpir)
211#define ioc3_w_etpir(v) do { ioc3->etpir = cpu_to_be32(v); } while (0)
212#define ioc3_r_emar_h() be32_to_cpu(ioc3->emar_h)
213#define ioc3_w_emar_h(v) do { ioc3->emar_h = cpu_to_be32(v); } while (0)
214#define ioc3_r_emar_l() be32_to_cpu(ioc3->emar_l)
215#define ioc3_w_emar_l(v) do { ioc3->emar_l = cpu_to_be32(v); } while (0)
216#define ioc3_r_ehar_h() be32_to_cpu(ioc3->ehar_h)
217#define ioc3_w_ehar_h(v) do { ioc3->ehar_h = cpu_to_be32(v); } while (0)
218#define ioc3_r_ehar_l() be32_to_cpu(ioc3->ehar_l)
219#define ioc3_w_ehar_l(v) do { ioc3->ehar_l = cpu_to_be32(v); } while (0)
220#define ioc3_r_micr() be32_to_cpu(ioc3->micr)
221#define ioc3_w_micr(v) do { ioc3->micr = cpu_to_be32(v); } while (0)
222#define ioc3_r_midr_r() be32_to_cpu(ioc3->midr_r)
223#define ioc3_w_midr_r(v) do { ioc3->midr_r = cpu_to_be32(v); } while (0)
224#define ioc3_r_midr_w() be32_to_cpu(ioc3->midr_w)
225#define ioc3_w_midr_w(v) do { ioc3->midr_w = cpu_to_be32(v); } while (0)
226
227static inline u32 mcr_pack(u32 pulse, u32 sample)
228{
229 return (pulse << 10) | (sample << 2);
230}
231
232static int nic_wait(struct ioc3 *ioc3)
233{
234 u32 mcr;
235
236 do {
237 mcr = ioc3_r_mcr();
238 } while (!(mcr & 2));
239
240 return mcr & 1;
241}
242
243static int nic_reset(struct ioc3 *ioc3)
244{
245 int presence;
246
247 ioc3_w_mcr(mcr_pack(500, 65));
248 presence = nic_wait(ioc3);
249
250 ioc3_w_mcr(mcr_pack(0, 500));
251 nic_wait(ioc3);
252
253 return presence;
254}
255
256static inline int nic_read_bit(struct ioc3 *ioc3)
257{
258 int result;
259
260 ioc3_w_mcr(mcr_pack(6, 13));
261 result = nic_wait(ioc3);
262 ioc3_w_mcr(mcr_pack(0, 100));
263 nic_wait(ioc3);
264
265 return result;
266}
267
268static inline void nic_write_bit(struct ioc3 *ioc3, int bit)
269{
270 if (bit)
271 ioc3_w_mcr(mcr_pack(6, 110));
272 else
273 ioc3_w_mcr(mcr_pack(80, 30));
274
275 nic_wait(ioc3);
276}
277
278/*
279 * Read a byte from an iButton device
280 */
281static u32 nic_read_byte(struct ioc3 *ioc3)
282{
283 u32 result = 0;
284 int i;
285
286 for (i = 0; i < 8; i++)
287 result = (result >> 1) | (nic_read_bit(ioc3) << 7);
288
289 return result;
290}
291
292/*
293 * Write a byte to an iButton device
294 */
295static void nic_write_byte(struct ioc3 *ioc3, int byte)
296{
297 int i, bit;
298
299 for (i = 8; i; i--) {
300 bit = byte & 1;
301 byte >>= 1;
302
303 nic_write_bit(ioc3, bit);
304 }
305}
306
307static u64 nic_find(struct ioc3 *ioc3, int *last)
308{
309 int a, b, index, disc;
310 u64 address = 0;
311
312 nic_reset(ioc3);
313 /* Search ROM. */
314 nic_write_byte(ioc3, 0xf0);
315
316 /* Algorithm from ``Book of iButton Standards''. */
317 for (index = 0, disc = 0; index < 64; index++) {
318 a = nic_read_bit(ioc3);
319 b = nic_read_bit(ioc3);
320
321 if (a && b) {
322 printk("NIC search failed (not fatal).\n");
323 *last = 0;
324 return 0;
325 }
326
327 if (!a && !b) {
328 if (index == *last) {
329 address |= 1UL << index;
330 } else if (index > *last) {
331 address &= ~(1UL << index);
332 disc = index;
333 } else if ((address & (1UL << index)) == 0)
334 disc = index;
335 nic_write_bit(ioc3, address & (1UL << index));
336 continue;
337 } else {
338 if (a)
339 address |= 1UL << index;
340 else
341 address &= ~(1UL << index);
342 nic_write_bit(ioc3, a);
343 continue;
344 }
345 }
346
347 *last = disc;
348
349 return address;
350}
351
352static int nic_init(struct ioc3 *ioc3)
353{
Alan Coxf49343a2007-07-10 17:05:16 +0100354 const char *unknown = "unknown";
355 const char *type = unknown;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356 u8 crc;
357 u8 serial[6];
358 int save = 0, i;
359
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 while (1) {
361 u64 reg;
362 reg = nic_find(ioc3, &save);
363
364 switch (reg & 0xff) {
365 case 0x91:
366 type = "DS1981U";
367 break;
368 default:
369 if (save == 0) {
370 /* Let the caller try again. */
371 return -1;
372 }
373 continue;
374 }
375
376 nic_reset(ioc3);
377
378 /* Match ROM. */
379 nic_write_byte(ioc3, 0x55);
380 for (i = 0; i < 8; i++)
381 nic_write_byte(ioc3, (reg >> (i << 3)) & 0xff);
382
383 reg >>= 8; /* Shift out type. */
384 for (i = 0; i < 6; i++) {
385 serial[i] = reg & 0xff;
386 reg >>= 8;
387 }
388 crc = reg & 0xff;
389 break;
390 }
391
392 printk("Found %s NIC", type);
Alan Coxf49343a2007-07-10 17:05:16 +0100393 if (type != unknown) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394 printk (" registration number %02x:%02x:%02x:%02x:%02x:%02x,"
395 " CRC %02x", serial[0], serial[1], serial[2],
396 serial[3], serial[4], serial[5], crc);
397 }
398 printk(".\n");
399
400 return 0;
401}
402
403/*
404 * Read the NIC (Number-In-a-Can) device used to store the MAC address on
405 * SN0 / SN00 nodeboards and PCI cards.
406 */
407static void ioc3_get_eaddr_nic(struct ioc3_private *ip)
408{
409 struct ioc3 *ioc3 = ip->regs;
410 u8 nic[14];
411 int tries = 2; /* There may be some problem with the battery? */
412 int i;
413
414 ioc3_w_gpcr_s(1 << 21);
415
416 while (tries--) {
417 if (!nic_init(ioc3))
418 break;
419 udelay(500);
420 }
421
422 if (tries < 0) {
423 printk("Failed to read MAC address\n");
424 return;
425 }
426
427 /* Read Memory. */
428 nic_write_byte(ioc3, 0xf0);
429 nic_write_byte(ioc3, 0x00);
430 nic_write_byte(ioc3, 0x00);
431
432 for (i = 13; i >= 0; i--)
433 nic[i] = nic_read_byte(ioc3);
434
435 for (i = 2; i < 8; i++)
436 priv_netdev(ip)->dev_addr[i - 2] = nic[i];
437}
438
439/*
440 * Ok, this is hosed by design. It's necessary to know what machine the
441 * NIC is in in order to know how to read the NIC address. We also have
442 * to know if it's a PCI card or a NIC in on the node board ...
443 */
444static void ioc3_get_eaddr(struct ioc3_private *ip)
445{
Joe Perches0795af52007-10-03 17:59:30 -0700446 DECLARE_MAC_BUF(mac);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447
448 ioc3_get_eaddr_nic(ip);
449
Joe Perches0795af52007-10-03 17:59:30 -0700450 printk("Ethernet address is %s.\n",
451 print_mac(mac, priv_netdev(ip)->dev_addr));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452}
453
454static void __ioc3_set_mac_address(struct net_device *dev)
455{
456 struct ioc3_private *ip = netdev_priv(dev);
457 struct ioc3 *ioc3 = ip->regs;
458
459 ioc3_w_emar_h((dev->dev_addr[5] << 8) | dev->dev_addr[4]);
460 ioc3_w_emar_l((dev->dev_addr[3] << 24) | (dev->dev_addr[2] << 16) |
461 (dev->dev_addr[1] << 8) | dev->dev_addr[0]);
462}
463
464static int ioc3_set_mac_address(struct net_device *dev, void *addr)
465{
466 struct ioc3_private *ip = netdev_priv(dev);
467 struct sockaddr *sa = addr;
468
469 memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
470
471 spin_lock_irq(&ip->ioc3_lock);
472 __ioc3_set_mac_address(dev);
473 spin_unlock_irq(&ip->ioc3_lock);
474
475 return 0;
476}
477
478/*
479 * Caller must hold the ioc3_lock ever for MII readers. This is also
480 * used to protect the transmitter side but it's low contention.
481 */
482static int ioc3_mdio_read(struct net_device *dev, int phy, int reg)
483{
484 struct ioc3_private *ip = netdev_priv(dev);
485 struct ioc3 *ioc3 = ip->regs;
486
487 while (ioc3_r_micr() & MICR_BUSY);
488 ioc3_w_micr((phy << MICR_PHYADDR_SHIFT) | reg | MICR_READTRIG);
489 while (ioc3_r_micr() & MICR_BUSY);
490
Ralf Baechle852ea222005-08-02 11:01:27 +0100491 return ioc3_r_midr_r() & MIDR_DATA_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492}
493
494static void ioc3_mdio_write(struct net_device *dev, int phy, int reg, int data)
495{
496 struct ioc3_private *ip = netdev_priv(dev);
497 struct ioc3 *ioc3 = ip->regs;
498
499 while (ioc3_r_micr() & MICR_BUSY);
500 ioc3_w_midr_w(data);
501 ioc3_w_micr((phy << MICR_PHYADDR_SHIFT) | reg);
502 while (ioc3_r_micr() & MICR_BUSY);
503}
504
505static int ioc3_mii_init(struct ioc3_private *ip);
506
507static struct net_device_stats *ioc3_get_stats(struct net_device *dev)
508{
509 struct ioc3_private *ip = netdev_priv(dev);
510 struct ioc3 *ioc3 = ip->regs;
511
512 ip->stats.collisions += (ioc3_r_etcdc() & ETCDC_COLLCNT_MASK);
513 return &ip->stats;
514}
515
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516static void ioc3_tcpudp_checksum(struct sk_buff *skb, uint32_t hwsum, int len)
517{
518 struct ethhdr *eh = eth_hdr(skb);
519 uint32_t csum, ehsum;
520 unsigned int proto;
521 struct iphdr *ih;
522 uint16_t *ew;
523 unsigned char *cp;
524
525 /*
526 * Did hardware handle the checksum at all? The cases we can handle
527 * are:
528 *
529 * - TCP and UDP checksums of IPv4 only.
530 * - IPv6 would be doable but we keep that for later ...
531 * - Only unfragmented packets. Did somebody already tell you
532 * fragmentation is evil?
533 * - don't care about packet size. Worst case when processing a
534 * malformed packet we'll try to access the packet at ip header +
535 * 64 bytes which is still inside the skb. Even in the unlikely
536 * case where the checksum is right the higher layers will still
537 * drop the packet as appropriate.
538 */
539 if (eh->h_proto != ntohs(ETH_P_IP))
540 return;
541
542 ih = (struct iphdr *) ((char *)eh + ETH_HLEN);
543 if (ih->frag_off & htons(IP_MF | IP_OFFSET))
544 return;
545
546 proto = ih->protocol;
547 if (proto != IPPROTO_TCP && proto != IPPROTO_UDP)
548 return;
549
550 /* Same as tx - compute csum of pseudo header */
551 csum = hwsum +
552 (ih->tot_len - (ih->ihl << 2)) +
553 htons((uint16_t)ih->protocol) +
554 (ih->saddr >> 16) + (ih->saddr & 0xffff) +
555 (ih->daddr >> 16) + (ih->daddr & 0xffff);
556
557 /* Sum up ethernet dest addr, src addr and protocol */
558 ew = (uint16_t *) eh;
559 ehsum = ew[0] + ew[1] + ew[2] + ew[3] + ew[4] + ew[5] + ew[6];
560
561 ehsum = (ehsum & 0xffff) + (ehsum >> 16);
562 ehsum = (ehsum & 0xffff) + (ehsum >> 16);
563
564 csum += 0xffff ^ ehsum;
565
566 /* In the next step we also subtract the 1's complement
567 checksum of the trailing ethernet CRC. */
568 cp = (char *)eh + len; /* points at trailing CRC */
569 if (len & 1) {
570 csum += 0xffff ^ (uint16_t) ((cp[1] << 8) | cp[0]);
571 csum += 0xffff ^ (uint16_t) ((cp[3] << 8) | cp[2]);
572 } else {
573 csum += 0xffff ^ (uint16_t) ((cp[0] << 8) | cp[1]);
574 csum += 0xffff ^ (uint16_t) ((cp[2] << 8) | cp[3]);
575 }
576
577 csum = (csum & 0xffff) + (csum >> 16);
578 csum = (csum & 0xffff) + (csum >> 16);
579
580 if (csum == 0xffff)
581 skb->ip_summed = CHECKSUM_UNNECESSARY;
582}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583
584static inline void ioc3_rx(struct ioc3_private *ip)
585{
586 struct sk_buff *skb, *new_skb;
587 struct ioc3 *ioc3 = ip->regs;
588 int rx_entry, n_entry, len;
589 struct ioc3_erxbuf *rxb;
590 unsigned long *rxr;
591 u32 w0, err;
592
593 rxr = (unsigned long *) ip->rxr; /* Ring base */
594 rx_entry = ip->rx_ci; /* RX consume index */
595 n_entry = ip->rx_pi;
596
597 skb = ip->rx_skbs[rx_entry];
598 rxb = (struct ioc3_erxbuf *) (skb->data - RX_OFFSET);
599 w0 = be32_to_cpu(rxb->w0);
600
601 while (w0 & ERXBUF_V) {
602 err = be32_to_cpu(rxb->err); /* It's valid ... */
603 if (err & ERXBUF_GOODPKT) {
604 len = ((w0 >> ERXBUF_BYTECNT_SHIFT) & 0x7ff) - 4;
605 skb_trim(skb, len);
606 skb->protocol = eth_type_trans(skb, priv_netdev(ip));
607
608 new_skb = ioc3_alloc_skb(RX_BUF_ALLOC_SIZE, GFP_ATOMIC);
609 if (!new_skb) {
610 /* Ouch, drop packet and just recycle packet
611 to keep the ring filled. */
612 ip->stats.rx_dropped++;
613 new_skb = skb;
614 goto next;
615 }
616
Ralf Baechlebbfb86c2007-07-25 12:31:57 +0100617 if (likely(ip->flags & IOC3_FLAG_RX_CHECKSUMS))
618 ioc3_tcpudp_checksum(skb,
619 w0 & ERXBUF_IPCKSUM_MASK, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620
621 netif_rx(skb);
622
623 ip->rx_skbs[rx_entry] = NULL; /* Poison */
624
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 /* Because we reserve afterwards. */
626 skb_put(new_skb, (1664 + RX_OFFSET));
627 rxb = (struct ioc3_erxbuf *) new_skb->data;
628 skb_reserve(new_skb, RX_OFFSET);
629
630 priv_netdev(ip)->last_rx = jiffies;
631 ip->stats.rx_packets++; /* Statistics */
632 ip->stats.rx_bytes += len;
633 } else {
634 /* The frame is invalid and the skb never
635 reached the network layer so we can just
636 recycle it. */
637 new_skb = skb;
638 ip->stats.rx_errors++;
639 }
640 if (err & ERXBUF_CRCERR) /* Statistics */
641 ip->stats.rx_crc_errors++;
642 if (err & ERXBUF_FRAMERR)
643 ip->stats.rx_frame_errors++;
644next:
645 ip->rx_skbs[n_entry] = new_skb;
646 rxr[n_entry] = cpu_to_be64(ioc3_map(rxb, 1));
647 rxb->w0 = 0; /* Clear valid flag */
648 n_entry = (n_entry + 1) & 511; /* Update erpir */
649
650 /* Now go on to the next ring entry. */
651 rx_entry = (rx_entry + 1) & 511;
652 skb = ip->rx_skbs[rx_entry];
653 rxb = (struct ioc3_erxbuf *) (skb->data - RX_OFFSET);
654 w0 = be32_to_cpu(rxb->w0);
655 }
656 ioc3_w_erpir((n_entry << 3) | ERPIR_ARM);
657 ip->rx_pi = n_entry;
658 ip->rx_ci = rx_entry;
659}
660
661static inline void ioc3_tx(struct ioc3_private *ip)
662{
663 unsigned long packets, bytes;
664 struct ioc3 *ioc3 = ip->regs;
665 int tx_entry, o_entry;
666 struct sk_buff *skb;
667 u32 etcir;
668
669 spin_lock(&ip->ioc3_lock);
670 etcir = ioc3_r_etcir();
671
672 tx_entry = (etcir >> 7) & 127;
673 o_entry = ip->tx_ci;
674 packets = 0;
675 bytes = 0;
676
677 while (o_entry != tx_entry) {
678 packets++;
679 skb = ip->tx_skbs[o_entry];
680 bytes += skb->len;
681 dev_kfree_skb_irq(skb);
682 ip->tx_skbs[o_entry] = NULL;
683
684 o_entry = (o_entry + 1) & 127; /* Next */
685
686 etcir = ioc3_r_etcir(); /* More pkts sent? */
687 tx_entry = (etcir >> 7) & 127;
688 }
689
690 ip->stats.tx_packets += packets;
691 ip->stats.tx_bytes += bytes;
692 ip->txqlen -= packets;
693
694 if (ip->txqlen < 128)
695 netif_wake_queue(priv_netdev(ip));
696
697 ip->tx_ci = o_entry;
698 spin_unlock(&ip->ioc3_lock);
699}
700
701/*
702 * Deal with fatal IOC3 errors. This condition might be caused by a hard or
703 * software problems, so we should try to recover
704 * more gracefully if this ever happens. In theory we might be flooded
705 * with such error interrupts if something really goes wrong, so we might
706 * also consider to take the interface down.
707 */
708static void ioc3_error(struct ioc3_private *ip, u32 eisr)
709{
710 struct net_device *dev = priv_netdev(ip);
711 unsigned char *iface = dev->name;
712
713 spin_lock(&ip->ioc3_lock);
714
715 if (eisr & EISR_RXOFLO)
716 printk(KERN_ERR "%s: RX overflow.\n", iface);
717 if (eisr & EISR_RXBUFOFLO)
718 printk(KERN_ERR "%s: RX buffer overflow.\n", iface);
719 if (eisr & EISR_RXMEMERR)
720 printk(KERN_ERR "%s: RX PCI error.\n", iface);
721 if (eisr & EISR_RXPARERR)
722 printk(KERN_ERR "%s: RX SSRAM parity error.\n", iface);
723 if (eisr & EISR_TXBUFUFLO)
724 printk(KERN_ERR "%s: TX buffer underflow.\n", iface);
725 if (eisr & EISR_TXMEMERR)
726 printk(KERN_ERR "%s: TX PCI error.\n", iface);
727
728 ioc3_stop(ip);
729 ioc3_init(dev);
730 ioc3_mii_init(ip);
731
732 netif_wake_queue(dev);
733
734 spin_unlock(&ip->ioc3_lock);
735}
736
737/* The interrupt handler does all of the Rx thread work and cleans up
738 after the Tx thread. */
David Howells7d12e782006-10-05 14:55:46 +0100739static irqreturn_t ioc3_interrupt(int irq, void *_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700740{
741 struct net_device *dev = (struct net_device *)_dev;
742 struct ioc3_private *ip = netdev_priv(dev);
743 struct ioc3 *ioc3 = ip->regs;
744 const u32 enabled = EISR_RXTIMERINT | EISR_RXOFLO | EISR_RXBUFOFLO |
745 EISR_RXMEMERR | EISR_RXPARERR | EISR_TXBUFUFLO |
746 EISR_TXEXPLICIT | EISR_TXMEMERR;
747 u32 eisr;
748
749 eisr = ioc3_r_eisr() & enabled;
750
751 ioc3_w_eisr(eisr);
752 (void) ioc3_r_eisr(); /* Flush */
753
754 if (eisr & (EISR_RXOFLO | EISR_RXBUFOFLO | EISR_RXMEMERR |
755 EISR_RXPARERR | EISR_TXBUFUFLO | EISR_TXMEMERR))
756 ioc3_error(ip, eisr);
757 if (eisr & EISR_RXTIMERINT)
758 ioc3_rx(ip);
759 if (eisr & EISR_TXEXPLICIT)
760 ioc3_tx(ip);
761
762 return IRQ_HANDLED;
763}
764
765static inline void ioc3_setup_duplex(struct ioc3_private *ip)
766{
767 struct ioc3 *ioc3 = ip->regs;
768
769 if (ip->mii.full_duplex) {
770 ioc3_w_etcsr(ETCSR_FD);
771 ip->emcr |= EMCR_DUPLEX;
772 } else {
773 ioc3_w_etcsr(ETCSR_HD);
774 ip->emcr &= ~EMCR_DUPLEX;
775 }
776 ioc3_w_emcr(ip->emcr);
777}
778
779static void ioc3_timer(unsigned long data)
780{
781 struct ioc3_private *ip = (struct ioc3_private *) data;
782
783 /* Print the link status if it has changed */
784 mii_check_media(&ip->mii, 1, 0);
785 ioc3_setup_duplex(ip);
786
787 ip->ioc3_timer.expires = jiffies + ((12 * HZ)/10); /* 1.2s */
788 add_timer(&ip->ioc3_timer);
789}
790
791/*
792 * Try to find a PHY. There is no apparent relation between the MII addresses
793 * in the SGI documentation and what we find in reality, so we simply probe
794 * for the PHY. It seems IOC3 PHYs usually live on address 31. One of my
795 * onboard IOC3s has the special oddity that probing doesn't seem to find it
796 * yet the interface seems to work fine, so if probing fails we for now will
797 * simply default to PHY 31 instead of bailing out.
798 */
799static int ioc3_mii_init(struct ioc3_private *ip)
800{
801 struct net_device *dev = priv_netdev(ip);
802 int i, found = 0, res = 0;
803 int ioc3_phy_workaround = 1;
804 u16 word;
805
806 for (i = 0; i < 32; i++) {
807 word = ioc3_mdio_read(dev, i, MII_PHYSID1);
808
809 if (word != 0xffff && word != 0x0000) {
810 found = 1;
811 break; /* Found a PHY */
812 }
813 }
814
815 if (!found) {
816 if (ioc3_phy_workaround)
817 i = 31;
818 else {
819 ip->mii.phy_id = -1;
820 res = -ENODEV;
821 goto out;
822 }
823 }
824
825 ip->mii.phy_id = i;
Ralf Baechlef0ba7352007-02-17 02:51:15 +0000826
827out:
828 return res;
829}
830
831static void ioc3_mii_start(struct ioc3_private *ip)
832{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833 ip->ioc3_timer.expires = jiffies + (12 * HZ)/10; /* 1.2 sec. */
834 ip->ioc3_timer.data = (unsigned long) ip;
835 ip->ioc3_timer.function = &ioc3_timer;
836 add_timer(&ip->ioc3_timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837}
838
839static inline void ioc3_clean_rx_ring(struct ioc3_private *ip)
840{
841 struct sk_buff *skb;
842 int i;
843
844 for (i = ip->rx_ci; i & 15; i++) {
845 ip->rx_skbs[ip->rx_pi] = ip->rx_skbs[ip->rx_ci];
846 ip->rxr[ip->rx_pi++] = ip->rxr[ip->rx_ci++];
847 }
848 ip->rx_pi &= 511;
849 ip->rx_ci &= 511;
850
851 for (i = ip->rx_ci; i != ip->rx_pi; i = (i+1) & 511) {
852 struct ioc3_erxbuf *rxb;
853 skb = ip->rx_skbs[i];
854 rxb = (struct ioc3_erxbuf *) (skb->data - RX_OFFSET);
855 rxb->w0 = 0;
856 }
857}
858
859static inline void ioc3_clean_tx_ring(struct ioc3_private *ip)
860{
861 struct sk_buff *skb;
862 int i;
863
864 for (i=0; i < 128; i++) {
865 skb = ip->tx_skbs[i];
866 if (skb) {
867 ip->tx_skbs[i] = NULL;
868 dev_kfree_skb_any(skb);
869 }
870 ip->txr[i].cmd = 0;
871 }
872 ip->tx_pi = 0;
873 ip->tx_ci = 0;
874}
875
876static void ioc3_free_rings(struct ioc3_private *ip)
877{
878 struct sk_buff *skb;
879 int rx_entry, n_entry;
880
881 if (ip->txr) {
882 ioc3_clean_tx_ring(ip);
883 free_pages((unsigned long)ip->txr, 2);
884 ip->txr = NULL;
885 }
886
887 if (ip->rxr) {
888 n_entry = ip->rx_ci;
889 rx_entry = ip->rx_pi;
890
891 while (n_entry != rx_entry) {
892 skb = ip->rx_skbs[n_entry];
893 if (skb)
894 dev_kfree_skb_any(skb);
895
896 n_entry = (n_entry + 1) & 511;
897 }
898 free_page((unsigned long)ip->rxr);
899 ip->rxr = NULL;
900 }
901}
902
903static void ioc3_alloc_rings(struct net_device *dev)
904{
905 struct ioc3_private *ip = netdev_priv(dev);
906 struct ioc3_erxbuf *rxb;
907 unsigned long *rxr;
908 int i;
909
910 if (ip->rxr == NULL) {
911 /* Allocate and initialize rx ring. 4kb = 512 entries */
912 ip->rxr = (unsigned long *) get_zeroed_page(GFP_ATOMIC);
913 rxr = (unsigned long *) ip->rxr;
914 if (!rxr)
915 printk("ioc3_alloc_rings(): get_zeroed_page() failed!\n");
916
917 /* Now the rx buffers. The RX ring may be larger but
918 we only allocate 16 buffers for now. Need to tune
919 this for performance and memory later. */
920 for (i = 0; i < RX_BUFFS; i++) {
921 struct sk_buff *skb;
922
923 skb = ioc3_alloc_skb(RX_BUF_ALLOC_SIZE, GFP_ATOMIC);
924 if (!skb) {
925 show_free_areas();
926 continue;
927 }
928
929 ip->rx_skbs[i] = skb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700930
931 /* Because we reserve afterwards. */
932 skb_put(skb, (1664 + RX_OFFSET));
933 rxb = (struct ioc3_erxbuf *) skb->data;
934 rxr[i] = cpu_to_be64(ioc3_map(rxb, 1));
935 skb_reserve(skb, RX_OFFSET);
936 }
937 ip->rx_ci = 0;
938 ip->rx_pi = RX_BUFFS;
939 }
940
941 if (ip->txr == NULL) {
942 /* Allocate and initialize tx rings. 16kb = 128 bufs. */
943 ip->txr = (struct ioc3_etxd *)__get_free_pages(GFP_KERNEL, 2);
944 if (!ip->txr)
945 printk("ioc3_alloc_rings(): __get_free_pages() failed!\n");
946 ip->tx_pi = 0;
947 ip->tx_ci = 0;
948 }
949}
950
951static void ioc3_init_rings(struct net_device *dev)
952{
953 struct ioc3_private *ip = netdev_priv(dev);
954 struct ioc3 *ioc3 = ip->regs;
955 unsigned long ring;
956
957 ioc3_free_rings(ip);
958 ioc3_alloc_rings(dev);
959
960 ioc3_clean_rx_ring(ip);
961 ioc3_clean_tx_ring(ip);
962
963 /* Now the rx ring base, consume & produce registers. */
964 ring = ioc3_map(ip->rxr, 0);
965 ioc3_w_erbr_h(ring >> 32);
966 ioc3_w_erbr_l(ring & 0xffffffff);
967 ioc3_w_ercir(ip->rx_ci << 3);
968 ioc3_w_erpir((ip->rx_pi << 3) | ERPIR_ARM);
969
970 ring = ioc3_map(ip->txr, 0);
971
972 ip->txqlen = 0; /* nothing queued */
973
974 /* Now the tx ring base, consume & produce registers. */
975 ioc3_w_etbr_h(ring >> 32);
976 ioc3_w_etbr_l(ring & 0xffffffff);
977 ioc3_w_etpir(ip->tx_pi << 7);
978 ioc3_w_etcir(ip->tx_ci << 7);
979 (void) ioc3_r_etcir(); /* Flush */
980}
981
982static inline void ioc3_ssram_disc(struct ioc3_private *ip)
983{
984 struct ioc3 *ioc3 = ip->regs;
985 volatile u32 *ssram0 = &ioc3->ssram[0x0000];
986 volatile u32 *ssram1 = &ioc3->ssram[0x4000];
987 unsigned int pattern = 0x5555;
988
989 /* Assume the larger size SSRAM and enable parity checking */
990 ioc3_w_emcr(ioc3_r_emcr() | (EMCR_BUFSIZ | EMCR_RAMPAR));
991
992 *ssram0 = pattern;
993 *ssram1 = ~pattern & IOC3_SSRAM_DM;
994
995 if ((*ssram0 & IOC3_SSRAM_DM) != pattern ||
996 (*ssram1 & IOC3_SSRAM_DM) != (~pattern & IOC3_SSRAM_DM)) {
997 /* set ssram size to 64 KB */
998 ip->emcr = EMCR_RAMPAR;
999 ioc3_w_emcr(ioc3_r_emcr() & ~EMCR_BUFSIZ);
1000 } else
1001 ip->emcr = EMCR_BUFSIZ | EMCR_RAMPAR;
1002}
1003
1004static void ioc3_init(struct net_device *dev)
1005{
1006 struct ioc3_private *ip = netdev_priv(dev);
1007 struct ioc3 *ioc3 = ip->regs;
1008
Ralf Baechlecfadbd22006-10-18 02:15:37 +01001009 del_timer_sync(&ip->ioc3_timer); /* Kill if running */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010
1011 ioc3_w_emcr(EMCR_RST); /* Reset */
1012 (void) ioc3_r_emcr(); /* Flush WB */
1013 udelay(4); /* Give it time ... */
1014 ioc3_w_emcr(0);
1015 (void) ioc3_r_emcr();
1016
1017 /* Misc registers */
1018#ifdef CONFIG_SGI_IP27
1019 ioc3_w_erbar(PCI64_ATTR_BAR >> 32); /* Barrier on last store */
1020#else
1021 ioc3_w_erbar(0); /* Let PCI API get it right */
1022#endif
1023 (void) ioc3_r_etcdc(); /* Clear on read */
1024 ioc3_w_ercsr(15); /* RX low watermark */
1025 ioc3_w_ertr(0); /* Interrupt immediately */
1026 __ioc3_set_mac_address(dev);
1027 ioc3_w_ehar_h(ip->ehar_h);
1028 ioc3_w_ehar_l(ip->ehar_l);
1029 ioc3_w_ersr(42); /* XXX should be random */
1030
1031 ioc3_init_rings(dev);
1032
1033 ip->emcr |= ((RX_OFFSET / 2) << EMCR_RXOFF_SHIFT) | EMCR_TXDMAEN |
1034 EMCR_TXEN | EMCR_RXDMAEN | EMCR_RXEN | EMCR_PADEN;
1035 ioc3_w_emcr(ip->emcr);
1036 ioc3_w_eier(EISR_RXTIMERINT | EISR_RXOFLO | EISR_RXBUFOFLO |
1037 EISR_RXMEMERR | EISR_RXPARERR | EISR_TXBUFUFLO |
1038 EISR_TXEXPLICIT | EISR_TXMEMERR);
1039 (void) ioc3_r_eier();
1040}
1041
1042static inline void ioc3_stop(struct ioc3_private *ip)
1043{
1044 struct ioc3 *ioc3 = ip->regs;
1045
1046 ioc3_w_emcr(0); /* Shutup */
1047 ioc3_w_eier(0); /* Disable interrupts */
1048 (void) ioc3_r_eier(); /* Flush */
1049}
1050
1051static int ioc3_open(struct net_device *dev)
1052{
1053 struct ioc3_private *ip = netdev_priv(dev);
1054
Thomas Gleixner1fb9df52006-07-01 19:29:39 -07001055 if (request_irq(dev->irq, ioc3_interrupt, IRQF_SHARED, ioc3_str, dev)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001056 printk(KERN_ERR "%s: Can't get irq %d\n", dev->name, dev->irq);
1057
1058 return -EAGAIN;
1059 }
1060
1061 ip->ehar_h = 0;
1062 ip->ehar_l = 0;
1063 ioc3_init(dev);
Ralf Baechlef0ba7352007-02-17 02:51:15 +00001064 ioc3_mii_start(ip);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001065
1066 netif_start_queue(dev);
1067 return 0;
1068}
1069
1070static int ioc3_close(struct net_device *dev)
1071{
1072 struct ioc3_private *ip = netdev_priv(dev);
1073
Ralf Baechlecfadbd22006-10-18 02:15:37 +01001074 del_timer_sync(&ip->ioc3_timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075
1076 netif_stop_queue(dev);
1077
1078 ioc3_stop(ip);
1079 free_irq(dev->irq, dev);
1080
1081 ioc3_free_rings(ip);
1082 return 0;
1083}
1084
1085/*
1086 * MENET cards have four IOC3 chips, which are attached to two sets of
1087 * PCI slot resources each: the primary connections are on slots
1088 * 0..3 and the secondaries are on 4..7
1089 *
1090 * All four ethernets are brought out to connectors; six serial ports
1091 * (a pair from each of the first three IOC3s) are brought out to
1092 * MiniDINs; all other subdevices are left swinging in the wind, leave
1093 * them disabled.
1094 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001095
Alan Coxf49343a2007-07-10 17:05:16 +01001096static int ioc3_adjacent_is_ioc3(struct pci_dev *pdev, int slot)
1097{
1098 struct pci_dev *dev = pci_get_slot(pdev->bus, PCI_DEVFN(slot, 0));
1099 int ret = 0;
1100
1101 if (dev) {
1102 if (dev->vendor == PCI_VENDOR_ID_SGI &&
1103 dev->device == PCI_DEVICE_ID_SGI_IOC3)
1104 ret = 1;
1105 pci_dev_put(dev);
1106 }
1107
1108 return ret;
1109}
1110
1111static int ioc3_is_menet(struct pci_dev *pdev)
1112{
1113 return pdev->bus->parent == NULL &&
1114 ioc3_adjacent_is_ioc3(pdev, 0) &&
1115 ioc3_adjacent_is_ioc3(pdev, 1) &&
1116 ioc3_adjacent_is_ioc3(pdev, 2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117}
1118
1119#ifdef CONFIG_SERIAL_8250
1120/*
1121 * Note about serial ports and consoles:
1122 * For console output, everyone uses the IOC3 UARTA (offset 0x178)
1123 * connected to the master node (look in ip27_setup_console() and
1124 * ip27prom_console_write()).
1125 *
1126 * For serial (/dev/ttyS0 etc), we can not have hardcoded serial port
1127 * addresses on a partitioned machine. Since we currently use the ioc3
1128 * serial ports, we use dynamic serial port discovery that the serial.c
1129 * driver uses for pci/pnp ports (there is an entry for the SGI ioc3
1130 * boards in pci_boards[]). Unfortunately, UARTA's pio address is greater
1131 * than UARTB's, although UARTA on o200s has traditionally been known as
1132 * port 0. So, we just use one serial port from each ioc3 (since the
1133 * serial driver adds addresses to get to higher ports).
1134 *
1135 * The first one to do a register_console becomes the preferred console
1136 * (if there is no kernel command line console= directive). /dev/console
1137 * (ie 5, 1) is then "aliased" into the device number returned by the
1138 * "device" routine referred to in this console structure
1139 * (ip27prom_console_dev).
1140 *
1141 * Also look in ip27-pci.c:pci_fixup_ioc3() for some comments on working
1142 * around ioc3 oddities in this respect.
1143 *
Ralf Baechle0491d1f32007-08-26 18:51:22 +01001144 * The IOC3 serials use a 22MHz clock rate with an additional divider which
1145 * can be programmed in the SCR register if the DLAB bit is set.
1146 *
1147 * Register to interrupt zero because we share the interrupt with
1148 * the serial driver which we don't properly support yet.
1149 *
1150 * Can't use UPF_IOREMAP as the whole of IOC3 resources have already been
1151 * registered.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001152 */
Ralf Baechle0491d1f32007-08-26 18:51:22 +01001153static void __devinit ioc3_8250_register(struct ioc3_uartregs __iomem *uart)
1154{
1155#define COSMISC_CONSTANT 6
1156
1157 struct uart_port port = {
1158 .irq = 0,
1159 .flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF,
1160 .iotype = UPIO_MEM,
1161 .regshift = 0,
1162 .uartclk = (22000000 << 1) / COSMISC_CONSTANT,
1163
1164 .membase = (unsigned char __iomem *) uart,
1165 .mapbase = (unsigned long) uart,
1166 };
1167 unsigned char lcr;
1168
1169 lcr = uart->iu_lcr;
1170 uart->iu_lcr = lcr | UART_LCR_DLAB;
1171 uart->iu_scr = COSMISC_CONSTANT,
1172 uart->iu_lcr = lcr;
1173 uart->iu_lcr;
1174 serial8250_register_port(&port);
1175}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001176
1177static void __devinit ioc3_serial_probe(struct pci_dev *pdev, struct ioc3 *ioc3)
1178{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001179 /*
1180 * We need to recognice and treat the fourth MENET serial as it
1181 * does not have an SuperIO chip attached to it, therefore attempting
1182 * to access it will result in bus errors. We call something an
1183 * MENET if PCI slot 0, 1, 2 and 3 of a master PCI bus all have an IOC3
1184 * in it. This is paranoid but we want to avoid blowing up on a
1185 * showhorn PCI box that happens to have 4 IOC3 cards in it so it's
1186 * not paranoid enough ...
1187 */
1188 if (ioc3_is_menet(pdev) && PCI_SLOT(pdev->devfn) == 3)
1189 return;
1190
Ralf Baechle15a93802005-11-08 23:10:51 +00001191 /*
Ralf Baechle0491d1f32007-08-26 18:51:22 +01001192 * Switch IOC3 to PIO mode. It probably already was but let's be
1193 * paranoid
Ralf Baechle15a93802005-11-08 23:10:51 +00001194 */
Ralf Baechle0491d1f32007-08-26 18:51:22 +01001195 ioc3->gpcr_s = GPCR_UARTA_MODESEL | GPCR_UARTB_MODESEL;
1196 ioc3->gpcr_s;
1197 ioc3->gppr_6 = 0;
1198 ioc3->gppr_6;
1199 ioc3->gppr_7 = 0;
1200 ioc3->gppr_7;
1201 ioc3->sscr_a = ioc3->sscr_a & ~SSCR_DMA_EN;
1202 ioc3->sscr_a;
1203 ioc3->sscr_b = ioc3->sscr_b & ~SSCR_DMA_EN;
1204 ioc3->sscr_b;
1205 /* Disable all SA/B interrupts except for SA/B_INT in SIO_IEC. */
1206 ioc3->sio_iec &= ~ (SIO_IR_SA_TX_MT | SIO_IR_SA_RX_FULL |
1207 SIO_IR_SA_RX_HIGH | SIO_IR_SA_RX_TIMER |
1208 SIO_IR_SA_DELTA_DCD | SIO_IR_SA_DELTA_CTS |
1209 SIO_IR_SA_TX_EXPLICIT | SIO_IR_SA_MEMERR);
1210 ioc3->sio_iec |= SIO_IR_SA_INT;
1211 ioc3->sscr_a = 0;
1212 ioc3->sio_iec &= ~ (SIO_IR_SB_TX_MT | SIO_IR_SB_RX_FULL |
1213 SIO_IR_SB_RX_HIGH | SIO_IR_SB_RX_TIMER |
1214 SIO_IR_SB_DELTA_DCD | SIO_IR_SB_DELTA_CTS |
1215 SIO_IR_SB_TX_EXPLICIT | SIO_IR_SB_MEMERR);
1216 ioc3->sio_iec |= SIO_IR_SB_INT;
1217 ioc3->sscr_b = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218
Ralf Baechle0491d1f32007-08-26 18:51:22 +01001219 ioc3_8250_register(&ioc3->sregs.uarta);
1220 ioc3_8250_register(&ioc3->sregs.uartb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001221}
1222#endif
1223
Ralf Baechle725e49c2008-03-08 16:58:33 +00001224static int __devinit ioc3_probe(struct pci_dev *pdev,
1225 const struct pci_device_id *ent)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001226{
1227 unsigned int sw_physid1, sw_physid2;
1228 struct net_device *dev = NULL;
1229 struct ioc3_private *ip;
1230 struct ioc3 *ioc3;
1231 unsigned long ioc3_base, ioc3_size;
1232 u32 vendor, model, rev;
1233 int err, pci_using_dac;
1234
1235 /* Configure DMA attributes. */
Matthias Gehre910638a2006-03-28 01:56:48 -08001236 err = pci_set_dma_mask(pdev, DMA_64BIT_MASK);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001237 if (!err) {
1238 pci_using_dac = 1;
Matthias Gehre910638a2006-03-28 01:56:48 -08001239 err = pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240 if (err < 0) {
1241 printk(KERN_ERR "%s: Unable to obtain 64 bit DMA "
1242 "for consistent allocations\n", pci_name(pdev));
1243 goto out;
1244 }
1245 } else {
Matthias Gehre910638a2006-03-28 01:56:48 -08001246 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247 if (err) {
1248 printk(KERN_ERR "%s: No usable DMA configuration, "
1249 "aborting.\n", pci_name(pdev));
1250 goto out;
1251 }
1252 pci_using_dac = 0;
1253 }
1254
1255 if (pci_enable_device(pdev))
1256 return -ENODEV;
1257
1258 dev = alloc_etherdev(sizeof(struct ioc3_private));
1259 if (!dev) {
1260 err = -ENOMEM;
1261 goto out_disable;
1262 }
1263
1264 if (pci_using_dac)
1265 dev->features |= NETIF_F_HIGHDMA;
1266
1267 err = pci_request_regions(pdev, "ioc3");
1268 if (err)
1269 goto out_free;
1270
Linus Torvalds1da177e2005-04-16 15:20:36 -07001271 SET_NETDEV_DEV(dev, &pdev->dev);
1272
1273 ip = netdev_priv(dev);
1274
1275 dev->irq = pdev->irq;
1276
1277 ioc3_base = pci_resource_start(pdev, 0);
1278 ioc3_size = pci_resource_len(pdev, 0);
1279 ioc3 = (struct ioc3 *) ioremap(ioc3_base, ioc3_size);
1280 if (!ioc3) {
1281 printk(KERN_CRIT "ioc3eth(%s): ioremap failed, goodbye.\n",
1282 pci_name(pdev));
1283 err = -ENOMEM;
1284 goto out_res;
1285 }
1286 ip->regs = ioc3;
1287
1288#ifdef CONFIG_SERIAL_8250
1289 ioc3_serial_probe(pdev, ioc3);
1290#endif
1291
1292 spin_lock_init(&ip->ioc3_lock);
1293 init_timer(&ip->ioc3_timer);
1294
1295 ioc3_stop(ip);
1296 ioc3_init(dev);
1297
1298 ip->pdev = pdev;
1299
1300 ip->mii.phy_id_mask = 0x1f;
1301 ip->mii.reg_num_mask = 0x1f;
1302 ip->mii.dev = dev;
1303 ip->mii.mdio_read = ioc3_mdio_read;
1304 ip->mii.mdio_write = ioc3_mdio_write;
1305
1306 ioc3_mii_init(ip);
1307
1308 if (ip->mii.phy_id == -1) {
1309 printk(KERN_CRIT "ioc3-eth(%s): Didn't find a PHY, goodbye.\n",
1310 pci_name(pdev));
1311 err = -ENODEV;
1312 goto out_stop;
1313 }
1314
Ralf Baechlef0ba7352007-02-17 02:51:15 +00001315 ioc3_mii_start(ip);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001316 ioc3_ssram_disc(ip);
1317 ioc3_get_eaddr(ip);
1318
1319 /* The IOC3-specific entries in the device structure. */
1320 dev->open = ioc3_open;
1321 dev->hard_start_xmit = ioc3_start_xmit;
1322 dev->tx_timeout = ioc3_timeout;
1323 dev->watchdog_timeo = 5 * HZ;
1324 dev->stop = ioc3_close;
1325 dev->get_stats = ioc3_get_stats;
1326 dev->do_ioctl = ioc3_ioctl;
1327 dev->set_multicast_list = ioc3_set_multicast_list;
1328 dev->set_mac_address = ioc3_set_mac_address;
1329 dev->ethtool_ops = &ioc3_ethtool_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330 dev->features = NETIF_F_IP_CSUM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 sw_physid1 = ioc3_mdio_read(dev, ip->mii.phy_id, MII_PHYSID1);
1333 sw_physid2 = ioc3_mdio_read(dev, ip->mii.phy_id, MII_PHYSID2);
1334
1335 err = register_netdev(dev);
1336 if (err)
1337 goto out_stop;
1338
1339 mii_check_media(&ip->mii, 1, 1);
Ralf Baechle852ea222005-08-02 11:01:27 +01001340 ioc3_setup_duplex(ip);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001341
1342 vendor = (sw_physid1 << 12) | (sw_physid2 >> 4);
1343 model = (sw_physid2 >> 4) & 0x3f;
1344 rev = sw_physid2 & 0xf;
1345 printk(KERN_INFO "%s: Using PHY %d, vendor 0x%x, model %d, "
1346 "rev %d.\n", dev->name, ip->mii.phy_id, vendor, model, rev);
1347 printk(KERN_INFO "%s: IOC3 SSRAM has %d kbyte.\n", dev->name,
1348 ip->emcr & EMCR_BUFSIZ ? 128 : 64);
1349
1350 return 0;
1351
1352out_stop:
1353 ioc3_stop(ip);
Ralf Baechlef0ba7352007-02-17 02:51:15 +00001354 del_timer_sync(&ip->ioc3_timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355 ioc3_free_rings(ip);
1356out_res:
1357 pci_release_regions(pdev);
1358out_free:
1359 free_netdev(dev);
1360out_disable:
1361 /*
1362 * We should call pci_disable_device(pdev); here if the IOC3 wasn't
1363 * such a weird device ...
1364 */
1365out:
1366 return err;
1367}
1368
1369static void __devexit ioc3_remove_one (struct pci_dev *pdev)
1370{
1371 struct net_device *dev = pci_get_drvdata(pdev);
1372 struct ioc3_private *ip = netdev_priv(dev);
1373 struct ioc3 *ioc3 = ip->regs;
1374
1375 unregister_netdev(dev);
Ralf Baechlef0ba7352007-02-17 02:51:15 +00001376 del_timer_sync(&ip->ioc3_timer);
1377
Linus Torvalds1da177e2005-04-16 15:20:36 -07001378 iounmap(ioc3);
1379 pci_release_regions(pdev);
1380 free_netdev(dev);
1381 /*
1382 * We should call pci_disable_device(pdev); here if the IOC3 wasn't
1383 * such a weird device ...
1384 */
1385}
1386
1387static struct pci_device_id ioc3_pci_tbl[] = {
1388 { PCI_VENDOR_ID_SGI, PCI_DEVICE_ID_SGI_IOC3, PCI_ANY_ID, PCI_ANY_ID },
1389 { 0 }
1390};
1391MODULE_DEVICE_TABLE(pci, ioc3_pci_tbl);
1392
1393static struct pci_driver ioc3_driver = {
1394 .name = "ioc3-eth",
1395 .id_table = ioc3_pci_tbl,
1396 .probe = ioc3_probe,
1397 .remove = __devexit_p(ioc3_remove_one),
1398};
1399
1400static int __init ioc3_init_module(void)
1401{
Ralf Baechle70f1e002005-11-13 10:13:05 +00001402 return pci_register_driver(&ioc3_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001403}
1404
1405static void __exit ioc3_cleanup_module(void)
1406{
1407 pci_unregister_driver(&ioc3_driver);
1408}
1409
1410static int ioc3_start_xmit(struct sk_buff *skb, struct net_device *dev)
1411{
1412 unsigned long data;
1413 struct ioc3_private *ip = netdev_priv(dev);
1414 struct ioc3 *ioc3 = ip->regs;
1415 unsigned int len;
1416 struct ioc3_etxd *desc;
1417 uint32_t w0 = 0;
1418 int produce;
1419
Linus Torvalds1da177e2005-04-16 15:20:36 -07001420 /*
1421 * IOC3 has a fairly simple minded checksumming hardware which simply
1422 * adds up the 1's complement checksum for the entire packet and
1423 * inserts it at an offset which can be specified in the descriptor
1424 * into the transmit packet. This means we have to compensate for the
1425 * MAC header which should not be summed and the TCP/UDP pseudo headers
1426 * manually.
1427 */
Patrick McHardy84fa7932006-08-29 16:44:56 -07001428 if (skb->ip_summed == CHECKSUM_PARTIAL) {
Arnaldo Carvalho de Meloeddc9ec2007-04-20 22:47:35 -07001429 const struct iphdr *ih = ip_hdr(skb);
1430 const int proto = ntohs(ih->protocol);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431 unsigned int csoff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001432 uint32_t csum, ehsum;
1433 uint16_t *eh;
1434
1435 /* The MAC header. skb->mac seem the logic approach
1436 to find the MAC header - except it's a NULL pointer ... */
1437 eh = (uint16_t *) skb->data;
1438
1439 /* Sum up dest addr, src addr and protocol */
1440 ehsum = eh[0] + eh[1] + eh[2] + eh[3] + eh[4] + eh[5] + eh[6];
1441
1442 /* Fold ehsum. can't use csum_fold which negates also ... */
1443 ehsum = (ehsum & 0xffff) + (ehsum >> 16);
1444 ehsum = (ehsum & 0xffff) + (ehsum >> 16);
1445
1446 /* Skip IP header; it's sum is always zero and was
1447 already filled in by ip_output.c */
1448 csum = csum_tcpudp_nofold(ih->saddr, ih->daddr,
1449 ih->tot_len - (ih->ihl << 2),
1450 proto, 0xffff ^ ehsum);
1451
1452 csum = (csum & 0xffff) + (csum >> 16); /* Fold again */
1453 csum = (csum & 0xffff) + (csum >> 16);
1454
1455 csoff = ETH_HLEN + (ih->ihl << 2);
1456 if (proto == IPPROTO_UDP) {
1457 csoff += offsetof(struct udphdr, check);
Arnaldo Carvalho de Melo4bedb452007-03-13 14:28:48 -03001458 udp_hdr(skb)->check = csum;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001459 }
1460 if (proto == IPPROTO_TCP) {
1461 csoff += offsetof(struct tcphdr, check);
Arnaldo Carvalho de Meloaa8223c2007-04-10 21:04:22 -07001462 tcp_hdr(skb)->check = csum;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001463 }
1464
1465 w0 = ETXD_DOCHECKSUM | (csoff << ETXD_CHKOFF_SHIFT);
1466 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001467
1468 spin_lock_irq(&ip->ioc3_lock);
1469
1470 data = (unsigned long) skb->data;
1471 len = skb->len;
1472
1473 produce = ip->tx_pi;
1474 desc = &ip->txr[produce];
1475
1476 if (len <= 104) {
1477 /* Short packet, let's copy it directly into the ring. */
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -03001478 skb_copy_from_linear_data(skb, desc->data, skb->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001479 if (len < ETH_ZLEN) {
1480 /* Very short packet, pad with zeros at the end. */
1481 memset(desc->data + len, 0, ETH_ZLEN - len);
1482 len = ETH_ZLEN;
1483 }
1484 desc->cmd = cpu_to_be32(len | ETXD_INTWHENDONE | ETXD_D0V | w0);
1485 desc->bufcnt = cpu_to_be32(len);
1486 } else if ((data ^ (data + len - 1)) & 0x4000) {
1487 unsigned long b2 = (data | 0x3fffUL) + 1UL;
1488 unsigned long s1 = b2 - data;
1489 unsigned long s2 = data + len - b2;
1490
1491 desc->cmd = cpu_to_be32(len | ETXD_INTWHENDONE |
1492 ETXD_B1V | ETXD_B2V | w0);
1493 desc->bufcnt = cpu_to_be32((s1 << ETXD_B1CNT_SHIFT) |
1494 (s2 << ETXD_B2CNT_SHIFT));
1495 desc->p1 = cpu_to_be64(ioc3_map(skb->data, 1));
1496 desc->p2 = cpu_to_be64(ioc3_map((void *) b2, 1));
1497 } else {
1498 /* Normal sized packet that doesn't cross a page boundary. */
1499 desc->cmd = cpu_to_be32(len | ETXD_INTWHENDONE | ETXD_B1V | w0);
1500 desc->bufcnt = cpu_to_be32(len << ETXD_B1CNT_SHIFT);
1501 desc->p1 = cpu_to_be64(ioc3_map(skb->data, 1));
1502 }
1503
1504 BARRIER();
1505
1506 dev->trans_start = jiffies;
1507 ip->tx_skbs[produce] = skb; /* Remember skb */
1508 produce = (produce + 1) & 127;
1509 ip->tx_pi = produce;
1510 ioc3_w_etpir(produce << 7); /* Fire ... */
1511
1512 ip->txqlen++;
1513
1514 if (ip->txqlen >= 127)
1515 netif_stop_queue(dev);
1516
1517 spin_unlock_irq(&ip->ioc3_lock);
1518
1519 return 0;
1520}
1521
1522static void ioc3_timeout(struct net_device *dev)
1523{
1524 struct ioc3_private *ip = netdev_priv(dev);
1525
1526 printk(KERN_ERR "%s: transmit timed out, resetting\n", dev->name);
1527
1528 spin_lock_irq(&ip->ioc3_lock);
1529
1530 ioc3_stop(ip);
1531 ioc3_init(dev);
1532 ioc3_mii_init(ip);
Ralf Baechlef0ba7352007-02-17 02:51:15 +00001533 ioc3_mii_start(ip);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001534
1535 spin_unlock_irq(&ip->ioc3_lock);
1536
1537 netif_wake_queue(dev);
1538}
1539
1540/*
1541 * Given a multicast ethernet address, this routine calculates the
1542 * address's bit index in the logical address filter mask
1543 */
1544
1545static inline unsigned int ioc3_hash(const unsigned char *addr)
1546{
1547 unsigned int temp = 0;
1548 u32 crc;
1549 int bits;
1550
1551 crc = ether_crc_le(ETH_ALEN, addr);
1552
1553 crc &= 0x3f; /* bit reverse lowest 6 bits for hash index */
1554 for (bits = 6; --bits >= 0; ) {
1555 temp <<= 1;
1556 temp |= (crc & 0x1);
1557 crc >>= 1;
1558 }
1559
1560 return temp;
1561}
1562
1563static void ioc3_get_drvinfo (struct net_device *dev,
1564 struct ethtool_drvinfo *info)
1565{
1566 struct ioc3_private *ip = netdev_priv(dev);
Ralf Baechle852ea222005-08-02 11:01:27 +01001567
Linus Torvalds1da177e2005-04-16 15:20:36 -07001568 strcpy (info->driver, IOC3_NAME);
1569 strcpy (info->version, IOC3_VERSION);
1570 strcpy (info->bus_info, pci_name(ip->pdev));
1571}
1572
1573static int ioc3_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1574{
1575 struct ioc3_private *ip = netdev_priv(dev);
1576 int rc;
1577
1578 spin_lock_irq(&ip->ioc3_lock);
1579 rc = mii_ethtool_gset(&ip->mii, cmd);
1580 spin_unlock_irq(&ip->ioc3_lock);
1581
1582 return rc;
1583}
1584
1585static int ioc3_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1586{
1587 struct ioc3_private *ip = netdev_priv(dev);
1588 int rc;
1589
1590 spin_lock_irq(&ip->ioc3_lock);
1591 rc = mii_ethtool_sset(&ip->mii, cmd);
1592 spin_unlock_irq(&ip->ioc3_lock);
Ralf Baechle852ea222005-08-02 11:01:27 +01001593
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594 return rc;
1595}
1596
1597static int ioc3_nway_reset(struct net_device *dev)
1598{
1599 struct ioc3_private *ip = netdev_priv(dev);
1600 int rc;
1601
1602 spin_lock_irq(&ip->ioc3_lock);
1603 rc = mii_nway_restart(&ip->mii);
1604 spin_unlock_irq(&ip->ioc3_lock);
1605
1606 return rc;
1607}
1608
1609static u32 ioc3_get_link(struct net_device *dev)
1610{
1611 struct ioc3_private *ip = netdev_priv(dev);
1612 int rc;
1613
1614 spin_lock_irq(&ip->ioc3_lock);
1615 rc = mii_link_ok(&ip->mii);
1616 spin_unlock_irq(&ip->ioc3_lock);
1617
1618 return rc;
1619}
1620
Ralf Baechlebbfb86c2007-07-25 12:31:57 +01001621static u32 ioc3_get_rx_csum(struct net_device *dev)
1622{
1623 struct ioc3_private *ip = netdev_priv(dev);
1624
1625 return ip->flags & IOC3_FLAG_RX_CHECKSUMS;
1626}
1627
1628static int ioc3_set_rx_csum(struct net_device *dev, u32 data)
1629{
1630 struct ioc3_private *ip = netdev_priv(dev);
1631
1632 spin_lock_bh(&ip->ioc3_lock);
1633 if (data)
1634 ip->flags |= IOC3_FLAG_RX_CHECKSUMS;
1635 else
1636 ip->flags &= ~IOC3_FLAG_RX_CHECKSUMS;
1637 spin_unlock_bh(&ip->ioc3_lock);
1638
1639 return 0;
1640}
1641
Jeff Garzik7282d492006-09-13 14:30:00 -04001642static const struct ethtool_ops ioc3_ethtool_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001643 .get_drvinfo = ioc3_get_drvinfo,
1644 .get_settings = ioc3_get_settings,
1645 .set_settings = ioc3_set_settings,
1646 .nway_reset = ioc3_nway_reset,
1647 .get_link = ioc3_get_link,
Ralf Baechlebbfb86c2007-07-25 12:31:57 +01001648 .get_rx_csum = ioc3_get_rx_csum,
1649 .set_rx_csum = ioc3_set_rx_csum,
1650 .get_tx_csum = ethtool_op_get_tx_csum,
1651 .set_tx_csum = ethtool_op_set_tx_csum
Linus Torvalds1da177e2005-04-16 15:20:36 -07001652};
1653
1654static int ioc3_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1655{
1656 struct ioc3_private *ip = netdev_priv(dev);
1657 int rc;
1658
1659 spin_lock_irq(&ip->ioc3_lock);
1660 rc = generic_mii_ioctl(&ip->mii, if_mii(rq), cmd, NULL);
1661 spin_unlock_irq(&ip->ioc3_lock);
1662
1663 return rc;
1664}
1665
1666static void ioc3_set_multicast_list(struct net_device *dev)
1667{
1668 struct dev_mc_list *dmi = dev->mc_list;
1669 struct ioc3_private *ip = netdev_priv(dev);
1670 struct ioc3 *ioc3 = ip->regs;
1671 u64 ehar = 0;
1672 int i;
1673
1674 netif_stop_queue(dev); /* Lock out others. */
1675
1676 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001677 ip->emcr |= EMCR_PROMISC;
1678 ioc3_w_emcr(ip->emcr);
1679 (void) ioc3_r_emcr();
1680 } else {
1681 ip->emcr &= ~EMCR_PROMISC;
1682 ioc3_w_emcr(ip->emcr); /* Clear promiscuous. */
1683 (void) ioc3_r_emcr();
1684
1685 if ((dev->flags & IFF_ALLMULTI) || (dev->mc_count > 64)) {
1686 /* Too many for hashing to make sense or we want all
1687 multicast packets anyway, so skip computing all the
1688 hashes and just accept all packets. */
1689 ip->ehar_h = 0xffffffff;
1690 ip->ehar_l = 0xffffffff;
1691 } else {
1692 for (i = 0; i < dev->mc_count; i++) {
1693 char *addr = dmi->dmi_addr;
1694 dmi = dmi->next;
1695
1696 if (!(*addr & 1))
1697 continue;
1698
1699 ehar |= (1UL << ioc3_hash(addr));
1700 }
1701 ip->ehar_h = ehar >> 32;
1702 ip->ehar_l = ehar & 0xffffffff;
1703 }
1704 ioc3_w_ehar_h(ip->ehar_h);
1705 ioc3_w_ehar_l(ip->ehar_l);
1706 }
1707
1708 netif_wake_queue(dev); /* Let us get going again. */
1709}
1710
1711MODULE_AUTHOR("Ralf Baechle <ralf@linux-mips.org>");
1712MODULE_DESCRIPTION("SGI IOC3 Ethernet driver");
1713MODULE_LICENSE("GPL");
1714
1715module_init(ioc3_init_module);
1716module_exit(ioc3_cleanup_module);