SAA9730: Handle multicast frames.
[linux-2.6] / drivers / net / saa9730.c
1 /*
2  * Copyright (C) 2000, 2005  MIPS Technologies, Inc.  All rights reserved.
3  *      Authors: Carsten Langgaard <carstenl@mips.com>
4  *               Maciej W. Rozycki <macro@mips.com>
5  * Copyright (C) 2004 Ralf Baechle <ralf@linux-mips.org>
6  *
7  *  This program is free software; you can distribute it and/or modify it
8  *  under the terms of the GNU General Public License (Version 2) as
9  *  published by the Free Software Foundation.
10  *
11  *  This program is distributed in the hope it will be useful, but WITHOUT
12  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
14  *  for more details.
15  *
16  *  You should have received a copy of the GNU General Public License along
17  *  with this program; if not, write to the Free Software Foundation, Inc.,
18  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
19  *
20  * SAA9730 ethernet driver.
21  *
22  * Changes:
23  * Angelo Dell'Aera <buffer@antifork.org> :     Conversion to the new PCI API
24  *                                              (pci_driver).
25  *                                              Conversion to spinlocks.
26  *                                              Error handling fixes.
27  */
28
29 #include <linux/init.h>
30 #include <linux/netdevice.h>
31 #include <linux/delay.h>
32 #include <linux/etherdevice.h>
33 #include <linux/module.h>
34 #include <linux/skbuff.h>
35 #include <linux/pci.h>
36 #include <linux/spinlock.h>
37 #include <linux/types.h>
38
39 #include <asm/addrspace.h>
40 #include <asm/io.h>
41
42 #include <asm/mips-boards/prom.h>
43
44 #include "saa9730.h"
45
46 #ifdef LAN_SAA9730_DEBUG
47 int lan_saa9730_debug = LAN_SAA9730_DEBUG;
48 #else
49 int lan_saa9730_debug;
50 #endif
51
52 #define DRV_MODULE_NAME "saa9730"
53
54 static struct pci_device_id saa9730_pci_tbl[] = {
55         { PCI_VENDOR_ID_PHILIPS, PCI_DEVICE_ID_PHILIPS_SAA9730,
56           PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL },
57         { 0, }
58 };
59
60 MODULE_DEVICE_TABLE(pci, saa9730_pci_tbl);
61
62 /* Non-zero only if the current card is a PCI with BIOS-set IRQ. */
63 static unsigned int pci_irq_line;
64
65 static void evm_saa9730_enable_lan_int(struct lan_saa9730_private *lp)
66 {
67         writel(readl(&lp->evm_saa9730_regs->InterruptBlock1) | EVM_LAN_INT,
68                &lp->evm_saa9730_regs->InterruptBlock1);
69         writel(readl(&lp->evm_saa9730_regs->InterruptStatus1) | EVM_LAN_INT,
70                &lp->evm_saa9730_regs->InterruptStatus1);
71         writel(readl(&lp->evm_saa9730_regs->InterruptEnable1) | EVM_LAN_INT |
72                EVM_MASTER_EN, &lp->evm_saa9730_regs->InterruptEnable1);
73 }
74
75 static void evm_saa9730_disable_lan_int(struct lan_saa9730_private *lp)
76 {
77         writel(readl(&lp->evm_saa9730_regs->InterruptBlock1) & ~EVM_LAN_INT,
78                &lp->evm_saa9730_regs->InterruptBlock1);
79         writel(readl(&lp->evm_saa9730_regs->InterruptEnable1) & ~EVM_LAN_INT,
80                &lp->evm_saa9730_regs->InterruptEnable1);
81 }
82
83 static void evm_saa9730_clear_lan_int(struct lan_saa9730_private *lp)
84 {
85         writel(EVM_LAN_INT, &lp->evm_saa9730_regs->InterruptStatus1);
86 }
87
88 static void evm_saa9730_block_lan_int(struct lan_saa9730_private *lp)
89 {
90         writel(readl(&lp->evm_saa9730_regs->InterruptBlock1) & ~EVM_LAN_INT,
91                &lp->evm_saa9730_regs->InterruptBlock1);
92 }
93
94 static void evm_saa9730_unblock_lan_int(struct lan_saa9730_private *lp)
95 {
96         writel(readl(&lp->evm_saa9730_regs->InterruptBlock1) | EVM_LAN_INT,
97                &lp->evm_saa9730_regs->InterruptBlock1);
98 }
99
100 static void __attribute_used__ show_saa9730_regs(struct lan_saa9730_private *lp)
101 {
102         int i, j;
103         printk("TxmBufferA = %p\n", lp->TxmBuffer[0][0]);
104         printk("TxmBufferB = %p\n", lp->TxmBuffer[1][0]);
105         printk("RcvBufferA = %p\n", lp->RcvBuffer[0][0]);
106         printk("RcvBufferB = %p\n", lp->RcvBuffer[1][0]);
107         for (i = 0; i < LAN_SAA9730_BUFFERS; i++) {
108                 for (j = 0; j < LAN_SAA9730_TXM_Q_SIZE; j++) {
109                         printk("TxmBuffer[%d][%d] = %x\n", i, j,
110                                le32_to_cpu(*(unsigned int *)
111                                            lp->TxmBuffer[i][j]));
112                 }
113         }
114         for (i = 0; i < LAN_SAA9730_BUFFERS; i++) {
115                 for (j = 0; j < LAN_SAA9730_RCV_Q_SIZE; j++) {
116                         printk("RcvBuffer[%d][%d] = %x\n", i, j,
117                                le32_to_cpu(*(unsigned int *)
118                                            lp->RcvBuffer[i][j]));
119                 }
120         }
121         printk("lp->evm_saa9730_regs->InterruptBlock1 = %x\n",
122                readl(&lp->evm_saa9730_regs->InterruptBlock1));
123         printk("lp->evm_saa9730_regs->InterruptStatus1 = %x\n",
124                readl(&lp->evm_saa9730_regs->InterruptStatus1));
125         printk("lp->evm_saa9730_regs->InterruptEnable1 = %x\n",
126                readl(&lp->evm_saa9730_regs->InterruptEnable1));
127         printk("lp->lan_saa9730_regs->Ok2Use = %x\n",
128                readl(&lp->lan_saa9730_regs->Ok2Use));
129         printk("lp->NextTxmBufferIndex = %x\n", lp->NextTxmBufferIndex);
130         printk("lp->NextTxmPacketIndex = %x\n", lp->NextTxmPacketIndex);
131         printk("lp->PendingTxmBufferIndex = %x\n",
132                lp->PendingTxmBufferIndex);
133         printk("lp->PendingTxmPacketIndex = %x\n",
134                lp->PendingTxmPacketIndex);
135         printk("lp->lan_saa9730_regs->LanDmaCtl = %x\n",
136                readl(&lp->lan_saa9730_regs->LanDmaCtl));
137         printk("lp->lan_saa9730_regs->DmaStatus = %x\n",
138                readl(&lp->lan_saa9730_regs->DmaStatus));
139         printk("lp->lan_saa9730_regs->CamCtl = %x\n",
140                readl(&lp->lan_saa9730_regs->CamCtl));
141         printk("lp->lan_saa9730_regs->TxCtl = %x\n",
142                readl(&lp->lan_saa9730_regs->TxCtl));
143         printk("lp->lan_saa9730_regs->TxStatus = %x\n",
144                readl(&lp->lan_saa9730_regs->TxStatus));
145         printk("lp->lan_saa9730_regs->RxCtl = %x\n",
146                readl(&lp->lan_saa9730_regs->RxCtl));
147         printk("lp->lan_saa9730_regs->RxStatus = %x\n",
148                readl(&lp->lan_saa9730_regs->RxStatus));
149         for (i = 0; i < LAN_SAA9730_CAM_DWORDS; i++) {
150                 writel(i, &lp->lan_saa9730_regs->CamAddress);
151                 printk("lp->lan_saa9730_regs->CamData = %x\n",
152                        readl(&lp->lan_saa9730_regs->CamData));
153         }
154         printk("lp->stats.tx_packets = %lx\n", lp->stats.tx_packets);
155         printk("lp->stats.tx_errors = %lx\n", lp->stats.tx_errors);
156         printk("lp->stats.tx_aborted_errors = %lx\n",
157                lp->stats.tx_aborted_errors);
158         printk("lp->stats.tx_window_errors = %lx\n",
159                lp->stats.tx_window_errors);
160         printk("lp->stats.tx_carrier_errors = %lx\n",
161                lp->stats.tx_carrier_errors);
162         printk("lp->stats.tx_fifo_errors = %lx\n",
163                lp->stats.tx_fifo_errors);
164         printk("lp->stats.tx_heartbeat_errors = %lx\n",
165                lp->stats.tx_heartbeat_errors);
166         printk("lp->stats.collisions = %lx\n", lp->stats.collisions);
167
168         printk("lp->stats.rx_packets = %lx\n", lp->stats.rx_packets);
169         printk("lp->stats.rx_errors = %lx\n", lp->stats.rx_errors);
170         printk("lp->stats.rx_dropped = %lx\n", lp->stats.rx_dropped);
171         printk("lp->stats.rx_crc_errors = %lx\n", lp->stats.rx_crc_errors);
172         printk("lp->stats.rx_frame_errors = %lx\n",
173                lp->stats.rx_frame_errors);
174         printk("lp->stats.rx_fifo_errors = %lx\n",
175                lp->stats.rx_fifo_errors);
176         printk("lp->stats.rx_length_errors = %lx\n",
177                lp->stats.rx_length_errors);
178
179         printk("lp->lan_saa9730_regs->DebugPCIMasterAddr = %x\n",
180                readl(&lp->lan_saa9730_regs->DebugPCIMasterAddr));
181         printk("lp->lan_saa9730_regs->DebugLanTxStateMachine = %x\n",
182                readl(&lp->lan_saa9730_regs->DebugLanTxStateMachine));
183         printk("lp->lan_saa9730_regs->DebugLanRxStateMachine = %x\n",
184                readl(&lp->lan_saa9730_regs->DebugLanRxStateMachine));
185         printk("lp->lan_saa9730_regs->DebugLanTxFifoPointers = %x\n",
186                readl(&lp->lan_saa9730_regs->DebugLanTxFifoPointers));
187         printk("lp->lan_saa9730_regs->DebugLanRxFifoPointers = %x\n",
188                readl(&lp->lan_saa9730_regs->DebugLanRxFifoPointers));
189         printk("lp->lan_saa9730_regs->DebugLanCtlStateMachine = %x\n",
190                readl(&lp->lan_saa9730_regs->DebugLanCtlStateMachine));
191 }
192
193 static void lan_saa9730_buffer_init(struct lan_saa9730_private *lp)
194 {
195         int i, j;
196
197         /* Init RX buffers */
198         for (i = 0; i < LAN_SAA9730_BUFFERS; i++) {
199                 for (j = 0; j < LAN_SAA9730_RCV_Q_SIZE; j++) {
200                         *(unsigned int *) lp->RcvBuffer[i][j] =
201                             cpu_to_le32(RXSF_READY <<
202                                         RX_STAT_CTL_OWNER_SHF);
203                 }
204         }
205
206         /* Init TX buffers */
207         for (i = 0; i < LAN_SAA9730_BUFFERS; i++) {
208                 for (j = 0; j < LAN_SAA9730_TXM_Q_SIZE; j++) {
209                         *(unsigned int *) lp->TxmBuffer[i][j] =
210                             cpu_to_le32(TXSF_EMPTY <<
211                                         TX_STAT_CTL_OWNER_SHF);
212                 }
213         }
214 }
215
216 static void lan_saa9730_free_buffers(struct pci_dev *pdev,
217                                      struct lan_saa9730_private *lp)
218 {
219         pci_free_consistent(pdev, lp->buffer_size, lp->buffer_start,
220                             lp->dma_addr);
221 }
222
223 static int lan_saa9730_allocate_buffers(struct pci_dev *pdev,
224                                         struct lan_saa9730_private *lp)
225 {
226         void *Pa;
227         unsigned int i, j, rxoffset, txoffset;
228         int ret;
229
230         /* Initialize buffer space */
231         lp->DmaRcvPackets = LAN_SAA9730_RCV_Q_SIZE;
232         lp->DmaTxmPackets = LAN_SAA9730_TXM_Q_SIZE;
233
234         /* Initialize Rx Buffer Index */
235         lp->NextRcvPacketIndex = 0;
236         lp->NextRcvBufferIndex = 0;
237
238         /* Set current buffer index & next available packet index */
239         lp->NextTxmPacketIndex = 0;
240         lp->NextTxmBufferIndex = 0;
241         lp->PendingTxmPacketIndex = 0;
242         lp->PendingTxmBufferIndex = 0;
243
244         /*
245          * Allocate all RX and TX packets in one chunk.
246          * The Rx and Tx packets must be PACKET_SIZE aligned.
247          */
248         lp->buffer_size = ((LAN_SAA9730_RCV_Q_SIZE + LAN_SAA9730_TXM_Q_SIZE) *
249                            LAN_SAA9730_PACKET_SIZE * LAN_SAA9730_BUFFERS) +
250                           LAN_SAA9730_PACKET_SIZE;
251         lp->buffer_start = pci_alloc_consistent(pdev, lp->buffer_size,
252                                                 &lp->dma_addr);
253         if (!lp->buffer_start) {
254                 ret = -ENOMEM;
255                 goto out;
256         }
257
258         Pa = (void *)ALIGN((unsigned long)lp->buffer_start,
259                            LAN_SAA9730_PACKET_SIZE);
260
261         rxoffset = Pa - lp->buffer_start;
262
263         /* Init RX buffers */
264         for (i = 0; i < LAN_SAA9730_BUFFERS; i++) {
265                 for (j = 0; j < LAN_SAA9730_RCV_Q_SIZE; j++) {
266                         *(unsigned int *) Pa =
267                             cpu_to_le32(RXSF_READY <<
268                                         RX_STAT_CTL_OWNER_SHF);
269                         lp->RcvBuffer[i][j] = Pa;
270                         Pa += LAN_SAA9730_PACKET_SIZE;
271                 }
272         }
273
274         txoffset = Pa - lp->buffer_start;
275
276         /* Init TX buffers */
277         for (i = 0; i < LAN_SAA9730_BUFFERS; i++) {
278                 for (j = 0; j < LAN_SAA9730_TXM_Q_SIZE; j++) {
279                         *(unsigned int *) Pa =
280                             cpu_to_le32(TXSF_EMPTY <<
281                                         TX_STAT_CTL_OWNER_SHF);
282                         lp->TxmBuffer[i][j] = Pa;
283                         Pa += LAN_SAA9730_PACKET_SIZE;
284                 }
285         }
286
287         /*
288          * Set rx buffer A and rx buffer B to point to the first two buffer
289          * spaces.
290          */
291         writel(lp->dma_addr + rxoffset, &lp->lan_saa9730_regs->RxBuffA);
292         writel(lp->dma_addr + rxoffset +
293                LAN_SAA9730_PACKET_SIZE * LAN_SAA9730_RCV_Q_SIZE,
294                &lp->lan_saa9730_regs->RxBuffB);
295
296         /*
297          * Set txm_buf_a and txm_buf_b to point to the first two buffer
298          * space
299          */
300         writel(lp->dma_addr + txoffset,
301                &lp->lan_saa9730_regs->TxBuffA);
302         writel(lp->dma_addr + txoffset +
303                LAN_SAA9730_PACKET_SIZE * LAN_SAA9730_TXM_Q_SIZE,
304                &lp->lan_saa9730_regs->TxBuffB);
305
306         /* Set packet number */
307         writel((lp->DmaRcvPackets << PK_COUNT_RX_A_SHF) |
308                (lp->DmaRcvPackets << PK_COUNT_RX_B_SHF) |
309                (lp->DmaTxmPackets << PK_COUNT_TX_A_SHF) |
310                (lp->DmaTxmPackets << PK_COUNT_TX_B_SHF),
311                &lp->lan_saa9730_regs->PacketCount);
312
313         return 0;
314
315 out:
316         return ret;
317 }
318
319 static int lan_saa9730_cam_load(struct lan_saa9730_private *lp)
320 {
321         unsigned int i;
322         unsigned char *NetworkAddress;
323
324         NetworkAddress = (unsigned char *) &lp->PhysicalAddress[0][0];
325
326         for (i = 0; i < LAN_SAA9730_CAM_DWORDS; i++) {
327                 /* First set address to where data is written */
328                 writel(i, &lp->lan_saa9730_regs->CamAddress);
329                 writel((NetworkAddress[0] << 24) | (NetworkAddress[1] << 16) |
330                        (NetworkAddress[2] << 8) | NetworkAddress[3],
331                        &lp->lan_saa9730_regs->CamData);
332                 NetworkAddress += 4;
333         }
334         return 0;
335 }
336
337 static int lan_saa9730_cam_init(struct net_device *dev)
338 {
339         struct lan_saa9730_private *lp = netdev_priv(dev);
340         unsigned int i;
341
342         /* Copy MAC-address into all entries. */
343         for (i = 0; i < LAN_SAA9730_CAM_ENTRIES; i++) {
344                 memcpy((unsigned char *) lp->PhysicalAddress[i],
345                        (unsigned char *) dev->dev_addr, 6);
346         }
347
348         return 0;
349 }
350
351 static int lan_saa9730_mii_init(struct lan_saa9730_private *lp)
352 {
353         int i, l;
354
355         /* Check link status, spin here till station is not busy. */
356         i = 0;
357         while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) & MD_CA_BUSY) {
358                 i++;
359                 if (i > 100) {
360                         printk("Error: lan_saa9730_mii_init: timeout\n");
361                         return -1;
362                 }
363                 mdelay(1);      /* wait 1 ms. */
364         }
365
366         /* Now set the control and address register. */
367         writel(MD_CA_BUSY | PHY_STATUS | PHY_ADDRESS << MD_CA_PHY_SHF,
368                &lp->lan_saa9730_regs->StationMgmtCtl);
369
370         /* check link status, spin here till station is not busy */
371         i = 0;
372         while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) & MD_CA_BUSY) {
373                 i++;
374                 if (i > 100) {
375                         printk("Error: lan_saa9730_mii_init: timeout\n");
376                         return -1;
377                 }
378                 mdelay(1);      /* wait 1 ms. */
379         }
380
381         /* Wait for 1 ms. */
382         mdelay(1);
383
384         /* Check the link status. */
385         if (readl(&lp->lan_saa9730_regs->StationMgmtData) &
386             PHY_STATUS_LINK_UP) {
387                 /* Link is up. */
388                 return 0;
389         } else {
390                 /* Link is down, reset the PHY first. */
391
392                 /* set PHY address = 'CONTROL' */
393                 writel(PHY_ADDRESS << MD_CA_PHY_SHF | MD_CA_WR | PHY_CONTROL,
394                        &lp->lan_saa9730_regs->StationMgmtCtl);
395
396                 /* Wait for 1 ms. */
397                 mdelay(1);
398
399                 /* set 'CONTROL' = force reset and renegotiate */
400                 writel(PHY_CONTROL_RESET | PHY_CONTROL_AUTO_NEG |
401                        PHY_CONTROL_RESTART_AUTO_NEG,
402                        &lp->lan_saa9730_regs->StationMgmtData);
403
404                 /* Wait for 50 ms. */
405                 mdelay(50);
406
407                 /* set 'BUSY' to start operation */
408                 writel(MD_CA_BUSY | PHY_ADDRESS << MD_CA_PHY_SHF | MD_CA_WR |
409                        PHY_CONTROL, &lp->lan_saa9730_regs->StationMgmtCtl);
410
411                 /* await completion */
412                 i = 0;
413                 while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) &
414                        MD_CA_BUSY) {
415                         i++;
416                         if (i > 100) {
417                                 printk
418                                     ("Error: lan_saa9730_mii_init: timeout\n");
419                                 return -1;
420                         }
421                         mdelay(1);      /* wait 1 ms. */
422                 }
423
424                 /* Wait for 1 ms. */
425                 mdelay(1);
426
427                 for (l = 0; l < 2; l++) {
428                         /* set PHY address = 'STATUS' */
429                         writel(MD_CA_BUSY | PHY_ADDRESS << MD_CA_PHY_SHF |
430                                PHY_STATUS,
431                                &lp->lan_saa9730_regs->StationMgmtCtl);
432
433                         /* await completion */
434                         i = 0;
435                         while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) &
436                                MD_CA_BUSY) {
437                                 i++;
438                                 if (i > 100) {
439                                         printk
440                                             ("Error: lan_saa9730_mii_init: timeout\n");
441                                         return -1;
442                                 }
443                                 mdelay(1);      /* wait 1 ms. */
444                         }
445
446                         /* wait for 3 sec. */
447                         mdelay(3000);
448
449                         /* check the link status */
450                         if (readl(&lp->lan_saa9730_regs->StationMgmtData) &
451                             PHY_STATUS_LINK_UP) {
452                                 /* link is up */
453                                 break;
454                         }
455                 }
456         }
457
458         return 0;
459 }
460
461 static int lan_saa9730_control_init(struct lan_saa9730_private *lp)
462 {
463         /* Initialize DMA control register. */
464         writel((LANMB_ANY << DMA_CTL_MAX_XFER_SHF) |
465                (LANEND_LITTLE << DMA_CTL_ENDIAN_SHF) |
466                (LAN_SAA9730_RCV_Q_INT_THRESHOLD << DMA_CTL_RX_INT_COUNT_SHF)
467                | DMA_CTL_RX_INT_TO_EN | DMA_CTL_RX_INT_EN |
468                DMA_CTL_MAC_RX_INT_EN | DMA_CTL_MAC_TX_INT_EN,
469                &lp->lan_saa9730_regs->LanDmaCtl);
470
471         /* Initial MAC control register. */
472         writel((MACCM_MII << MAC_CONTROL_CONN_SHF) | MAC_CONTROL_FULL_DUP,
473                &lp->lan_saa9730_regs->MacCtl);
474
475         /* Initialize CAM control register. */
476         writel(CAM_CONTROL_COMP_EN | CAM_CONTROL_BROAD_ACC,
477                &lp->lan_saa9730_regs->CamCtl);
478
479         /*
480          * Initialize CAM enable register, only turn on first entry, should
481          * contain own addr.
482          */
483         writel(0x0001, &lp->lan_saa9730_regs->CamEnable);
484
485         /* Initialize Tx control register */
486         writel(TX_CTL_EN_COMP, &lp->lan_saa9730_regs->TxCtl);
487
488         /* Initialize Rcv control register */
489         writel(RX_CTL_STRIP_CRC, &lp->lan_saa9730_regs->RxCtl);
490
491         /* Reset DMA engine */
492         writel(DMA_TEST_SW_RESET, &lp->lan_saa9730_regs->DmaTest);
493
494         return 0;
495 }
496
497 static int lan_saa9730_stop(struct lan_saa9730_private *lp)
498 {
499         int i;
500
501         /* Stop DMA first */
502         writel(readl(&lp->lan_saa9730_regs->LanDmaCtl) &
503                ~(DMA_CTL_EN_TX_DMA | DMA_CTL_EN_RX_DMA),
504                &lp->lan_saa9730_regs->LanDmaCtl);
505
506         /* Set the SW Reset bits in DMA and MAC control registers */
507         writel(DMA_TEST_SW_RESET, &lp->lan_saa9730_regs->DmaTest);
508         writel(readl(&lp->lan_saa9730_regs->MacCtl) | MAC_CONTROL_RESET,
509                &lp->lan_saa9730_regs->MacCtl);
510
511         /*
512          * Wait for MAC reset to have finished. The reset bit is auto cleared
513          * when the reset is done.
514          */
515         i = 0;
516         while (readl(&lp->lan_saa9730_regs->MacCtl) & MAC_CONTROL_RESET) {
517                 i++;
518                 if (i > 100) {
519                         printk
520                             ("Error: lan_sa9730_stop: MAC reset timeout\n");
521                         return -1;
522                 }
523                 mdelay(1);      /* wait 1 ms. */
524         }
525
526         return 0;
527 }
528
529 static int lan_saa9730_dma_init(struct lan_saa9730_private *lp)
530 {
531         /* Stop lan controller. */
532         lan_saa9730_stop(lp);
533
534         writel(LAN_SAA9730_DEFAULT_TIME_OUT_CNT,
535                &lp->lan_saa9730_regs->Timeout);
536
537         return 0;
538 }
539
540 static int lan_saa9730_start(struct lan_saa9730_private *lp)
541 {
542         lan_saa9730_buffer_init(lp);
543
544         /* Initialize Rx Buffer Index */
545         lp->NextRcvPacketIndex = 0;
546         lp->NextRcvBufferIndex = 0;
547
548         /* Set current buffer index & next available packet index */
549         lp->NextTxmPacketIndex = 0;
550         lp->NextTxmBufferIndex = 0;
551         lp->PendingTxmPacketIndex = 0;
552         lp->PendingTxmBufferIndex = 0;
553
554         writel(readl(&lp->lan_saa9730_regs->LanDmaCtl) | DMA_CTL_EN_TX_DMA |
555                DMA_CTL_EN_RX_DMA, &lp->lan_saa9730_regs->LanDmaCtl);
556
557         /* For Tx, turn on MAC then DMA */
558         writel(readl(&lp->lan_saa9730_regs->TxCtl) | TX_CTL_TX_EN,
559                &lp->lan_saa9730_regs->TxCtl);
560
561         /* For Rx, turn on DMA then MAC */
562         writel(readl(&lp->lan_saa9730_regs->RxCtl) | RX_CTL_RX_EN,
563                &lp->lan_saa9730_regs->RxCtl);
564
565         /* Set Ok2Use to let hardware own the buffers.  */
566         writel(OK2USE_RX_A | OK2USE_RX_B, &lp->lan_saa9730_regs->Ok2Use);
567
568         return 0;
569 }
570
571 static int lan_saa9730_restart(struct lan_saa9730_private *lp)
572 {
573         lan_saa9730_stop(lp);
574         lan_saa9730_start(lp);
575
576         return 0;
577 }
578
579 static int lan_saa9730_tx(struct net_device *dev)
580 {
581         struct lan_saa9730_private *lp = netdev_priv(dev);
582         unsigned int *pPacket;
583         unsigned int tx_status;
584
585         if (lan_saa9730_debug > 5)
586                 printk("lan_saa9730_tx interrupt\n");
587
588         /* Clear interrupt. */
589         writel(DMA_STATUS_MAC_TX_INT, &lp->lan_saa9730_regs->DmaStatus);
590
591         while (1) {
592                 pPacket = lp->TxmBuffer[lp->PendingTxmBufferIndex]
593                                        [lp->PendingTxmPacketIndex];
594
595                 /* Get status of first packet transmitted. */
596                 tx_status = le32_to_cpu(*pPacket);
597
598                 /* Check ownership. */
599                 if ((tx_status & TX_STAT_CTL_OWNER_MSK) !=
600                     (TXSF_HWDONE << TX_STAT_CTL_OWNER_SHF)) break;
601
602                 /* Check for error. */
603                 if (tx_status & TX_STAT_CTL_ERROR_MSK) {
604                         if (lan_saa9730_debug > 1)
605                                 printk("lan_saa9730_tx: tx error = %x\n",
606                                        tx_status);
607
608                         lp->stats.tx_errors++;
609                         if (tx_status &
610                             (TX_STATUS_EX_COLL << TX_STAT_CTL_STATUS_SHF))
611                                 lp->stats.tx_aborted_errors++;
612                         if (tx_status &
613                             (TX_STATUS_LATE_COLL << TX_STAT_CTL_STATUS_SHF))
614                                 lp->stats.tx_window_errors++;
615                         if (tx_status &
616                             (TX_STATUS_L_CARR << TX_STAT_CTL_STATUS_SHF))
617                                 lp->stats.tx_carrier_errors++;
618                         if (tx_status &
619                             (TX_STATUS_UNDER << TX_STAT_CTL_STATUS_SHF))
620                                 lp->stats.tx_fifo_errors++;
621                         if (tx_status &
622                             (TX_STATUS_SQ_ERR << TX_STAT_CTL_STATUS_SHF))
623                                 lp->stats.tx_heartbeat_errors++;
624
625                         lp->stats.collisions +=
626                                 tx_status & TX_STATUS_TX_COLL_MSK;
627                 }
628
629                 /* Free buffer. */
630                 *pPacket =
631                     cpu_to_le32(TXSF_EMPTY << TX_STAT_CTL_OWNER_SHF);
632
633                 /* Update pending index pointer. */
634                 lp->PendingTxmPacketIndex++;
635                 if (lp->PendingTxmPacketIndex >= LAN_SAA9730_TXM_Q_SIZE) {
636                         lp->PendingTxmPacketIndex = 0;
637                         lp->PendingTxmBufferIndex ^= 1;
638                 }
639         }
640
641         /* The tx buffer is no longer full. */
642         netif_wake_queue(dev);
643
644         return 0;
645 }
646
647 static int lan_saa9730_rx(struct net_device *dev)
648 {
649         struct lan_saa9730_private *lp = netdev_priv(dev);
650         int len = 0;
651         struct sk_buff *skb = 0;
652         unsigned int rx_status;
653         int BufferIndex;
654         int PacketIndex;
655         unsigned int *pPacket;
656         unsigned char *pData;
657
658         if (lan_saa9730_debug > 5)
659                 printk("lan_saa9730_rx interrupt\n");
660
661         /* Clear receive interrupts. */
662         writel(DMA_STATUS_MAC_RX_INT | DMA_STATUS_RX_INT |
663                DMA_STATUS_RX_TO_INT, &lp->lan_saa9730_regs->DmaStatus);
664
665         /* Address next packet */
666         BufferIndex = lp->NextRcvBufferIndex;
667         PacketIndex = lp->NextRcvPacketIndex;
668         pPacket = lp->RcvBuffer[BufferIndex][PacketIndex];
669         rx_status = le32_to_cpu(*pPacket);
670
671         /* Process each packet. */
672         while ((rx_status & RX_STAT_CTL_OWNER_MSK) ==
673                (RXSF_HWDONE << RX_STAT_CTL_OWNER_SHF)) {
674                 /* Check the rx status. */
675                 if (rx_status & (RX_STATUS_GOOD << RX_STAT_CTL_STATUS_SHF)) {
676                         /* Received packet is good. */
677                         len = (rx_status & RX_STAT_CTL_LENGTH_MSK) >>
678                             RX_STAT_CTL_LENGTH_SHF;
679
680                         pData = (unsigned char *) pPacket;
681                         pData += 4;
682                         skb = dev_alloc_skb(len + 2);
683                         if (skb == 0) {
684                                 printk
685                                     ("%s: Memory squeeze, deferring packet.\n",
686                                      dev->name);
687                                 lp->stats.rx_dropped++;
688                         } else {
689                                 lp->stats.rx_bytes += len;
690                                 lp->stats.rx_packets++;
691                                 skb_reserve(skb, 2);    /* 16 byte align */
692                                 skb_put(skb, len);      /* make room */
693                                 skb_copy_to_linear_data(skb,
694                                                  (unsigned char *) pData,
695                                                  len);
696                                 skb->protocol = eth_type_trans(skb, dev);
697                                 netif_rx(skb);
698                                 dev->last_rx = jiffies;
699                         }
700                 } else {
701                         /* We got an error packet. */
702                         if (lan_saa9730_debug > 2)
703                                 printk
704                                     ("lan_saa9730_rx: We got an error packet = %x\n",
705                                      rx_status);
706
707                         lp->stats.rx_errors++;
708                         if (rx_status &
709                             (RX_STATUS_CRC_ERR << RX_STAT_CTL_STATUS_SHF))
710                                 lp->stats.rx_crc_errors++;
711                         if (rx_status &
712                             (RX_STATUS_ALIGN_ERR << RX_STAT_CTL_STATUS_SHF))
713                                 lp->stats.rx_frame_errors++;
714                         if (rx_status &
715                             (RX_STATUS_OVERFLOW << RX_STAT_CTL_STATUS_SHF))
716                                 lp->stats.rx_fifo_errors++;
717                         if (rx_status &
718                             (RX_STATUS_LONG_ERR << RX_STAT_CTL_STATUS_SHF))
719                                 lp->stats.rx_length_errors++;
720                 }
721
722                 /* Indicate we have processed the buffer. */
723                 *pPacket = cpu_to_le32(RXSF_READY << RX_STAT_CTL_OWNER_SHF);
724
725                 /* Make sure A or B is available to hardware as appropriate. */
726                 writel(BufferIndex ? OK2USE_RX_B : OK2USE_RX_A,
727                        &lp->lan_saa9730_regs->Ok2Use);
728
729                 /* Go to next packet in sequence. */
730                 lp->NextRcvPacketIndex++;
731                 if (lp->NextRcvPacketIndex >= LAN_SAA9730_RCV_Q_SIZE) {
732                         lp->NextRcvPacketIndex = 0;
733                         lp->NextRcvBufferIndex ^= 1;
734                 }
735
736                 /* Address next packet */
737                 BufferIndex = lp->NextRcvBufferIndex;
738                 PacketIndex = lp->NextRcvPacketIndex;
739                 pPacket = lp->RcvBuffer[BufferIndex][PacketIndex];
740                 rx_status = le32_to_cpu(*pPacket);
741         }
742
743         return 0;
744 }
745
746 static irqreturn_t lan_saa9730_interrupt(const int irq, void *dev_id)
747 {
748         struct net_device *dev = dev_id;
749         struct lan_saa9730_private *lp = netdev_priv(dev);
750
751         if (lan_saa9730_debug > 5)
752                 printk("lan_saa9730_interrupt\n");
753
754         /* Disable the EVM LAN interrupt. */
755         evm_saa9730_block_lan_int(lp);
756
757         /* Clear the EVM LAN interrupt. */
758         evm_saa9730_clear_lan_int(lp);
759
760         /* Service pending transmit interrupts. */
761         if (readl(&lp->lan_saa9730_regs->DmaStatus) & DMA_STATUS_MAC_TX_INT)
762                 lan_saa9730_tx(dev);
763
764         /* Service pending receive interrupts. */
765         if (readl(&lp->lan_saa9730_regs->DmaStatus) &
766             (DMA_STATUS_MAC_RX_INT | DMA_STATUS_RX_INT |
767              DMA_STATUS_RX_TO_INT)) lan_saa9730_rx(dev);
768
769         /* Enable the EVM LAN interrupt. */
770         evm_saa9730_unblock_lan_int(lp);
771
772         return IRQ_HANDLED;
773 }
774
775 static int lan_saa9730_open(struct net_device *dev)
776 {
777         struct lan_saa9730_private *lp = netdev_priv(dev);
778
779         /* Associate IRQ with lan_saa9730_interrupt */
780         if (request_irq(dev->irq, &lan_saa9730_interrupt, 0, "SAA9730 Eth",
781                         dev)) {
782                 printk("lan_saa9730_open: Can't get irq %d\n", dev->irq);
783                 return -EAGAIN;
784         }
785
786         /* Enable the Lan interrupt in the event manager. */
787         evm_saa9730_enable_lan_int(lp);
788
789         /* Start the LAN controller */
790         if (lan_saa9730_start(lp))
791                 return -1;
792
793         netif_start_queue(dev);
794
795         return 0;
796 }
797
798 static int lan_saa9730_write(struct lan_saa9730_private *lp,
799                              struct sk_buff *skb, int skblen)
800 {
801         unsigned char *pbData = skb->data;
802         unsigned int len = skblen;
803         unsigned char *pbPacketData;
804         unsigned int tx_status;
805         int BufferIndex;
806         int PacketIndex;
807
808         if (lan_saa9730_debug > 5)
809                 printk("lan_saa9730_write: skb=%p\n", skb);
810
811         BufferIndex = lp->NextTxmBufferIndex;
812         PacketIndex = lp->NextTxmPacketIndex;
813
814         tx_status = le32_to_cpu(*(unsigned int *)lp->TxmBuffer[BufferIndex]
815                                                               [PacketIndex]);
816         if ((tx_status & TX_STAT_CTL_OWNER_MSK) !=
817             (TXSF_EMPTY << TX_STAT_CTL_OWNER_SHF)) {
818                 if (lan_saa9730_debug > 4)
819                         printk
820                             ("lan_saa9730_write: Tx buffer not available: tx_status = %x\n",
821                              tx_status);
822                 return -1;
823         }
824
825         lp->NextTxmPacketIndex++;
826         if (lp->NextTxmPacketIndex >= LAN_SAA9730_TXM_Q_SIZE) {
827                 lp->NextTxmPacketIndex = 0;
828                 lp->NextTxmBufferIndex ^= 1;
829         }
830
831         pbPacketData = lp->TxmBuffer[BufferIndex][PacketIndex];
832         pbPacketData += 4;
833
834         /* copy the bits */
835         memcpy(pbPacketData, pbData, len);
836
837         /* Set transmit status for hardware */
838         *(unsigned int *)lp->TxmBuffer[BufferIndex][PacketIndex] =
839                 cpu_to_le32((TXSF_READY << TX_STAT_CTL_OWNER_SHF) |
840                             (TX_STAT_CTL_INT_AFTER_TX <<
841                              TX_STAT_CTL_FRAME_SHF) |
842                             (len << TX_STAT_CTL_LENGTH_SHF));
843
844         /* Make sure A or B is available to hardware as appropriate. */
845         writel(BufferIndex ? OK2USE_TX_B : OK2USE_TX_A,
846                &lp->lan_saa9730_regs->Ok2Use);
847
848         return 0;
849 }
850
851 static void lan_saa9730_tx_timeout(struct net_device *dev)
852 {
853         struct lan_saa9730_private *lp = netdev_priv(dev);
854
855         /* Transmitter timeout, serious problems */
856         lp->stats.tx_errors++;
857         printk("%s: transmit timed out, reset\n", dev->name);
858         /*show_saa9730_regs(lp); */
859         lan_saa9730_restart(lp);
860
861         dev->trans_start = jiffies;
862         netif_wake_queue(dev);
863 }
864
865 static int lan_saa9730_start_xmit(struct sk_buff *skb,
866                                   struct net_device *dev)
867 {
868         struct lan_saa9730_private *lp = netdev_priv(dev);
869         unsigned long flags;
870         int skblen;
871         int len;
872
873         if (lan_saa9730_debug > 4)
874                 printk("Send packet: skb=%p\n", skb);
875
876         skblen = skb->len;
877
878         spin_lock_irqsave(&lp->lock, flags);
879
880         len = (skblen <= ETH_ZLEN) ? ETH_ZLEN : skblen;
881
882         if (lan_saa9730_write(lp, skb, skblen)) {
883                 spin_unlock_irqrestore(&lp->lock, flags);
884                 printk("Error when writing packet to controller: skb=%p\n", skb);
885                 netif_stop_queue(dev);
886                 return -1;
887         }
888
889         lp->stats.tx_bytes += len;
890         lp->stats.tx_packets++;
891
892         dev->trans_start = jiffies;
893         netif_wake_queue(dev);
894         dev_kfree_skb(skb);
895
896         spin_unlock_irqrestore(&lp->lock, flags);
897
898         return 0;
899 }
900
901 static int lan_saa9730_close(struct net_device *dev)
902 {
903         struct lan_saa9730_private *lp = netdev_priv(dev);
904
905         if (lan_saa9730_debug > 1)
906                 printk("lan_saa9730_close:\n");
907
908         netif_stop_queue(dev);
909
910         /* Disable the Lan interrupt in the event manager. */
911         evm_saa9730_disable_lan_int(lp);
912
913         /* Stop the controller */
914         if (lan_saa9730_stop(lp))
915                 return -1;
916
917         free_irq(dev->irq, (void *) dev);
918
919         return 0;
920 }
921
922 static struct net_device_stats *lan_saa9730_get_stats(struct net_device
923                                                       *dev)
924 {
925         struct lan_saa9730_private *lp = netdev_priv(dev);
926
927         return &lp->stats;
928 }
929
930 static void lan_saa9730_set_multicast(struct net_device *dev)
931 {
932         struct lan_saa9730_private *lp = netdev_priv(dev);
933
934         /* Stop the controller */
935         lan_saa9730_stop(lp);
936
937         if (dev->flags & IFF_PROMISC) {
938                 /* accept all packets */
939                 writel(CAM_CONTROL_COMP_EN | CAM_CONTROL_STATION_ACC |
940                        CAM_CONTROL_GROUP_ACC | CAM_CONTROL_BROAD_ACC,
941                        &lp->lan_saa9730_regs->CamCtl);
942         } else {
943                 if (dev->flags & IFF_ALLMULTI || dev->mc_count) {
944                         /* accept all multicast packets */
945                         /*
946                          * Will handle the multicast stuff later. -carstenl
947                          */
948                         writel(CAM_CONTROL_COMP_EN | CAM_CONTROL_GROUP_ACC |
949                                CAM_CONTROL_BROAD_ACC,
950                                &lp->lan_saa9730_regs->CamCtl);
951                 }
952         }
953
954         lan_saa9730_restart(lp);
955 }
956
957
958 static void __devexit saa9730_remove_one(struct pci_dev *pdev)
959 {
960         struct net_device *dev = pci_get_drvdata(pdev);
961         struct lan_saa9730_private *lp = netdev_priv(dev);
962
963         if (dev) {
964                 unregister_netdev(dev);
965                 lan_saa9730_free_buffers(pdev, lp);
966                 iounmap(lp->lan_saa9730_regs);
967                 iounmap(lp->evm_saa9730_regs);
968                 free_netdev(dev);
969                 pci_release_regions(pdev);
970                 pci_disable_device(pdev);
971                 pci_set_drvdata(pdev, NULL);
972         }
973 }
974
975
976 static int lan_saa9730_init(struct net_device *dev, struct pci_dev *pdev,
977         unsigned long ioaddr, int irq)
978 {
979         struct lan_saa9730_private *lp = netdev_priv(dev);
980         unsigned char ethernet_addr[6];
981         int ret;
982
983         if (get_ethernet_addr(ethernet_addr)) {
984                 ret = -ENODEV;
985                 goto out;
986         }
987
988         memcpy(dev->dev_addr, ethernet_addr, 6);
989         dev->base_addr = ioaddr;
990         dev->irq = irq;
991
992         lp->pci_dev = pdev;
993
994         /* Set SAA9730 LAN base address. */
995         lp->lan_saa9730_regs = ioremap(ioaddr + SAA9730_LAN_REGS_ADDR,
996                                        SAA9730_LAN_REGS_SIZE);
997         if (!lp->lan_saa9730_regs) {
998                 ret = -ENOMEM;
999                 goto out;
1000         }
1001
1002         /* Set SAA9730 EVM base address. */
1003         lp->evm_saa9730_regs = ioremap(ioaddr + SAA9730_EVM_REGS_ADDR,
1004                                        SAA9730_EVM_REGS_SIZE);
1005         if (!lp->evm_saa9730_regs) {
1006                 ret = -ENOMEM;
1007                 goto out_iounmap_lan;
1008         }
1009
1010         /* Allocate LAN RX/TX frame buffer space. */
1011         if ((ret = lan_saa9730_allocate_buffers(pdev, lp)))
1012                 goto out_iounmap;
1013
1014         /* Stop LAN controller. */
1015         if ((ret = lan_saa9730_stop(lp)))
1016                 goto out_free_consistent;
1017
1018         /* Initialize CAM registers. */
1019         if ((ret = lan_saa9730_cam_init(dev)))
1020                 goto out_free_consistent;
1021
1022         /* Initialize MII registers. */
1023         if ((ret = lan_saa9730_mii_init(lp)))
1024                 goto out_free_consistent;
1025
1026         /* Initialize control registers. */
1027         if ((ret = lan_saa9730_control_init(lp)))
1028                 goto out_free_consistent;
1029
1030         /* Load CAM registers. */
1031         if ((ret = lan_saa9730_cam_load(lp)))
1032                 goto out_free_consistent;
1033
1034         /* Initialize DMA context registers. */
1035         if ((ret = lan_saa9730_dma_init(lp)))
1036                 goto out_free_consistent;
1037
1038         spin_lock_init(&lp->lock);
1039
1040         dev->open = lan_saa9730_open;
1041         dev->hard_start_xmit = lan_saa9730_start_xmit;
1042         dev->stop = lan_saa9730_close;
1043         dev->get_stats = lan_saa9730_get_stats;
1044         dev->set_multicast_list = lan_saa9730_set_multicast;
1045         dev->tx_timeout = lan_saa9730_tx_timeout;
1046         dev->watchdog_timeo = (HZ >> 1);
1047         dev->dma = 0;
1048
1049         ret = register_netdev (dev);
1050         if (ret)
1051                 goto out_free_consistent;
1052
1053         return 0;
1054
1055 out_free_consistent:
1056         lan_saa9730_free_buffers(pdev, lp);
1057 out_iounmap:
1058         iounmap(lp->evm_saa9730_regs);
1059 out_iounmap_lan:
1060         iounmap(lp->lan_saa9730_regs);
1061 out:
1062         return ret;
1063 }
1064
1065
1066 static int __devinit saa9730_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
1067 {
1068         struct net_device *dev = NULL;
1069         unsigned long pci_ioaddr;
1070         int err;
1071
1072         if (lan_saa9730_debug > 1)
1073                 printk("saa9730.c: PCI bios is present, checking for devices...\n");
1074
1075         err = pci_enable_device(pdev);
1076         if (err) {
1077                 printk(KERN_ERR "Cannot enable PCI device, aborting.\n");
1078                 goto out;
1079         }
1080
1081         err = pci_request_regions(pdev, DRV_MODULE_NAME);
1082         if (err) {
1083                 printk(KERN_ERR "Cannot obtain PCI resources, aborting.\n");
1084                 goto out_disable_pdev;
1085         }
1086
1087         pci_irq_line = pdev->irq;
1088         /* LAN base address in located at BAR 1. */
1089
1090         pci_ioaddr = pci_resource_start(pdev, 1);
1091         pci_set_master(pdev);
1092
1093         printk("Found SAA9730 (PCI) at %lx, irq %d.\n",
1094                pci_ioaddr, pci_irq_line);
1095
1096         dev = alloc_etherdev(sizeof(struct lan_saa9730_private));
1097         if (!dev)
1098                 goto out_disable_pdev;
1099
1100         err = lan_saa9730_init(dev, pdev, pci_ioaddr, pci_irq_line);
1101         if (err) {
1102                 printk("LAN init failed");
1103                 goto out_free_netdev;
1104         }
1105
1106         pci_set_drvdata(pdev, dev);
1107         SET_NETDEV_DEV(dev, &pdev->dev);
1108         return 0;
1109
1110 out_free_netdev:
1111         free_netdev(dev);
1112 out_disable_pdev:
1113         pci_disable_device(pdev);
1114 out:
1115         pci_set_drvdata(pdev, NULL);
1116         return err;
1117 }
1118
1119
1120 static struct pci_driver saa9730_driver = {
1121         .name           = DRV_MODULE_NAME,
1122         .id_table       = saa9730_pci_tbl,
1123         .probe          = saa9730_init_one,
1124         .remove         = __devexit_p(saa9730_remove_one),
1125 };
1126
1127
1128 static int __init saa9730_init(void)
1129 {
1130         return pci_register_driver(&saa9730_driver);
1131 }
1132
1133 static void __exit saa9730_cleanup(void)
1134 {
1135         pci_unregister_driver(&saa9730_driver);
1136 }
1137
1138 module_init(saa9730_init);
1139 module_exit(saa9730_cleanup);
1140
1141 MODULE_AUTHOR("Ralf Baechle <ralf@linux-mips.org>");
1142 MODULE_DESCRIPTION("Philips SAA9730 ethernet driver");
1143 MODULE_LICENSE("GPL");