2 * ks8842.c timberdale KS8842 ethernet driver
3 * Copyright (c) 2009 Intel Corporation
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 * The Micrel KS8842 behind the timberdale FPGA
21 * The genuine Micrel KS8841/42 device with ISA 16/32bit bus interface
24 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/platform_device.h>
29 #include <linux/netdevice.h>
30 #include <linux/etherdevice.h>
31 #include <linux/ethtool.h>
32 #include <linux/ks8842.h>
34 #define DRV_NAME "ks8842"
36 /* Timberdale specific Registers */
37 #define REG_TIMB_RST 0x1c
39 /* KS8842 registers */
41 #define REG_SELECT_BANK 0x0e
43 /* bank 0 registers */
44 #define REG_QRFCR 0x04
46 /* bank 2 registers */
51 /* bank 3 registers */
54 /* bank 16 registers */
58 #define REG_TXMIR 0x08
59 #define REG_RXMIR 0x0A
61 /* bank 17 registers */
62 #define REG_TXQCR 0x00
63 #define REG_RXQCR 0x02
64 #define REG_TXFDPR 0x04
65 #define REG_RXFDPR 0x06
66 #define REG_QMU_DATA_LO 0x08
67 #define REG_QMU_DATA_HI 0x0A
69 /* bank 18 registers */
71 #define IRQ_LINK_CHANGE 0x8000
74 #define IRQ_RX_OVERRUN 0x0800
75 #define IRQ_TX_STOPPED 0x0200
76 #define IRQ_RX_STOPPED 0x0100
77 #define IRQ_RX_ERROR 0x0080
78 #define ENABLED_IRQS (IRQ_LINK_CHANGE | IRQ_TX | IRQ_RX | IRQ_RX_STOPPED | \
79 IRQ_TX_STOPPED | IRQ_RX_OVERRUN | IRQ_RX_ERROR)
82 #define RXSR_VALID 0x8000
83 #define RXSR_BROADCAST 0x80
84 #define RXSR_MULTICAST 0x40
85 #define RXSR_UNICAST 0x20
86 #define RXSR_FRAMETYPE 0x08
87 #define RXSR_TOO_LONG 0x04
88 #define RXSR_RUNT 0x02
89 #define RXSR_CRC_ERROR 0x01
90 #define RXSR_ERROR (RXSR_TOO_LONG | RXSR_RUNT | RXSR_CRC_ERROR)
92 /* bank 32 registers */
93 #define REG_SW_ID_AND_ENABLE 0x00
94 #define REG_SGCR1 0x02
95 #define REG_SGCR2 0x04
96 #define REG_SGCR3 0x06
98 /* bank 39 registers */
99 #define REG_MACAR1 0x00
100 #define REG_MACAR2 0x02
101 #define REG_MACAR3 0x04
103 /* bank 45 registers */
104 #define REG_P1MBCR 0x00
105 #define REG_P1MBSR 0x02
107 /* bank 46 registers */
108 #define REG_P2MBCR 0x00
109 #define REG_P2MBSR 0x02
111 /* bank 48 registers */
112 #define REG_P1CR2 0x02
114 /* bank 49 registers */
115 #define REG_P1CR4 0x02
116 #define REG_P1SR 0x04
118 /* flags passed by platform_device for configuration */
119 #define MICREL_KS884X 0x01 /* 0=Timeberdale(FPGA), 1=Micrel */
120 #define KS884X_16BIT 0x02 /* 1=16bit, 0=32bit */
122 struct ks8842_adapter
{
123 void __iomem
*hw_addr
;
125 unsigned long conf_flags
; /* copy of platform_device config */
126 struct tasklet_struct tasklet
;
127 spinlock_t lock
; /* spinlock to be interrupt safe */
128 struct work_struct timeout_work
;
129 struct net_device
*netdev
;
132 static inline void ks8842_select_bank(struct ks8842_adapter
*adapter
, u16 bank
)
134 iowrite16(bank
, adapter
->hw_addr
+ REG_SELECT_BANK
);
137 static inline void ks8842_write8(struct ks8842_adapter
*adapter
, u16 bank
,
138 u8 value
, int offset
)
140 ks8842_select_bank(adapter
, bank
);
141 iowrite8(value
, adapter
->hw_addr
+ offset
);
144 static inline void ks8842_write16(struct ks8842_adapter
*adapter
, u16 bank
,
145 u16 value
, int offset
)
147 ks8842_select_bank(adapter
, bank
);
148 iowrite16(value
, adapter
->hw_addr
+ offset
);
151 static inline void ks8842_enable_bits(struct ks8842_adapter
*adapter
, u16 bank
,
152 u16 bits
, int offset
)
155 ks8842_select_bank(adapter
, bank
);
156 reg
= ioread16(adapter
->hw_addr
+ offset
);
158 iowrite16(reg
, adapter
->hw_addr
+ offset
);
161 static inline void ks8842_clear_bits(struct ks8842_adapter
*adapter
, u16 bank
,
162 u16 bits
, int offset
)
165 ks8842_select_bank(adapter
, bank
);
166 reg
= ioread16(adapter
->hw_addr
+ offset
);
168 iowrite16(reg
, adapter
->hw_addr
+ offset
);
171 static inline void ks8842_write32(struct ks8842_adapter
*adapter
, u16 bank
,
172 u32 value
, int offset
)
174 ks8842_select_bank(adapter
, bank
);
175 iowrite32(value
, adapter
->hw_addr
+ offset
);
178 static inline u8
ks8842_read8(struct ks8842_adapter
*adapter
, u16 bank
,
181 ks8842_select_bank(adapter
, bank
);
182 return ioread8(adapter
->hw_addr
+ offset
);
185 static inline u16
ks8842_read16(struct ks8842_adapter
*adapter
, u16 bank
,
188 ks8842_select_bank(adapter
, bank
);
189 return ioread16(adapter
->hw_addr
+ offset
);
192 static inline u32
ks8842_read32(struct ks8842_adapter
*adapter
, u16 bank
,
195 ks8842_select_bank(adapter
, bank
);
196 return ioread32(adapter
->hw_addr
+ offset
);
199 static void ks8842_reset(struct ks8842_adapter
*adapter
)
201 if (adapter
->conf_flags
& MICREL_KS884X
) {
202 ks8842_write16(adapter
, 3, 1, REG_GRR
);
204 iowrite16(0, adapter
->hw_addr
+ REG_GRR
);
206 /* The KS8842 goes haywire when doing softare reset
207 * a work around in the timberdale IP is implemented to
208 * do a hardware reset instead
209 ks8842_write16(adapter, 3, 1, REG_GRR);
211 iowrite16(0, adapter->hw_addr + REG_GRR);
213 iowrite32(0x1, adapter
->hw_addr
+ REG_TIMB_RST
);
218 static void ks8842_update_link_status(struct net_device
*netdev
,
219 struct ks8842_adapter
*adapter
)
221 /* check the status of the link */
222 if (ks8842_read16(adapter
, 45, REG_P1MBSR
) & 0x4) {
223 netif_carrier_on(netdev
);
224 netif_wake_queue(netdev
);
226 netif_stop_queue(netdev
);
227 netif_carrier_off(netdev
);
231 static void ks8842_enable_tx(struct ks8842_adapter
*adapter
)
233 ks8842_enable_bits(adapter
, 16, 0x01, REG_TXCR
);
236 static void ks8842_disable_tx(struct ks8842_adapter
*adapter
)
238 ks8842_clear_bits(adapter
, 16, 0x01, REG_TXCR
);
241 static void ks8842_enable_rx(struct ks8842_adapter
*adapter
)
243 ks8842_enable_bits(adapter
, 16, 0x01, REG_RXCR
);
246 static void ks8842_disable_rx(struct ks8842_adapter
*adapter
)
248 ks8842_clear_bits(adapter
, 16, 0x01, REG_RXCR
);
251 static void ks8842_reset_hw(struct ks8842_adapter
*adapter
)
254 ks8842_reset(adapter
);
256 /* Enable QMU Transmit flow control / transmit padding / Transmit CRC */
257 ks8842_write16(adapter
, 16, 0x000E, REG_TXCR
);
259 /* enable the receiver, uni + multi + broadcast + flow ctrl
261 ks8842_write16(adapter
, 16, 0x8 | 0x20 | 0x40 | 0x80 | 0x400,
264 /* TX frame pointer autoincrement */
265 ks8842_write16(adapter
, 17, 0x4000, REG_TXFDPR
);
267 /* RX frame pointer autoincrement */
268 ks8842_write16(adapter
, 17, 0x4000, REG_RXFDPR
);
270 /* RX 2 kb high watermark */
271 ks8842_write16(adapter
, 0, 0x1000, REG_QRFCR
);
273 /* aggresive back off in half duplex */
274 ks8842_enable_bits(adapter
, 32, 1 << 8, REG_SGCR1
);
276 /* enable no excessive collison drop */
277 ks8842_enable_bits(adapter
, 32, 1 << 3, REG_SGCR2
);
279 /* Enable port 1 force flow control / back pressure / transmit / recv */
280 ks8842_write16(adapter
, 48, 0x1E07, REG_P1CR2
);
282 /* restart port auto-negotiation */
283 ks8842_enable_bits(adapter
, 49, 1 << 13, REG_P1CR4
);
285 if (!(adapter
->conf_flags
& MICREL_KS884X
))
286 /* only advertise 10Mbps */
287 ks8842_clear_bits(adapter
, 49, 3 << 2, REG_P1CR4
);
289 /* Enable the transmitter */
290 ks8842_enable_tx(adapter
);
292 /* Enable the receiver */
293 ks8842_enable_rx(adapter
);
295 /* clear all interrupts */
296 ks8842_write16(adapter
, 18, 0xffff, REG_ISR
);
298 /* enable interrupts */
299 ks8842_write16(adapter
, 18, ENABLED_IRQS
, REG_IER
);
301 /* enable the switch */
302 ks8842_write16(adapter
, 32, 0x1, REG_SW_ID_AND_ENABLE
);
305 static void ks8842_read_mac_addr(struct ks8842_adapter
*adapter
, u8
*dest
)
310 for (i
= 0; i
< ETH_ALEN
; i
++)
311 dest
[ETH_ALEN
- i
- 1] = ks8842_read8(adapter
, 2, REG_MARL
+ i
);
313 if (adapter
->conf_flags
& MICREL_KS884X
) {
315 the sequence of saving mac addr between MAC and Switch is
319 mac
= ks8842_read16(adapter
, 2, REG_MARL
);
320 ks8842_write16(adapter
, 39, mac
, REG_MACAR3
);
321 mac
= ks8842_read16(adapter
, 2, REG_MARM
);
322 ks8842_write16(adapter
, 39, mac
, REG_MACAR2
);
323 mac
= ks8842_read16(adapter
, 2, REG_MARH
);
324 ks8842_write16(adapter
, 39, mac
, REG_MACAR1
);
327 /* make sure the switch port uses the same MAC as the QMU */
328 mac
= ks8842_read16(adapter
, 2, REG_MARL
);
329 ks8842_write16(adapter
, 39, mac
, REG_MACAR1
);
330 mac
= ks8842_read16(adapter
, 2, REG_MARM
);
331 ks8842_write16(adapter
, 39, mac
, REG_MACAR2
);
332 mac
= ks8842_read16(adapter
, 2, REG_MARH
);
333 ks8842_write16(adapter
, 39, mac
, REG_MACAR3
);
337 static void ks8842_write_mac_addr(struct ks8842_adapter
*adapter
, u8
*mac
)
342 spin_lock_irqsave(&adapter
->lock
, flags
);
343 for (i
= 0; i
< ETH_ALEN
; i
++) {
344 ks8842_write8(adapter
, 2, mac
[ETH_ALEN
- i
- 1], REG_MARL
+ i
);
345 if (!(adapter
->conf_flags
& MICREL_KS884X
))
346 ks8842_write8(adapter
, 39, mac
[ETH_ALEN
- i
- 1],
350 if (adapter
->conf_flags
& MICREL_KS884X
) {
352 the sequence of saving mac addr between MAC and Switch is
358 mac
= ks8842_read16(adapter
, 2, REG_MARL
);
359 ks8842_write16(adapter
, 39, mac
, REG_MACAR3
);
360 mac
= ks8842_read16(adapter
, 2, REG_MARM
);
361 ks8842_write16(adapter
, 39, mac
, REG_MACAR2
);
362 mac
= ks8842_read16(adapter
, 2, REG_MARH
);
363 ks8842_write16(adapter
, 39, mac
, REG_MACAR1
);
365 spin_unlock_irqrestore(&adapter
->lock
, flags
);
368 static inline u16
ks8842_tx_fifo_space(struct ks8842_adapter
*adapter
)
370 return ks8842_read16(adapter
, 16, REG_TXMIR
) & 0x1fff;
373 static int ks8842_tx_frame(struct sk_buff
*skb
, struct net_device
*netdev
)
375 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
378 netdev_dbg(netdev
, "%s: len %u head %p data %p tail %p end %p\n",
379 __func__
, skb
->len
, skb
->head
, skb
->data
,
380 skb_tail_pointer(skb
), skb_end_pointer(skb
));
382 /* check FIFO buffer space, we need space for CRC and command bits */
383 if (ks8842_tx_fifo_space(adapter
) < len
+ 8)
384 return NETDEV_TX_BUSY
;
386 if (adapter
->conf_flags
& KS884X_16BIT
) {
387 u16
*ptr16
= (u16
*)skb
->data
;
388 ks8842_write16(adapter
, 17, 0x8000 | 0x100, REG_QMU_DATA_LO
);
389 ks8842_write16(adapter
, 17, (u16
)len
, REG_QMU_DATA_HI
);
390 netdev
->stats
.tx_bytes
+= len
;
394 iowrite16(*ptr16
++, adapter
->hw_addr
+ REG_QMU_DATA_LO
);
395 iowrite16(*ptr16
++, adapter
->hw_addr
+ REG_QMU_DATA_HI
);
400 u32
*ptr
= (u32
*)skb
->data
;
402 /* the control word, enable IRQ, port 1 and the length */
403 ctrl
= 0x8000 | 0x100 | (len
<< 16);
404 ks8842_write32(adapter
, 17, ctrl
, REG_QMU_DATA_LO
);
406 netdev
->stats
.tx_bytes
+= len
;
410 iowrite32(*ptr
, adapter
->hw_addr
+ REG_QMU_DATA_LO
);
417 ks8842_write16(adapter
, 17, 1, REG_TXQCR
);
424 static void ks8842_rx_frame(struct net_device
*netdev
,
425 struct ks8842_adapter
*adapter
)
430 if (adapter
->conf_flags
& KS884X_16BIT
) {
431 status
= ks8842_read16(adapter
, 17, REG_QMU_DATA_LO
);
432 len
= ks8842_read16(adapter
, 17, REG_QMU_DATA_HI
);
433 netdev_dbg(netdev
, "%s - rx_data: status: %x\n",
436 status
= ks8842_read32(adapter
, 17, REG_QMU_DATA_LO
);
437 len
= (status
>> 16) & 0x7ff;
439 netdev_dbg(netdev
, "%s - rx_data: status: %x\n",
443 /* check the status */
444 if ((status
& RXSR_VALID
) && !(status
& RXSR_ERROR
)) {
445 struct sk_buff
*skb
= netdev_alloc_skb_ip_align(netdev
, len
);
447 netdev_dbg(netdev
, "%s, got package, len: %d\n", __func__
, len
);
450 netdev
->stats
.rx_packets
++;
451 netdev
->stats
.rx_bytes
+= len
;
452 if (status
& RXSR_MULTICAST
)
453 netdev
->stats
.multicast
++;
455 if (adapter
->conf_flags
& KS884X_16BIT
) {
456 u16
*data16
= (u16
*)skb_put(skb
, len
);
457 ks8842_select_bank(adapter
, 17);
459 *data16
++ = ioread16(adapter
->hw_addr
+
461 *data16
++ = ioread16(adapter
->hw_addr
+
466 u32
*data
= (u32
*)skb_put(skb
, len
);
468 ks8842_select_bank(adapter
, 17);
470 *data
++ = ioread32(adapter
->hw_addr
+
475 skb
->protocol
= eth_type_trans(skb
, netdev
);
478 netdev
->stats
.rx_dropped
++;
480 netdev_dbg(netdev
, "RX error, status: %x\n", status
);
481 netdev
->stats
.rx_errors
++;
482 if (status
& RXSR_TOO_LONG
)
483 netdev
->stats
.rx_length_errors
++;
484 if (status
& RXSR_CRC_ERROR
)
485 netdev
->stats
.rx_crc_errors
++;
486 if (status
& RXSR_RUNT
)
487 netdev
->stats
.rx_frame_errors
++;
490 /* set high watermark to 3K */
491 ks8842_clear_bits(adapter
, 0, 1 << 12, REG_QRFCR
);
493 /* release the frame */
494 ks8842_write16(adapter
, 17, 0x01, REG_RXQCR
);
496 /* set high watermark to 2K */
497 ks8842_enable_bits(adapter
, 0, 1 << 12, REG_QRFCR
);
500 void ks8842_handle_rx(struct net_device
*netdev
, struct ks8842_adapter
*adapter
)
502 u16 rx_data
= ks8842_read16(adapter
, 16, REG_RXMIR
) & 0x1fff;
503 netdev_dbg(netdev
, "%s Entry - rx_data: %d\n", __func__
, rx_data
);
505 ks8842_rx_frame(netdev
, adapter
);
506 rx_data
= ks8842_read16(adapter
, 16, REG_RXMIR
) & 0x1fff;
510 void ks8842_handle_tx(struct net_device
*netdev
, struct ks8842_adapter
*adapter
)
512 u16 sr
= ks8842_read16(adapter
, 16, REG_TXSR
);
513 netdev_dbg(netdev
, "%s - entry, sr: %x\n", __func__
, sr
);
514 netdev
->stats
.tx_packets
++;
515 if (netif_queue_stopped(netdev
))
516 netif_wake_queue(netdev
);
519 void ks8842_handle_rx_overrun(struct net_device
*netdev
,
520 struct ks8842_adapter
*adapter
)
522 netdev_dbg(netdev
, "%s: entry\n", __func__
);
523 netdev
->stats
.rx_errors
++;
524 netdev
->stats
.rx_fifo_errors
++;
527 void ks8842_tasklet(unsigned long arg
)
529 struct net_device
*netdev
= (struct net_device
*)arg
;
530 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
535 /* read current bank to be able to set it back */
536 spin_lock_irqsave(&adapter
->lock
, flags
);
537 entry_bank
= ioread16(adapter
->hw_addr
+ REG_SELECT_BANK
);
538 spin_unlock_irqrestore(&adapter
->lock
, flags
);
540 isr
= ks8842_read16(adapter
, 18, REG_ISR
);
541 netdev_dbg(netdev
, "%s - ISR: 0x%x\n", __func__
, isr
);
544 ks8842_write16(adapter
, 18, isr
, REG_ISR
);
546 if (!netif_running(netdev
))
549 if (isr
& IRQ_LINK_CHANGE
)
550 ks8842_update_link_status(netdev
, adapter
);
552 if (isr
& (IRQ_RX
| IRQ_RX_ERROR
))
553 ks8842_handle_rx(netdev
, adapter
);
556 ks8842_handle_tx(netdev
, adapter
);
558 if (isr
& IRQ_RX_OVERRUN
)
559 ks8842_handle_rx_overrun(netdev
, adapter
);
561 if (isr
& IRQ_TX_STOPPED
) {
562 ks8842_disable_tx(adapter
);
563 ks8842_enable_tx(adapter
);
566 if (isr
& IRQ_RX_STOPPED
) {
567 ks8842_disable_rx(adapter
);
568 ks8842_enable_rx(adapter
);
571 /* re-enable interrupts, put back the bank selection register */
572 spin_lock_irqsave(&adapter
->lock
, flags
);
573 ks8842_write16(adapter
, 18, ENABLED_IRQS
, REG_IER
);
574 iowrite16(entry_bank
, adapter
->hw_addr
+ REG_SELECT_BANK
);
575 spin_unlock_irqrestore(&adapter
->lock
, flags
);
578 static irqreturn_t
ks8842_irq(int irq
, void *devid
)
580 struct net_device
*netdev
= devid
;
581 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
583 u16 entry_bank
= ioread16(adapter
->hw_addr
+ REG_SELECT_BANK
);
584 irqreturn_t ret
= IRQ_NONE
;
586 isr
= ks8842_read16(adapter
, 18, REG_ISR
);
587 netdev_dbg(netdev
, "%s - ISR: 0x%x\n", __func__
, isr
);
591 ks8842_write16(adapter
, 18, 0x00, REG_IER
);
593 /* schedule tasklet */
594 tasklet_schedule(&adapter
->tasklet
);
599 iowrite16(entry_bank
, adapter
->hw_addr
+ REG_SELECT_BANK
);
605 /* Netdevice operations */
607 static int ks8842_open(struct net_device
*netdev
)
609 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
612 netdev_dbg(netdev
, "%s - entry\n", __func__
);
615 ks8842_reset_hw(adapter
);
617 ks8842_write_mac_addr(adapter
, netdev
->dev_addr
);
619 ks8842_update_link_status(netdev
, adapter
);
621 err
= request_irq(adapter
->irq
, ks8842_irq
, IRQF_SHARED
, DRV_NAME
,
624 pr_err("Failed to request IRQ: %d: %d\n", adapter
->irq
, err
);
631 static int ks8842_close(struct net_device
*netdev
)
633 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
635 netdev_dbg(netdev
, "%s - entry\n", __func__
);
637 cancel_work_sync(&adapter
->timeout_work
);
640 free_irq(adapter
->irq
, netdev
);
642 /* disable the switch */
643 ks8842_write16(adapter
, 32, 0x0, REG_SW_ID_AND_ENABLE
);
648 static netdev_tx_t
ks8842_xmit_frame(struct sk_buff
*skb
,
649 struct net_device
*netdev
)
652 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
654 netdev_dbg(netdev
, "%s: entry\n", __func__
);
656 ret
= ks8842_tx_frame(skb
, netdev
);
658 if (ks8842_tx_fifo_space(adapter
) < netdev
->mtu
+ 8)
659 netif_stop_queue(netdev
);
664 static int ks8842_set_mac(struct net_device
*netdev
, void *p
)
666 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
667 struct sockaddr
*addr
= p
;
668 char *mac
= (u8
*)addr
->sa_data
;
670 netdev_dbg(netdev
, "%s: entry\n", __func__
);
672 if (!is_valid_ether_addr(addr
->sa_data
))
673 return -EADDRNOTAVAIL
;
675 memcpy(netdev
->dev_addr
, mac
, netdev
->addr_len
);
677 ks8842_write_mac_addr(adapter
, mac
);
681 static void ks8842_tx_timeout_work(struct work_struct
*work
)
683 struct ks8842_adapter
*adapter
=
684 container_of(work
, struct ks8842_adapter
, timeout_work
);
685 struct net_device
*netdev
= adapter
->netdev
;
688 netdev_dbg(netdev
, "%s: entry\n", __func__
);
690 spin_lock_irqsave(&adapter
->lock
, flags
);
691 /* disable interrupts */
692 ks8842_write16(adapter
, 18, 0, REG_IER
);
693 ks8842_write16(adapter
, 18, 0xFFFF, REG_ISR
);
695 netif_stop_queue(netdev
);
697 spin_unlock_irqrestore(&adapter
->lock
, flags
);
699 ks8842_reset_hw(adapter
);
701 ks8842_write_mac_addr(adapter
, netdev
->dev_addr
);
703 ks8842_update_link_status(netdev
, adapter
);
706 static void ks8842_tx_timeout(struct net_device
*netdev
)
708 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
710 netdev_dbg(netdev
, "%s: entry\n", __func__
);
712 schedule_work(&adapter
->timeout_work
);
715 static const struct net_device_ops ks8842_netdev_ops
= {
716 .ndo_open
= ks8842_open
,
717 .ndo_stop
= ks8842_close
,
718 .ndo_start_xmit
= ks8842_xmit_frame
,
719 .ndo_set_mac_address
= ks8842_set_mac
,
720 .ndo_tx_timeout
= ks8842_tx_timeout
,
721 .ndo_validate_addr
= eth_validate_addr
724 static const struct ethtool_ops ks8842_ethtool_ops
= {
725 .get_link
= ethtool_op_get_link
,
728 static int __devinit
ks8842_probe(struct platform_device
*pdev
)
731 struct resource
*iomem
;
732 struct net_device
*netdev
;
733 struct ks8842_adapter
*adapter
;
734 struct ks8842_platform_data
*pdata
= pdev
->dev
.platform_data
;
738 iomem
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
739 if (!request_mem_region(iomem
->start
, resource_size(iomem
), DRV_NAME
))
742 netdev
= alloc_etherdev(sizeof(struct ks8842_adapter
));
744 goto err_alloc_etherdev
;
746 SET_NETDEV_DEV(netdev
, &pdev
->dev
);
748 adapter
= netdev_priv(netdev
);
749 adapter
->netdev
= netdev
;
750 INIT_WORK(&adapter
->timeout_work
, ks8842_tx_timeout_work
);
751 adapter
->hw_addr
= ioremap(iomem
->start
, resource_size(iomem
));
752 adapter
->conf_flags
= iomem
->flags
;
754 if (!adapter
->hw_addr
)
757 adapter
->irq
= platform_get_irq(pdev
, 0);
758 if (adapter
->irq
< 0) {
763 tasklet_init(&adapter
->tasklet
, ks8842_tasklet
, (unsigned long)netdev
);
764 spin_lock_init(&adapter
->lock
);
766 netdev
->netdev_ops
= &ks8842_netdev_ops
;
767 netdev
->ethtool_ops
= &ks8842_ethtool_ops
;
769 /* Check if a mac address was given */
770 i
= netdev
->addr_len
;
772 for (i
= 0; i
< netdev
->addr_len
; i
++)
773 if (pdata
->macaddr
[i
] != 0)
776 if (i
< netdev
->addr_len
)
777 /* an address was passed, use it */
778 memcpy(netdev
->dev_addr
, pdata
->macaddr
,
782 if (i
== netdev
->addr_len
) {
783 ks8842_read_mac_addr(adapter
, netdev
->dev_addr
);
785 if (!is_valid_ether_addr(netdev
->dev_addr
))
786 random_ether_addr(netdev
->dev_addr
);
789 id
= ks8842_read16(adapter
, 32, REG_SW_ID_AND_ENABLE
);
791 strcpy(netdev
->name
, "eth%d");
792 err
= register_netdev(netdev
);
796 platform_set_drvdata(pdev
, netdev
);
798 pr_info("Found chip, family: 0x%x, id: 0x%x, rev: 0x%x\n",
799 (id
>> 8) & 0xff, (id
>> 4) & 0xf, (id
>> 1) & 0x7);
805 iounmap(adapter
->hw_addr
);
809 release_mem_region(iomem
->start
, resource_size(iomem
));
814 static int __devexit
ks8842_remove(struct platform_device
*pdev
)
816 struct net_device
*netdev
= platform_get_drvdata(pdev
);
817 struct ks8842_adapter
*adapter
= netdev_priv(netdev
);
818 struct resource
*iomem
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
820 unregister_netdev(netdev
);
821 tasklet_kill(&adapter
->tasklet
);
822 iounmap(adapter
->hw_addr
);
824 release_mem_region(iomem
->start
, resource_size(iomem
));
825 platform_set_drvdata(pdev
, NULL
);
830 static struct platform_driver ks8842_platform_driver
= {
833 .owner
= THIS_MODULE
,
835 .probe
= ks8842_probe
,
836 .remove
= ks8842_remove
,
839 static int __init
ks8842_init(void)
841 return platform_driver_register(&ks8842_platform_driver
);
844 static void __exit
ks8842_exit(void)
846 platform_driver_unregister(&ks8842_platform_driver
);
849 module_init(ks8842_init
);
850 module_exit(ks8842_exit
);
852 MODULE_DESCRIPTION("Timberdale KS8842 ethernet driver");
853 MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>");
854 MODULE_LICENSE("GPL v2");
855 MODULE_ALIAS("platform:ks8842");