blob: b2acedbefa8ffb2b63413e1d097ce29c8ca085c2 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Ralf Baechle05d9c842005-11-09 17:10:05 +00002 * 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>
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 *
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 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070020 * SAA9730 ethernet driver.
21 *
22 * Changes:
Ralf Baechle05d9c842005-11-09 17:10:05 +000023 * Angelo Dell'Aera <buffer@antifork.org> : Conversion to the new PCI API
24 * (pci_driver).
25 * Conversion to spinlocks.
26 * Error handling fixes.
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 */
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>
Ralf Baechle05d9c842005-11-09 17:10:05 +000037#include <linux/types.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
39#include <asm/addrspace.h>
Ralf Baechle05d9c842005-11-09 17:10:05 +000040#include <asm/io.h>
41
Linus Torvalds1da177e2005-04-16 15:20:36 -070042#include <asm/mips-boards/prom.h>
43
44#include "saa9730.h"
45
46#ifdef LAN_SAA9730_DEBUG
47int lan_saa9730_debug = LAN_SAA9730_DEBUG;
48#else
49int lan_saa9730_debug;
50#endif
51
52#define DRV_MODULE_NAME "saa9730"
53
54static struct pci_device_id saa9730_pci_tbl[] = {
Ralf Baechle05d9c842005-11-09 17:10:05 +000055 { PCI_VENDOR_ID_PHILIPS, PCI_DEVICE_ID_PHILIPS_SAA9730,
Ralf Baechle62ff0d02005-11-09 16:44:02 +000056 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL },
Linus Torvalds1da177e2005-04-16 15:20:36 -070057 { 0, }
58};
59
60MODULE_DEVICE_TABLE(pci, saa9730_pci_tbl);
61
62/* Non-zero only if the current card is a PCI with BIOS-set IRQ. */
63static unsigned int pci_irq_line;
64
Linus Torvalds1da177e2005-04-16 15:20:36 -070065static void evm_saa9730_enable_lan_int(struct lan_saa9730_private *lp)
66{
Ralf Baechle05d9c842005-11-09 17:10:05 +000067 outl(readl(&lp->evm_saa9730_regs->InterruptBlock1) | EVM_LAN_INT,
Linus Torvalds1da177e2005-04-16 15:20:36 -070068 &lp->evm_saa9730_regs->InterruptBlock1);
Ralf Baechle05d9c842005-11-09 17:10:05 +000069 outl(readl(&lp->evm_saa9730_regs->InterruptStatus1) | EVM_LAN_INT,
Linus Torvalds1da177e2005-04-16 15:20:36 -070070 &lp->evm_saa9730_regs->InterruptStatus1);
Ralf Baechle05d9c842005-11-09 17:10:05 +000071 outl(readl(&lp->evm_saa9730_regs->InterruptEnable1) | EVM_LAN_INT |
Linus Torvalds1da177e2005-04-16 15:20:36 -070072 EVM_MASTER_EN, &lp->evm_saa9730_regs->InterruptEnable1);
73}
Ralf Baechle05d9c842005-11-09 17:10:05 +000074
Linus Torvalds1da177e2005-04-16 15:20:36 -070075static void evm_saa9730_disable_lan_int(struct lan_saa9730_private *lp)
76{
Ralf Baechle05d9c842005-11-09 17:10:05 +000077 outl(readl(&lp->evm_saa9730_regs->InterruptBlock1) & ~EVM_LAN_INT,
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 &lp->evm_saa9730_regs->InterruptBlock1);
Ralf Baechle05d9c842005-11-09 17:10:05 +000079 outl(readl(&lp->evm_saa9730_regs->InterruptEnable1) & ~EVM_LAN_INT,
Linus Torvalds1da177e2005-04-16 15:20:36 -070080 &lp->evm_saa9730_regs->InterruptEnable1);
81}
82
83static void evm_saa9730_clear_lan_int(struct lan_saa9730_private *lp)
84{
Ralf Baechle05d9c842005-11-09 17:10:05 +000085 outl(EVM_LAN_INT, &lp->evm_saa9730_regs->InterruptStatus1);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086}
87
88static void evm_saa9730_block_lan_int(struct lan_saa9730_private *lp)
89{
Ralf Baechle05d9c842005-11-09 17:10:05 +000090 outl(readl(&lp->evm_saa9730_regs->InterruptBlock1) & ~EVM_LAN_INT,
Linus Torvalds1da177e2005-04-16 15:20:36 -070091 &lp->evm_saa9730_regs->InterruptBlock1);
92}
93
94static void evm_saa9730_unblock_lan_int(struct lan_saa9730_private *lp)
95{
Ralf Baechle05d9c842005-11-09 17:10:05 +000096 outl(readl(&lp->evm_saa9730_regs->InterruptBlock1) | EVM_LAN_INT,
Linus Torvalds1da177e2005-04-16 15:20:36 -070097 &lp->evm_saa9730_regs->InterruptBlock1);
98}
99
Ralf Baechle05d9c842005-11-09 17:10:05 +0000100static void __attribute_used__ show_saa9730_regs(struct lan_saa9730_private *lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101{
102 int i, j;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000103 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]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 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",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000122 readl(&lp->evm_saa9730_regs->InterruptBlock1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700123 printk("lp->evm_saa9730_regs->InterruptStatus1 = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000124 readl(&lp->evm_saa9730_regs->InterruptStatus1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 printk("lp->evm_saa9730_regs->InterruptEnable1 = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000126 readl(&lp->evm_saa9730_regs->InterruptEnable1));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 printk("lp->lan_saa9730_regs->Ok2Use = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000128 readl(&lp->lan_saa9730_regs->Ok2Use));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 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",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000136 readl(&lp->lan_saa9730_regs->LanDmaCtl));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 printk("lp->lan_saa9730_regs->DmaStatus = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000138 readl(&lp->lan_saa9730_regs->DmaStatus));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139 printk("lp->lan_saa9730_regs->CamCtl = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000140 readl(&lp->lan_saa9730_regs->CamCtl));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 printk("lp->lan_saa9730_regs->TxCtl = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000142 readl(&lp->lan_saa9730_regs->TxCtl));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143 printk("lp->lan_saa9730_regs->TxStatus = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000144 readl(&lp->lan_saa9730_regs->TxStatus));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145 printk("lp->lan_saa9730_regs->RxCtl = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000146 readl(&lp->lan_saa9730_regs->RxCtl));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147 printk("lp->lan_saa9730_regs->RxStatus = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000148 readl(&lp->lan_saa9730_regs->RxStatus));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 for (i = 0; i < LAN_SAA9730_CAM_DWORDS; i++) {
Ralf Baechle05d9c842005-11-09 17:10:05 +0000150 outl(i, &lp->lan_saa9730_regs->CamAddress);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 printk("lp->lan_saa9730_regs->CamData = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000152 readl(&lp->lan_saa9730_regs->CamData));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153 }
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",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000180 readl(&lp->lan_saa9730_regs->DebugPCIMasterAddr));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181 printk("lp->lan_saa9730_regs->DebugLanTxStateMachine = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000182 readl(&lp->lan_saa9730_regs->DebugLanTxStateMachine));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 printk("lp->lan_saa9730_regs->DebugLanRxStateMachine = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000184 readl(&lp->lan_saa9730_regs->DebugLanRxStateMachine));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 printk("lp->lan_saa9730_regs->DebugLanTxFifoPointers = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000186 readl(&lp->lan_saa9730_regs->DebugLanTxFifoPointers));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187 printk("lp->lan_saa9730_regs->DebugLanRxFifoPointers = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000188 readl(&lp->lan_saa9730_regs->DebugLanRxFifoPointers));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 printk("lp->lan_saa9730_regs->DebugLanCtlStateMachine = %x\n",
Ralf Baechle05d9c842005-11-09 17:10:05 +0000190 readl(&lp->lan_saa9730_regs->DebugLanCtlStateMachine));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191}
192
193static 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
Ralf Baechle05d9c842005-11-09 17:10:05 +0000216static void lan_saa9730_free_buffers(struct pci_dev *pdev,
217 struct lan_saa9730_private *lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700218{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000219 pci_free_consistent(pdev, lp->buffer_size, lp->buffer_start,
220 lp->dma_addr);
221}
222
223static int lan_saa9730_allocate_buffers(struct pci_dev *pdev,
224 struct lan_saa9730_private *lp)
225{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226 void *Pa;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000227 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000244 /*
245 * Allocate all RX and TX packets in one chunk.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246 * The Rx and Tx packets must be PACKET_SIZE aligned.
247 */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000248 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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257
Ralf Baechle05d9c842005-11-09 17:10:05 +0000258 Pa = (void *)ALIGN((unsigned long)lp->buffer_start,
259 LAN_SAA9730_PACKET_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260
Ralf Baechle05d9c842005-11-09 17:10:05 +0000261 rxoffset = Pa - lp->buffer_start;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262
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);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000269 lp->RcvBuffer[i][j] = Pa;
270 Pa += LAN_SAA9730_PACKET_SIZE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 }
272 }
273
Ralf Baechle05d9c842005-11-09 17:10:05 +0000274 txoffset = Pa - lp->buffer_start;
275
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276 /* 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);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000282 lp->TxmBuffer[i][j] = Pa;
283 Pa += LAN_SAA9730_PACKET_SIZE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284 }
285 }
286
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000287 /*
288 * Set rx buffer A and rx buffer B to point to the first two buffer
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 * spaces.
290 */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000291 outl(lp->dma_addr + rxoffset,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 &lp->lan_saa9730_regs->RxBuffA);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000293 outl(lp->dma_addr + rxoffset +
294 LAN_SAA9730_PACKET_SIZE * LAN_SAA9730_RCV_Q_SIZE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 &lp->lan_saa9730_regs->RxBuffB);
296
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000297 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 * Set txm_buf_a and txm_buf_b to point to the first two buffer
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000299 * space
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000301 outl(lp->dma_addr + txoffset,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700302 &lp->lan_saa9730_regs->TxBuffA);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000303 outl(lp->dma_addr + txoffset +
304 LAN_SAA9730_PACKET_SIZE * LAN_SAA9730_TXM_Q_SIZE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305 &lp->lan_saa9730_regs->TxBuffB);
306
307 /* Set packet number */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000308 outl((lp->DmaRcvPackets << PK_COUNT_RX_A_SHF) |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 (lp->DmaRcvPackets << PK_COUNT_RX_B_SHF) |
310 (lp->DmaTxmPackets << PK_COUNT_TX_A_SHF) |
311 (lp->DmaTxmPackets << PK_COUNT_TX_B_SHF),
312 &lp->lan_saa9730_regs->PacketCount);
313
314 return 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000315
316out:
317 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318}
319
320static int lan_saa9730_cam_load(struct lan_saa9730_private *lp)
321{
322 unsigned int i;
323 unsigned char *NetworkAddress;
324
325 NetworkAddress = (unsigned char *) &lp->PhysicalAddress[0][0];
326
327 for (i = 0; i < LAN_SAA9730_CAM_DWORDS; i++) {
328 /* First set address to where data is written */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000329 outl(i, &lp->lan_saa9730_regs->CamAddress);
330 outl((NetworkAddress[0] << 24) | (NetworkAddress[1] << 16)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 | (NetworkAddress[2] << 8) | NetworkAddress[3],
332 &lp->lan_saa9730_regs->CamData);
333 NetworkAddress += 4;
334 }
335 return 0;
336}
337
338static int lan_saa9730_cam_init(struct net_device *dev)
339{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000340 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 unsigned int i;
342
343 /* Copy MAC-address into all entries. */
344 for (i = 0; i < LAN_SAA9730_CAM_ENTRIES; i++) {
345 memcpy((unsigned char *) lp->PhysicalAddress[i],
346 (unsigned char *) dev->dev_addr, 6);
347 }
348
349 return 0;
350}
351
352static int lan_saa9730_mii_init(struct lan_saa9730_private *lp)
353{
354 int i, l;
355
356 /* Check link status, spin here till station is not busy. */
357 i = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000358 while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) & MD_CA_BUSY) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359 i++;
360 if (i > 100) {
361 printk("Error: lan_saa9730_mii_init: timeout\n");
362 return -1;
363 }
364 mdelay(1); /* wait 1 ms. */
365 }
366
367 /* Now set the control and address register. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000368 outl(MD_CA_BUSY | PHY_STATUS | PHY_ADDRESS << MD_CA_PHY_SHF,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 &lp->lan_saa9730_regs->StationMgmtCtl);
370
371 /* check link status, spin here till station is not busy */
372 i = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000373 while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) & MD_CA_BUSY) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374 i++;
375 if (i > 100) {
376 printk("Error: lan_saa9730_mii_init: timeout\n");
377 return -1;
378 }
379 mdelay(1); /* wait 1 ms. */
380 }
381
382 /* Wait for 1 ms. */
383 mdelay(1);
384
385 /* Check the link status. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000386 if (readl(&lp->lan_saa9730_regs->StationMgmtData) &
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 PHY_STATUS_LINK_UP) {
388 /* Link is up. */
389 return 0;
390 } else {
391 /* Link is down, reset the PHY first. */
392
393 /* set PHY address = 'CONTROL' */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000394 outl(PHY_ADDRESS << MD_CA_PHY_SHF | MD_CA_WR | PHY_CONTROL,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 &lp->lan_saa9730_regs->StationMgmtCtl);
396
397 /* Wait for 1 ms. */
398 mdelay(1);
399
400 /* set 'CONTROL' = force reset and renegotiate */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000401 outl(PHY_CONTROL_RESET | PHY_CONTROL_AUTO_NEG |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402 PHY_CONTROL_RESTART_AUTO_NEG,
403 &lp->lan_saa9730_regs->StationMgmtData);
404
405 /* Wait for 50 ms. */
406 mdelay(50);
407
408 /* set 'BUSY' to start operation */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000409 outl(MD_CA_BUSY | PHY_ADDRESS << MD_CA_PHY_SHF | MD_CA_WR |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 PHY_CONTROL, &lp->lan_saa9730_regs->StationMgmtCtl);
411
412 /* await completion */
413 i = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000414 while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) &
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 MD_CA_BUSY) {
416 i++;
417 if (i > 100) {
418 printk
419 ("Error: lan_saa9730_mii_init: timeout\n");
420 return -1;
421 }
422 mdelay(1); /* wait 1 ms. */
423 }
424
425 /* Wait for 1 ms. */
426 mdelay(1);
427
428 for (l = 0; l < 2; l++) {
429 /* set PHY address = 'STATUS' */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000430 outl(MD_CA_BUSY | PHY_ADDRESS << MD_CA_PHY_SHF |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700431 PHY_STATUS,
432 &lp->lan_saa9730_regs->StationMgmtCtl);
433
434 /* await completion */
435 i = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000436 while (readl(&lp->lan_saa9730_regs->StationMgmtCtl) &
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437 MD_CA_BUSY) {
438 i++;
439 if (i > 100) {
440 printk
441 ("Error: lan_saa9730_mii_init: timeout\n");
442 return -1;
443 }
444 mdelay(1); /* wait 1 ms. */
445 }
446
447 /* wait for 3 sec. */
448 mdelay(3000);
449
450 /* check the link status */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000451 if (readl(&lp->lan_saa9730_regs->StationMgmtData) &
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 PHY_STATUS_LINK_UP) {
453 /* link is up */
454 break;
455 }
456 }
457 }
458
459 return 0;
460}
461
462static int lan_saa9730_control_init(struct lan_saa9730_private *lp)
463{
464 /* Initialize DMA control register. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000465 outl((LANMB_ANY << DMA_CTL_MAX_XFER_SHF) |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466 (LANEND_LITTLE << DMA_CTL_ENDIAN_SHF) |
467 (LAN_SAA9730_RCV_Q_INT_THRESHOLD << DMA_CTL_RX_INT_COUNT_SHF)
468 | DMA_CTL_RX_INT_TO_EN | DMA_CTL_RX_INT_EN |
469 DMA_CTL_MAC_RX_INT_EN | DMA_CTL_MAC_TX_INT_EN,
470 &lp->lan_saa9730_regs->LanDmaCtl);
471
472 /* Initial MAC control register. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000473 outl((MACCM_MII << MAC_CONTROL_CONN_SHF) | MAC_CONTROL_FULL_DUP,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 &lp->lan_saa9730_regs->MacCtl);
475
476 /* Initialize CAM control register. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000477 outl(CAM_CONTROL_COMP_EN | CAM_CONTROL_BROAD_ACC,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 &lp->lan_saa9730_regs->CamCtl);
479
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000480 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 * Initialize CAM enable register, only turn on first entry, should
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000482 * contain own addr.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483 */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000484 outl(0x0001, &lp->lan_saa9730_regs->CamEnable);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485
486 /* Initialize Tx control register */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000487 outl(TX_CTL_EN_COMP, &lp->lan_saa9730_regs->TxCtl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488
489 /* Initialize Rcv control register */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000490 outl(RX_CTL_STRIP_CRC, &lp->lan_saa9730_regs->RxCtl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491
492 /* Reset DMA engine */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000493 outl(DMA_TEST_SW_RESET, &lp->lan_saa9730_regs->DmaTest);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494
495 return 0;
496}
497
498static int lan_saa9730_stop(struct lan_saa9730_private *lp)
499{
500 int i;
501
502 /* Stop DMA first */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000503 outl(readl(&lp->lan_saa9730_regs->LanDmaCtl) &
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504 ~(DMA_CTL_EN_TX_DMA | DMA_CTL_EN_RX_DMA),
505 &lp->lan_saa9730_regs->LanDmaCtl);
506
507 /* Set the SW Reset bits in DMA and MAC control registers */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000508 outl(DMA_TEST_SW_RESET, &lp->lan_saa9730_regs->DmaTest);
509 outl(readl(&lp->lan_saa9730_regs->MacCtl) | MAC_CONTROL_RESET,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 &lp->lan_saa9730_regs->MacCtl);
511
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000512 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513 * Wait for MAC reset to have finished. The reset bit is auto cleared
514 * when the reset is done.
515 */
516 i = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000517 while (readl(&lp->lan_saa9730_regs->MacCtl) & MAC_CONTROL_RESET) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 i++;
519 if (i > 100) {
520 printk
521 ("Error: lan_sa9730_stop: MAC reset timeout\n");
522 return -1;
523 }
524 mdelay(1); /* wait 1 ms. */
525 }
526
527 return 0;
528}
529
530static int lan_saa9730_dma_init(struct lan_saa9730_private *lp)
531{
532 /* Stop lan controller. */
533 lan_saa9730_stop(lp);
534
Ralf Baechle05d9c842005-11-09 17:10:05 +0000535 outl(LAN_SAA9730_DEFAULT_TIME_OUT_CNT,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 &lp->lan_saa9730_regs->Timeout);
537
538 return 0;
539}
540
541static int lan_saa9730_start(struct lan_saa9730_private *lp)
542{
543 lan_saa9730_buffer_init(lp);
544
545 /* Initialize Rx Buffer Index */
546 lp->NextRcvPacketIndex = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000547 lp->NextRcvBufferIndex = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700548
Ralf Baechle05d9c842005-11-09 17:10:05 +0000549 /* Set current buffer index & next available packet index */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 lp->NextTxmPacketIndex = 0;
551 lp->NextTxmBufferIndex = 0;
552 lp->PendingTxmPacketIndex = 0;
553 lp->PendingTxmBufferIndex = 0;
554
Ralf Baechle05d9c842005-11-09 17:10:05 +0000555 outl(readl(&lp->lan_saa9730_regs->LanDmaCtl) | DMA_CTL_EN_TX_DMA |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 DMA_CTL_EN_RX_DMA, &lp->lan_saa9730_regs->LanDmaCtl);
557
558 /* For Tx, turn on MAC then DMA */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000559 outl(readl(&lp->lan_saa9730_regs->TxCtl) | TX_CTL_TX_EN,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560 &lp->lan_saa9730_regs->TxCtl);
561
562 /* For Rx, turn on DMA then MAC */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000563 outl(readl(&lp->lan_saa9730_regs->RxCtl) | RX_CTL_RX_EN,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 &lp->lan_saa9730_regs->RxCtl);
565
Ralf Baechle05d9c842005-11-09 17:10:05 +0000566 /* Set Ok2Use to let hardware own the buffers. */
567 outl(OK2USE_RX_A | OK2USE_RX_B, &lp->lan_saa9730_regs->Ok2Use);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568
569 return 0;
570}
571
572static int lan_saa9730_restart(struct lan_saa9730_private *lp)
573{
574 lan_saa9730_stop(lp);
575 lan_saa9730_start(lp);
576
577 return 0;
578}
579
580static int lan_saa9730_tx(struct net_device *dev)
581{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000582 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 unsigned int *pPacket;
584 unsigned int tx_status;
585
586 if (lan_saa9730_debug > 5)
587 printk("lan_saa9730_tx interrupt\n");
588
589 /* Clear interrupt. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000590 outl(DMA_STATUS_MAC_TX_INT, &lp->lan_saa9730_regs->DmaStatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591
592 while (1) {
Ralf Baechle05d9c842005-11-09 17:10:05 +0000593 pPacket = lp->TxmBuffer[lp->PendingTxmBufferIndex]
594 [lp->PendingTxmPacketIndex];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595
596 /* Get status of first packet transmitted. */
597 tx_status = le32_to_cpu(*pPacket);
598
599 /* Check ownership. */
600 if ((tx_status & TX_STAT_CTL_OWNER_MSK) !=
601 (TXSF_HWDONE << TX_STAT_CTL_OWNER_SHF)) break;
602
603 /* Check for error. */
604 if (tx_status & TX_STAT_CTL_ERROR_MSK) {
605 if (lan_saa9730_debug > 1)
606 printk("lan_saa9730_tx: tx error = %x\n",
607 tx_status);
608
609 lp->stats.tx_errors++;
610 if (tx_status &
611 (TX_STATUS_EX_COLL << TX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000612 lp->stats.tx_aborted_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613 if (tx_status &
Ralf Baechle05d9c842005-11-09 17:10:05 +0000614 (TX_STATUS_LATE_COLL << TX_STAT_CTL_STATUS_SHF))
615 lp->stats.tx_window_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700616 if (tx_status &
617 (TX_STATUS_L_CARR << TX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000618 lp->stats.tx_carrier_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619 if (tx_status &
620 (TX_STATUS_UNDER << TX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000621 lp->stats.tx_fifo_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622 if (tx_status &
623 (TX_STATUS_SQ_ERR << TX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000624 lp->stats.tx_heartbeat_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625
626 lp->stats.collisions +=
Ralf Baechle05d9c842005-11-09 17:10:05 +0000627 tx_status & TX_STATUS_TX_COLL_MSK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 }
629
630 /* Free buffer. */
631 *pPacket =
632 cpu_to_le32(TXSF_EMPTY << TX_STAT_CTL_OWNER_SHF);
633
634 /* Update pending index pointer. */
635 lp->PendingTxmPacketIndex++;
636 if (lp->PendingTxmPacketIndex >= LAN_SAA9730_TXM_Q_SIZE) {
637 lp->PendingTxmPacketIndex = 0;
638 lp->PendingTxmBufferIndex ^= 1;
639 }
640 }
641
Ralf Baechle05d9c842005-11-09 17:10:05 +0000642 /* The tx buffer is no longer full. */
643 netif_wake_queue(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644
645 return 0;
646}
647
648static int lan_saa9730_rx(struct net_device *dev)
649{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000650 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 int len = 0;
652 struct sk_buff *skb = 0;
653 unsigned int rx_status;
654 int BufferIndex;
655 int PacketIndex;
656 unsigned int *pPacket;
657 unsigned char *pData;
658
659 if (lan_saa9730_debug > 5)
660 printk("lan_saa9730_rx interrupt\n");
661
662 /* Clear receive interrupts. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000663 outl(DMA_STATUS_MAC_RX_INT | DMA_STATUS_RX_INT |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664 DMA_STATUS_RX_TO_INT, &lp->lan_saa9730_regs->DmaStatus);
665
666 /* Address next packet */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000667 BufferIndex = lp->NextRcvBufferIndex;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668 PacketIndex = lp->NextRcvPacketIndex;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000669 pPacket = lp->RcvBuffer[BufferIndex][PacketIndex];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 rx_status = le32_to_cpu(*pPacket);
671
672 /* Process each packet. */
673 while ((rx_status & RX_STAT_CTL_OWNER_MSK) ==
674 (RXSF_HWDONE << RX_STAT_CTL_OWNER_SHF)) {
675 /* Check the rx status. */
676 if (rx_status & (RX_STATUS_GOOD << RX_STAT_CTL_STATUS_SHF)) {
677 /* Received packet is good. */
678 len = (rx_status & RX_STAT_CTL_LENGTH_MSK) >>
679 RX_STAT_CTL_LENGTH_SHF;
680
681 pData = (unsigned char *) pPacket;
682 pData += 4;
683 skb = dev_alloc_skb(len + 2);
684 if (skb == 0) {
685 printk
686 ("%s: Memory squeeze, deferring packet.\n",
687 dev->name);
688 lp->stats.rx_dropped++;
689 } else {
690 lp->stats.rx_bytes += len;
691 lp->stats.rx_packets++;
692 skb->dev = dev;
693 skb_reserve(skb, 2); /* 16 byte align */
694 skb_put(skb, len); /* make room */
695 eth_copy_and_sum(skb,
696 (unsigned char *) pData,
697 len, 0);
698 skb->protocol = eth_type_trans(skb, dev);
699 netif_rx(skb);
700 dev->last_rx = jiffies;
701 }
702 } else {
703 /* We got an error packet. */
704 if (lan_saa9730_debug > 2)
705 printk
706 ("lan_saa9730_rx: We got an error packet = %x\n",
707 rx_status);
708
709 lp->stats.rx_errors++;
710 if (rx_status &
711 (RX_STATUS_CRC_ERR << RX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000712 lp->stats.rx_crc_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713 if (rx_status &
Ralf Baechle05d9c842005-11-09 17:10:05 +0000714 (RX_STATUS_ALIGN_ERR << RX_STAT_CTL_STATUS_SHF))
715 lp->stats.rx_frame_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 if (rx_status &
717 (RX_STATUS_OVERFLOW << RX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000718 lp->stats.rx_fifo_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 if (rx_status &
720 (RX_STATUS_LONG_ERR << RX_STAT_CTL_STATUS_SHF))
Ralf Baechle05d9c842005-11-09 17:10:05 +0000721 lp->stats.rx_length_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722 }
723
724 /* Indicate we have processed the buffer. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000725 *pPacket = cpu_to_le32(RXSF_READY << RX_STAT_CTL_OWNER_SHF);
726
727 /* Make sure A or B is available to hardware as appropriate. */
728 outl(BufferIndex ? OK2USE_RX_B : OK2USE_RX_A,
729 &lp->lan_saa9730_regs->Ok2Use);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730
731 /* Go to next packet in sequence. */
732 lp->NextRcvPacketIndex++;
733 if (lp->NextRcvPacketIndex >= LAN_SAA9730_RCV_Q_SIZE) {
734 lp->NextRcvPacketIndex = 0;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000735 lp->NextRcvBufferIndex ^= 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737
738 /* Address next packet */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000739 BufferIndex = lp->NextRcvBufferIndex;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700740 PacketIndex = lp->NextRcvPacketIndex;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000741 pPacket = lp->RcvBuffer[BufferIndex][PacketIndex];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742 rx_status = le32_to_cpu(*pPacket);
743 }
744
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745 return 0;
746}
747
748static irqreturn_t lan_saa9730_interrupt(const int irq, void *dev_id,
749 struct pt_regs *regs)
750{
751 struct net_device *dev = (struct net_device *) dev_id;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000752 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753
754 if (lan_saa9730_debug > 5)
755 printk("lan_saa9730_interrupt\n");
756
757 /* Disable the EVM LAN interrupt. */
758 evm_saa9730_block_lan_int(lp);
759
760 /* Clear the EVM LAN interrupt. */
761 evm_saa9730_clear_lan_int(lp);
762
763 /* Service pending transmit interrupts. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000764 if (readl(&lp->lan_saa9730_regs->DmaStatus) & DMA_STATUS_MAC_TX_INT)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765 lan_saa9730_tx(dev);
766
767 /* Service pending receive interrupts. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000768 if (readl(&lp->lan_saa9730_regs->DmaStatus) &
Linus Torvalds1da177e2005-04-16 15:20:36 -0700769 (DMA_STATUS_MAC_RX_INT | DMA_STATUS_RX_INT |
770 DMA_STATUS_RX_TO_INT)) lan_saa9730_rx(dev);
771
772 /* Enable the EVM LAN interrupt. */
773 evm_saa9730_unblock_lan_int(lp);
774
775 return IRQ_HANDLED;
776}
777
Linus Torvalds1da177e2005-04-16 15:20:36 -0700778static int lan_saa9730_open(struct net_device *dev)
779{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000780 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781
782 /* Associate IRQ with lan_saa9730_interrupt */
783 if (request_irq(dev->irq, &lan_saa9730_interrupt, 0, "SAA9730 Eth",
784 dev)) {
785 printk("lan_saa9730_open: Can't get irq %d\n", dev->irq);
786 return -EAGAIN;
787 }
788
789 /* Enable the Lan interrupt in the event manager. */
790 evm_saa9730_enable_lan_int(lp);
791
792 /* Start the LAN controller */
793 if (lan_saa9730_start(lp))
794 return -1;
795
796 netif_start_queue(dev);
797
798 return 0;
799}
800
801static int lan_saa9730_write(struct lan_saa9730_private *lp,
802 struct sk_buff *skb, int skblen)
803{
804 unsigned char *pbData = skb->data;
805 unsigned int len = skblen;
806 unsigned char *pbPacketData;
807 unsigned int tx_status;
808 int BufferIndex;
809 int PacketIndex;
810
811 if (lan_saa9730_debug > 5)
Ralf Baechle05d9c842005-11-09 17:10:05 +0000812 printk("lan_saa9730_write: skb=%p\n", skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813
814 BufferIndex = lp->NextTxmBufferIndex;
815 PacketIndex = lp->NextTxmPacketIndex;
816
Ralf Baechle05d9c842005-11-09 17:10:05 +0000817 tx_status = le32_to_cpu(*(unsigned int *)lp->TxmBuffer[BufferIndex]
818 [PacketIndex]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819 if ((tx_status & TX_STAT_CTL_OWNER_MSK) !=
820 (TXSF_EMPTY << TX_STAT_CTL_OWNER_SHF)) {
821 if (lan_saa9730_debug > 4)
822 printk
823 ("lan_saa9730_write: Tx buffer not available: tx_status = %x\n",
824 tx_status);
825 return -1;
826 }
827
828 lp->NextTxmPacketIndex++;
829 if (lp->NextTxmPacketIndex >= LAN_SAA9730_TXM_Q_SIZE) {
830 lp->NextTxmPacketIndex = 0;
831 lp->NextTxmBufferIndex ^= 1;
832 }
833
Ralf Baechle05d9c842005-11-09 17:10:05 +0000834 pbPacketData = lp->TxmBuffer[BufferIndex][PacketIndex];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 pbPacketData += 4;
836
837 /* copy the bits */
838 memcpy(pbPacketData, pbData, len);
839
840 /* Set transmit status for hardware */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000841 *(unsigned int *)lp->TxmBuffer[BufferIndex][PacketIndex] =
842 cpu_to_le32((TXSF_READY << TX_STAT_CTL_OWNER_SHF) |
843 (TX_STAT_CTL_INT_AFTER_TX <<
844 TX_STAT_CTL_FRAME_SHF) |
845 (len << TX_STAT_CTL_LENGTH_SHF));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700846
Ralf Baechle05d9c842005-11-09 17:10:05 +0000847 /* Make sure A or B is available to hardware as appropriate. */
848 outl(BufferIndex ? OK2USE_TX_B : OK2USE_TX_A,
849 &lp->lan_saa9730_regs->Ok2Use);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850
851 return 0;
852}
853
854static void lan_saa9730_tx_timeout(struct net_device *dev)
855{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000856 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857
858 /* Transmitter timeout, serious problems */
859 lp->stats.tx_errors++;
860 printk("%s: transmit timed out, reset\n", dev->name);
861 /*show_saa9730_regs(lp); */
862 lan_saa9730_restart(lp);
863
864 dev->trans_start = jiffies;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000865 netif_wake_queue(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700866}
867
868static int lan_saa9730_start_xmit(struct sk_buff *skb,
869 struct net_device *dev)
870{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000871 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700872 unsigned long flags;
873 int skblen;
874 int len;
875
876 if (lan_saa9730_debug > 4)
Ralf Baechle05d9c842005-11-09 17:10:05 +0000877 printk("Send packet: skb=%p\n", skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700878
879 skblen = skb->len;
880
881 spin_lock_irqsave(&lp->lock, flags);
882
883 len = (skblen <= ETH_ZLEN) ? ETH_ZLEN : skblen;
884
885 if (lan_saa9730_write(lp, skb, skblen)) {
886 spin_unlock_irqrestore(&lp->lock, flags);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000887 printk("Error when writing packet to controller: skb=%p\n", skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888 netif_stop_queue(dev);
889 return -1;
890 }
891
892 lp->stats.tx_bytes += len;
893 lp->stats.tx_packets++;
894
895 dev->trans_start = jiffies;
Ralf Baechle05d9c842005-11-09 17:10:05 +0000896 netif_wake_queue(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700897 dev_kfree_skb(skb);
898
899 spin_unlock_irqrestore(&lp->lock, flags);
900
901 return 0;
902}
903
904static int lan_saa9730_close(struct net_device *dev)
905{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000906 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907
908 if (lan_saa9730_debug > 1)
909 printk("lan_saa9730_close:\n");
910
911 netif_stop_queue(dev);
912
913 /* Disable the Lan interrupt in the event manager. */
914 evm_saa9730_disable_lan_int(lp);
915
916 /* Stop the controller */
917 if (lan_saa9730_stop(lp))
918 return -1;
919
920 free_irq(dev->irq, (void *) dev);
921
922 return 0;
923}
924
925static struct net_device_stats *lan_saa9730_get_stats(struct net_device
926 *dev)
927{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000928 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700929
930 return &lp->stats;
931}
932
933static void lan_saa9730_set_multicast(struct net_device *dev)
934{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000935 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936
937 /* Stop the controller */
938 lan_saa9730_stop(lp);
939
940 if (dev->flags & IFF_PROMISC) {
941 /* accept all packets */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000942 outl(CAM_CONTROL_COMP_EN | CAM_CONTROL_STATION_ACC |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700943 CAM_CONTROL_GROUP_ACC | CAM_CONTROL_BROAD_ACC,
944 &lp->lan_saa9730_regs->CamCtl);
945 } else {
946 if (dev->flags & IFF_ALLMULTI) {
947 /* accept all multicast packets */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000948 outl(CAM_CONTROL_COMP_EN | CAM_CONTROL_GROUP_ACC |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700949 CAM_CONTROL_BROAD_ACC,
950 &lp->lan_saa9730_regs->CamCtl);
951 } else {
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000952 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953 * Will handle the multicast stuff later. -carstenl
954 */
955 }
956 }
957
958 lan_saa9730_restart(lp);
959}
960
961
962static void __devexit saa9730_remove_one(struct pci_dev *pdev)
963{
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000964 struct net_device *dev = pci_get_drvdata(pdev);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000965 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000967 if (dev) {
968 unregister_netdev(dev);
Ralf Baechle05d9c842005-11-09 17:10:05 +0000969 lan_saa9730_free_buffers(pdev, lp);
970 iounmap(lp->lan_saa9730_regs);
971 iounmap(lp->evm_saa9730_regs);
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000972 free_netdev(dev);
973 pci_release_regions(pdev);
974 pci_disable_device(pdev);
975 pci_set_drvdata(pdev, NULL);
976 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700977}
978
979
Ralf Baechle05d9c842005-11-09 17:10:05 +0000980static int lan_saa9730_init(struct net_device *dev, struct pci_dev *pdev,
981 unsigned long ioaddr, int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982{
Ralf Baechle05d9c842005-11-09 17:10:05 +0000983 struct lan_saa9730_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984 unsigned char ethernet_addr[6];
Ralf Baechle05d9c842005-11-09 17:10:05 +0000985 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986
Ralf Baechle05d9c842005-11-09 17:10:05 +0000987 if (get_ethernet_addr(ethernet_addr)) {
988 ret = -ENODEV;
989 goto out;
990 }
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000991
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992 memcpy(dev->dev_addr, ethernet_addr, 6);
993 dev->base_addr = ioaddr;
994 dev->irq = irq;
Ralf Baechle62ff0d02005-11-09 16:44:02 +0000995
Ralf Baechle05d9c842005-11-09 17:10:05 +0000996 lp->pci_dev = pdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997
998 /* Set SAA9730 LAN base address. */
Ralf Baechle05d9c842005-11-09 17:10:05 +0000999 lp->lan_saa9730_regs = ioremap(ioaddr + SAA9730_LAN_REGS_ADDR,
1000 SAA9730_LAN_REGS_SIZE);
1001 if (!lp->lan_saa9730_regs) {
1002 ret = -ENOMEM;
1003 goto out;
1004 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005
1006 /* Set SAA9730 EVM base address. */
Ralf Baechle05d9c842005-11-09 17:10:05 +00001007 lp->evm_saa9730_regs = ioremap(ioaddr + SAA9730_EVM_REGS_ADDR,
1008 SAA9730_EVM_REGS_SIZE);
1009 if (!lp->evm_saa9730_regs) {
1010 ret = -ENOMEM;
1011 goto out_iounmap_lan;
1012 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001013
1014 /* Allocate LAN RX/TX frame buffer space. */
Ralf Baechle05d9c842005-11-09 17:10:05 +00001015 if ((ret = lan_saa9730_allocate_buffers(pdev, lp)))
1016 goto out_iounmap;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001017
1018 /* Stop LAN controller. */
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001019 if ((ret = lan_saa9730_stop(lp)))
Ralf Baechle05d9c842005-11-09 17:10:05 +00001020 goto out_free_consistent;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001021
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022 /* Initialize CAM registers. */
1023 if ((ret = lan_saa9730_cam_init(dev)))
Ralf Baechle05d9c842005-11-09 17:10:05 +00001024 goto out_free_consistent;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025
1026 /* Initialize MII registers. */
1027 if ((ret = lan_saa9730_mii_init(lp)))
Ralf Baechle05d9c842005-11-09 17:10:05 +00001028 goto out_free_consistent;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001029
1030 /* Initialize control registers. */
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001031 if ((ret = lan_saa9730_control_init(lp)))
Ralf Baechle05d9c842005-11-09 17:10:05 +00001032 goto out_free_consistent;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001033
Linus Torvalds1da177e2005-04-16 15:20:36 -07001034 /* Load CAM registers. */
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001035 if ((ret = lan_saa9730_cam_load(lp)))
Ralf Baechle05d9c842005-11-09 17:10:05 +00001036 goto out_free_consistent;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001037
Linus Torvalds1da177e2005-04-16 15:20:36 -07001038 /* Initialize DMA context registers. */
1039 if ((ret = lan_saa9730_dma_init(lp)))
Ralf Baechle05d9c842005-11-09 17:10:05 +00001040 goto out_free_consistent;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001041
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042 spin_lock_init(&lp->lock);
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001043
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044 dev->open = lan_saa9730_open;
1045 dev->hard_start_xmit = lan_saa9730_start_xmit;
1046 dev->stop = lan_saa9730_close;
1047 dev->get_stats = lan_saa9730_get_stats;
1048 dev->set_multicast_list = lan_saa9730_set_multicast;
1049 dev->tx_timeout = lan_saa9730_tx_timeout;
1050 dev->watchdog_timeo = (HZ >> 1);
1051 dev->dma = 0;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001052
Ralf Baechle05d9c842005-11-09 17:10:05 +00001053 ret = register_netdev (dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054 if (ret)
Ralf Baechle05d9c842005-11-09 17:10:05 +00001055 goto out_free_consistent;
1056
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 return 0;
1058
Ralf Baechle05d9c842005-11-09 17:10:05 +00001059out_free_consistent:
1060 lan_saa9730_free_buffers(pdev, lp);
1061out_iounmap:
1062 iounmap(lp->evm_saa9730_regs);
1063out_iounmap_lan:
1064 iounmap(lp->lan_saa9730_regs);
1065out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066 return ret;
1067}
1068
1069
1070static int __devinit saa9730_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
1071{
Ralf Baechle05d9c842005-11-09 17:10:05 +00001072 struct net_device *dev = NULL;
1073 unsigned long pci_ioaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 int err;
1075
1076 if (lan_saa9730_debug > 1)
1077 printk("saa9730.c: PCI bios is present, checking for devices...\n");
1078
Linus Torvalds1da177e2005-04-16 15:20:36 -07001079 err = pci_enable_device(pdev);
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001080 if (err) {
1081 printk(KERN_ERR "Cannot enable PCI device, aborting.\n");
Ralf Baechle05d9c842005-11-09 17:10:05 +00001082 goto out;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001083 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084
1085 err = pci_request_regions(pdev, DRV_MODULE_NAME);
1086 if (err) {
1087 printk(KERN_ERR "Cannot obtain PCI resources, aborting.\n");
Ralf Baechle05d9c842005-11-09 17:10:05 +00001088 goto out_disable_pdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089 }
1090
1091 pci_irq_line = pdev->irq;
1092 /* LAN base address in located at BAR 1. */
1093
1094 pci_ioaddr = pci_resource_start(pdev, 1);
1095 pci_set_master(pdev);
1096
Ralf Baechle05d9c842005-11-09 17:10:05 +00001097 printk("Found SAA9730 (PCI) at %lx, irq %d.\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001098 pci_ioaddr, pci_irq_line);
1099
Ralf Baechle05d9c842005-11-09 17:10:05 +00001100 dev = alloc_etherdev(sizeof(struct lan_saa9730_private));
1101 if (!dev)
1102 goto out_disable_pdev;
1103
1104 err = lan_saa9730_init(dev, pdev, pci_ioaddr, pci_irq_line);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001105 if (err) {
Ralf Baechle05d9c842005-11-09 17:10:05 +00001106 printk("LAN init failed");
1107 goto out_free_netdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001108 }
1109
1110 pci_set_drvdata(pdev, dev);
1111 SET_NETDEV_DEV(dev, &pdev->dev);
1112 return 0;
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001113
Ralf Baechle05d9c842005-11-09 17:10:05 +00001114out_free_netdev:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115 free_netdev(dev);
Ralf Baechle05d9c842005-11-09 17:10:05 +00001116out_disable_pdev:
1117 pci_disable_device(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118out:
Ralf Baechle05d9c842005-11-09 17:10:05 +00001119 pci_set_drvdata(pdev, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001120 return err;
1121}
1122
1123
1124static struct pci_driver saa9730_driver = {
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001125 .name = DRV_MODULE_NAME,
1126 .id_table = saa9730_pci_tbl,
1127 .probe = saa9730_init_one,
1128 .remove = __devexit_p(saa9730_remove_one),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001129};
1130
1131
1132static int __init saa9730_init(void)
1133{
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001134 return pci_module_init(&saa9730_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001135}
1136
1137static void __exit saa9730_cleanup(void)
1138{
Ralf Baechle62ff0d02005-11-09 16:44:02 +00001139 pci_unregister_driver(&saa9730_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001140}
1141
1142module_init(saa9730_init);
1143module_exit(saa9730_cleanup);
1144
Ralf Baechle05d9c842005-11-09 17:10:05 +00001145MODULE_AUTHOR("Ralf Baechle <ralf@linux-mips.org>");
1146MODULE_DESCRIPTION("Philips SAA9730 ethernet driver");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001147MODULE_LICENSE("GPL");