2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; version 2 of the License
6 * This program is distributed in the hope that it will be useful,
7 * but WITHOUT ANY WARRANTY; without even the implied warranty of
8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
9 * GNU General Public License for more details.
11 * You should have received a copy of the GNU General Public License
12 * along with this program; if not, write to the Free Software
13 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
15 * Copyright (C) 2009 John Crispin <blogic@openwrt.org>
18 #include <linux/module.h>
19 #include <linux/kernel.h>
20 #include <linux/types.h>
21 #include <linux/dma-mapping.h>
22 #include <linux/init.h>
23 #include <linux/skbuff.h>
24 #include <linux/etherdevice.h>
25 #include <linux/ethtool.h>
26 #include <linux/platform_device.h>
28 #include <ramips_eth_platform.h>
29 #include "ramips_eth.h"
31 #define TX_TIMEOUT (20 * HZ / 100)
32 #define MAX_RX_LENGTH 1600
34 #ifdef CONFIG_RALINK_RT305X
35 #include "ramips_esw.c"
37 static inline int rt305x_esw_init(void) { return 0; }
38 static inline void rt305x_esw_exit(void) { }
41 #define phys_to_bus(a) (a & 0x1FFFFFFF)
43 static struct net_device
* ramips_dev
;
44 static void __iomem
*ramips_fe_base
= 0;
47 ramips_fe_wr(u32 val
, unsigned reg
)
49 __raw_writel(val
, ramips_fe_base
+ reg
);
53 ramips_fe_rr(unsigned reg
)
55 return __raw_readl(ramips_fe_base
+ reg
);
59 ramips_fe_int_disable(u32 mask
)
61 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) & ~mask
,
62 RAMIPS_FE_INT_ENABLE
);
64 ramips_fe_rr(RAMIPS_FE_INT_ENABLE
);
68 ramips_fe_int_enable(u32 mask
)
70 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) | mask
,
71 RAMIPS_FE_INT_ENABLE
);
73 ramips_fe_rr(RAMIPS_FE_INT_ENABLE
);
77 ramips_hw_set_macaddr(unsigned char *mac
)
79 ramips_fe_wr((mac
[0] << 8) | mac
[1], RAMIPS_GDMA1_MAC_ADRH
);
80 ramips_fe_wr((mac
[2] << 24) | (mac
[3] << 16) | (mac
[4] << 8) | mac
[5],
81 RAMIPS_GDMA1_MAC_ADRL
);
84 #ifdef CONFIG_RALINK_RT288X
86 ramips_setup_mdio_cfg(struct raeth_priv
*re
)
88 unsigned int mdio_cfg
;
90 mdio_cfg
= RAMIPS_MDIO_CFG_TX_CLK_SKEW_200
|
91 RAMIPS_MDIO_CFG_TX_CLK_SKEW_200
|
92 RAMIPS_MDIO_CFG_GP1_FRC_EN
;
94 if (re
->duplex
== DUPLEX_FULL
)
95 mdio_cfg
|= RAMIPS_MDIO_CFG_GP1_DUPLEX
;
98 mdio_cfg
|= RAMIPS_MDIO_CFG_GP1_FC_TX
;
101 mdio_cfg
|= RAMIPS_MDIO_CFG_GP1_FC_RX
;
105 mdio_cfg
|= RAMIPS_MDIO_CFG_GP1_SPEED_10
;
108 mdio_cfg
|= RAMIPS_MDIO_CFG_GP1_SPEED_100
;
111 mdio_cfg
|= RAMIPS_MDIO_CFG_GP1_SPEED_1000
;
117 ramips_fe_wr(mdio_cfg
, RAMIPS_MDIO_CFG
);
120 static inline void ramips_setup_mdio_cfg(struct raeth_priv
*re
)
123 #endif /* CONFIG_RALINK_RT288X */
126 ramips_cleanup_dma(struct raeth_priv
*re
)
130 for (i
= 0; i
< NUM_RX_DESC
; i
++)
132 dma_unmap_single(NULL
, re
->rx_dma
[i
], MAX_RX_LENGTH
,
134 dev_kfree_skb_any(re
->rx_skb
[i
]);
138 dma_free_coherent(NULL
,
139 NUM_RX_DESC
* sizeof(struct ramips_rx_dma
),
140 re
->rx
, re
->rx_desc_dma
);
143 dma_free_coherent(NULL
,
144 NUM_TX_DESC
* sizeof(struct ramips_tx_dma
),
145 re
->tx
, re
->tx_desc_dma
);
149 ramips_alloc_dma(struct raeth_priv
*re
)
154 re
->skb_free_idx
= 0;
157 re
->tx
= dma_alloc_coherent(NULL
,
158 NUM_TX_DESC
* sizeof(struct ramips_tx_dma
),
159 &re
->tx_desc_dma
, GFP_ATOMIC
);
163 memset(re
->tx
, 0, NUM_TX_DESC
* sizeof(struct ramips_tx_dma
));
164 for (i
= 0; i
< NUM_TX_DESC
; i
++) {
165 re
->tx
[i
].txd2
= TX_DMA_LSO
| TX_DMA_DONE
;
166 re
->tx
[i
].txd4
= TX_DMA_QN(3) | TX_DMA_PN(1);
170 re
->rx
= dma_alloc_coherent(NULL
,
171 NUM_RX_DESC
* sizeof(struct ramips_rx_dma
),
172 &re
->rx_desc_dma
, GFP_ATOMIC
);
176 memset(re
->rx
, 0, sizeof(struct ramips_rx_dma
) * NUM_RX_DESC
);
177 for (i
= 0; i
< NUM_RX_DESC
; i
++) {
179 struct sk_buff
*new_skb
= dev_alloc_skb(MAX_RX_LENGTH
+
185 skb_reserve(new_skb
, NET_IP_ALIGN
);
187 dma_addr
= dma_map_single(NULL
, new_skb
->data
,
188 MAX_RX_LENGTH
, DMA_FROM_DEVICE
);
189 re
->rx_dma
[i
] = dma_addr
;
190 re
->rx
[i
].rxd1
= (unsigned int) re
->rx_dma
[i
];
191 re
->rx
[i
].rxd2
|= RX_DMA_LSO
;
192 re
->rx_skb
[i
] = new_skb
;
198 ramips_cleanup_dma(re
);
203 ramips_setup_dma(struct raeth_priv
*re
)
205 ramips_fe_wr(re
->tx_desc_dma
, RAMIPS_TX_BASE_PTR0
);
206 ramips_fe_wr(NUM_TX_DESC
, RAMIPS_TX_MAX_CNT0
);
207 ramips_fe_wr(0, RAMIPS_TX_CTX_IDX0
);
208 ramips_fe_wr(RAMIPS_PST_DTX_IDX0
, RAMIPS_PDMA_RST_CFG
);
210 ramips_fe_wr(re
->rx_desc_dma
, RAMIPS_RX_BASE_PTR0
);
211 ramips_fe_wr(NUM_RX_DESC
, RAMIPS_RX_MAX_CNT0
);
212 ramips_fe_wr((NUM_RX_DESC
- 1), RAMIPS_RX_CALC_IDX0
);
213 ramips_fe_wr(RAMIPS_PST_DRX_IDX0
, RAMIPS_PDMA_RST_CFG
);
217 ramips_eth_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
219 struct raeth_priv
*priv
= netdev_priv(dev
);
221 unsigned int tx_next
;
222 unsigned int mapped_addr
;
224 if (priv
->plat
->min_pkt_len
) {
225 if (skb
->len
< priv
->plat
->min_pkt_len
) {
226 if (skb_padto(skb
, priv
->plat
->min_pkt_len
)) {
228 "ramips_eth: skb_padto failed\n");
232 skb_put(skb
, priv
->plat
->min_pkt_len
- skb
->len
);
236 dev
->trans_start
= jiffies
;
237 mapped_addr
= (unsigned int) dma_map_single(NULL
, skb
->data
, skb
->len
,
239 dma_sync_single_for_device(NULL
, mapped_addr
, skb
->len
, DMA_TO_DEVICE
);
240 spin_lock(&priv
->page_lock
);
241 tx
= ramips_fe_rr(RAMIPS_TX_CTX_IDX0
);
242 tx_next
= (tx
+ 1) % NUM_TX_DESC
;
244 if ((priv
->tx_skb
[tx
]) || (priv
->tx_skb
[tx_next
]) ||
245 !(priv
->tx
[tx
].txd2
& TX_DMA_DONE
) ||
246 !(priv
->tx
[tx_next
].txd2
& TX_DMA_DONE
))
249 priv
->tx
[tx
].txd1
= mapped_addr
;
250 priv
->tx
[tx
].txd2
&= ~(TX_DMA_PLEN0_MASK
| TX_DMA_DONE
);
251 priv
->tx
[tx
].txd2
|= TX_DMA_PLEN0(skb
->len
);
252 dev
->stats
.tx_packets
++;
253 dev
->stats
.tx_bytes
+= skb
->len
;
254 priv
->tx_skb
[tx
] = skb
;
256 ramips_fe_wr(tx_next
, RAMIPS_TX_CTX_IDX0
);
257 spin_unlock(&priv
->page_lock
);
261 spin_unlock(&priv
->page_lock
);
262 dev
->stats
.tx_dropped
++;
268 ramips_eth_rx_hw(unsigned long ptr
)
270 struct net_device
*dev
= (struct net_device
*) ptr
;
271 struct raeth_priv
*priv
= netdev_priv(dev
);
276 struct sk_buff
*rx_skb
, *new_skb
;
279 rx
= (ramips_fe_rr(RAMIPS_RX_CALC_IDX0
) + 1) % NUM_RX_DESC
;
280 if (!(priv
->rx
[rx
].rxd2
& RX_DMA_DONE
))
284 rx_skb
= priv
->rx_skb
[rx
];
285 pktlen
= RX_DMA_PLEN0(priv
->rx
[rx
].rxd2
);
287 new_skb
= netdev_alloc_skb(dev
, MAX_RX_LENGTH
+ NET_IP_ALIGN
);
288 /* Reuse the buffer on allocation failures */
292 dma_unmap_single(NULL
, priv
->rx_dma
[rx
], MAX_RX_LENGTH
,
295 skb_put(rx_skb
, pktlen
);
297 rx_skb
->protocol
= eth_type_trans(rx_skb
, dev
);
298 rx_skb
->ip_summed
= CHECKSUM_NONE
;
299 dev
->stats
.rx_packets
++;
300 dev
->stats
.rx_bytes
+= pktlen
;
303 priv
->rx_skb
[rx
] = new_skb
;
304 skb_reserve(new_skb
, NET_IP_ALIGN
);
306 dma_addr
= dma_map_single(NULL
,
310 priv
->rx_dma
[rx
] = dma_addr
;
311 priv
->rx
[rx
].rxd1
= (unsigned int) dma_addr
;
313 dev
->stats
.rx_dropped
++;
316 priv
->rx
[rx
].rxd2
&= ~RX_DMA_DONE
;
318 ramips_fe_wr(rx
, RAMIPS_RX_CALC_IDX0
);
322 tasklet_schedule(&priv
->rx_tasklet
);
324 ramips_fe_int_enable(RAMIPS_RX_DLY_INT
);
328 ramips_eth_tx_housekeeping(unsigned long ptr
)
330 struct net_device
*dev
= (struct net_device
*)ptr
;
331 struct raeth_priv
*priv
= netdev_priv(dev
);
333 spin_lock(&priv
->page_lock
);
334 while ((priv
->tx
[priv
->skb_free_idx
].txd2
& TX_DMA_DONE
) &&
335 (priv
->tx_skb
[priv
->skb_free_idx
])) {
336 dev_kfree_skb_irq(priv
->tx_skb
[priv
->skb_free_idx
]);
337 priv
->tx_skb
[priv
->skb_free_idx
] = 0;
338 priv
->skb_free_idx
++;
339 if (priv
->skb_free_idx
>= NUM_TX_DESC
)
340 priv
->skb_free_idx
= 0;
342 spin_unlock(&priv
->page_lock
);
344 ramips_fe_int_enable(RAMIPS_TX_DLY_INT
);
348 ramips_eth_timeout(struct net_device
*dev
)
350 struct raeth_priv
*priv
= netdev_priv(dev
);
352 tasklet_schedule(&priv
->tx_housekeeping_tasklet
);
356 ramips_eth_irq(int irq
, void *dev
)
358 struct raeth_priv
*priv
= netdev_priv(dev
);
359 unsigned long fe_int
= ramips_fe_rr(RAMIPS_FE_INT_STATUS
);
361 ramips_fe_wr(0xFFFFFFFF, RAMIPS_FE_INT_STATUS
);
363 if (fe_int
& RAMIPS_RX_DLY_INT
) {
364 ramips_fe_int_disable(RAMIPS_RX_DLY_INT
);
365 tasklet_schedule(&priv
->rx_tasklet
);
368 if (fe_int
& RAMIPS_TX_DLY_INT
) {
369 ramips_fe_int_disable(RAMIPS_TX_DLY_INT
);
370 tasklet_schedule(&priv
->tx_housekeeping_tasklet
);
377 ramips_eth_open(struct net_device
*dev
)
379 struct raeth_priv
*priv
= netdev_priv(dev
);
382 err
= request_irq(dev
->irq
, ramips_eth_irq
, IRQF_DISABLED
,
387 err
= ramips_alloc_dma(priv
);
391 ramips_hw_set_macaddr(dev
->dev_addr
);
393 ramips_setup_dma(priv
);
394 ramips_fe_wr((ramips_fe_rr(RAMIPS_PDMA_GLO_CFG
) & 0xff) |
395 (RAMIPS_TX_WB_DDONE
| RAMIPS_RX_DMA_EN
|
396 RAMIPS_TX_DMA_EN
| RAMIPS_PDMA_SIZE_4DWORDS
),
397 RAMIPS_PDMA_GLO_CFG
);
398 ramips_fe_wr((ramips_fe_rr(RAMIPS_FE_GLO_CFG
) &
399 ~(RAMIPS_US_CYC_CNT_MASK
<< RAMIPS_US_CYC_CNT_SHIFT
)) |
400 ((priv
->plat
->sys_freq
/ RAMIPS_US_CYC_CNT_DIVISOR
) << RAMIPS_US_CYC_CNT_SHIFT
),
403 tasklet_init(&priv
->tx_housekeeping_tasklet
, ramips_eth_tx_housekeeping
,
405 tasklet_init(&priv
->rx_tasklet
, ramips_eth_rx_hw
, (unsigned long)dev
);
407 ramips_setup_mdio_cfg(priv
);
409 ramips_fe_wr(RAMIPS_DELAY_INIT
, RAMIPS_DLY_INT_CFG
);
410 ramips_fe_wr(RAMIPS_TX_DLY_INT
| RAMIPS_RX_DLY_INT
, RAMIPS_FE_INT_ENABLE
);
411 ramips_fe_wr(ramips_fe_rr(RAMIPS_GDMA1_FWD_CFG
) &
412 ~(RAMIPS_GDM1_ICS_EN
| RAMIPS_GDM1_TCS_EN
| RAMIPS_GDM1_UCS_EN
| 0xffff),
413 RAMIPS_GDMA1_FWD_CFG
);
414 ramips_fe_wr(ramips_fe_rr(RAMIPS_CDMA_CSG_CFG
) &
415 ~(RAMIPS_ICS_GEN_EN
| RAMIPS_TCS_GEN_EN
| RAMIPS_UCS_GEN_EN
),
416 RAMIPS_CDMA_CSG_CFG
);
417 ramips_fe_wr(RAMIPS_PSE_FQFC_CFG_INIT
, RAMIPS_PSE_FQ_CFG
);
418 ramips_fe_wr(1, RAMIPS_FE_RST_GL
);
419 ramips_fe_wr(0, RAMIPS_FE_RST_GL
);
421 netif_start_queue(dev
);
425 free_irq(dev
->irq
, dev
);
430 ramips_eth_stop(struct net_device
*dev
)
432 struct raeth_priv
*priv
= netdev_priv(dev
);
434 ramips_fe_wr(ramips_fe_rr(RAMIPS_PDMA_GLO_CFG
) &
435 ~(RAMIPS_TX_WB_DDONE
| RAMIPS_RX_DMA_EN
| RAMIPS_TX_DMA_EN
),
436 RAMIPS_PDMA_GLO_CFG
);
438 /* disable all interrupts in the hw */
439 ramips_fe_wr(0, RAMIPS_FE_INT_ENABLE
);
441 free_irq(dev
->irq
, dev
);
442 netif_stop_queue(dev
);
443 tasklet_kill(&priv
->tx_housekeeping_tasklet
);
444 tasklet_kill(&priv
->rx_tasklet
);
445 ramips_cleanup_dma(priv
);
446 printk(KERN_DEBUG
"ramips_eth: stopped\n");
451 ramips_eth_probe(struct net_device
*dev
)
453 struct raeth_priv
*priv
= netdev_priv(dev
);
455 BUG_ON(!priv
->plat
->reset_fe
);
456 priv
->plat
->reset_fe();
457 net_srandom(jiffies
);
458 memcpy(dev
->dev_addr
, priv
->plat
->mac
, ETH_ALEN
);
462 dev
->watchdog_timeo
= TX_TIMEOUT
;
463 spin_lock_init(&priv
->page_lock
);
468 static const struct net_device_ops ramips_eth_netdev_ops
= {
469 .ndo_init
= ramips_eth_probe
,
470 .ndo_open
= ramips_eth_open
,
471 .ndo_stop
= ramips_eth_stop
,
472 .ndo_start_xmit
= ramips_eth_hard_start_xmit
,
473 .ndo_tx_timeout
= ramips_eth_timeout
,
474 .ndo_change_mtu
= eth_change_mtu
,
475 .ndo_set_mac_address
= eth_mac_addr
,
476 .ndo_validate_addr
= eth_validate_addr
,
480 ramips_eth_plat_probe(struct platform_device
*plat
)
482 struct raeth_priv
*priv
;
483 struct ramips_eth_platform_data
*data
= plat
->dev
.platform_data
;
484 struct resource
*res
;
488 dev_err(&plat
->dev
, "no platform data specified\n");
492 res
= platform_get_resource(plat
, IORESOURCE_MEM
, 0);
494 dev_err(&plat
->dev
, "no memory resource found\n");
498 ramips_fe_base
= ioremap_nocache(res
->start
, res
->end
- res
->start
+ 1);
502 ramips_dev
= alloc_etherdev(sizeof(struct raeth_priv
));
504 dev_err(&plat
->dev
, "alloc_etherdev failed\n");
509 strcpy(ramips_dev
->name
, "eth%d");
510 ramips_dev
->irq
= platform_get_irq(plat
, 0);
511 if (ramips_dev
->irq
< 0) {
512 dev_err(&plat
->dev
, "no IRQ resource found\n");
516 ramips_dev
->addr_len
= ETH_ALEN
;
517 ramips_dev
->base_addr
= (unsigned long)ramips_fe_base
;
518 ramips_dev
->netdev_ops
= &ramips_eth_netdev_ops
;
520 priv
= netdev_priv(ramips_dev
);
522 priv
->speed
= data
->speed
;
523 priv
->duplex
= data
->duplex
;
524 priv
->rx_fc
= data
->rx_fc
;
525 priv
->tx_fc
= data
->tx_fc
;
528 err
= register_netdev(ramips_dev
);
530 dev_err(&plat
->dev
, "error bringing up device\n");
534 printk(KERN_DEBUG
"ramips_eth: loaded\n");
540 iounmap(ramips_fe_base
);
545 ramips_eth_plat_remove(struct platform_device
*plat
)
547 unregister_netdev(ramips_dev
);
548 free_netdev(ramips_dev
);
549 printk(KERN_DEBUG
"ramips_eth: unloaded\n");
553 static struct platform_driver ramips_eth_driver
= {
554 .probe
= ramips_eth_plat_probe
,
555 .remove
= ramips_eth_plat_remove
,
557 .name
= "ramips_eth",
558 .owner
= THIS_MODULE
,
563 ramips_eth_init(void)
567 ret
= rt305x_esw_init();
571 ret
= platform_driver_register(&ramips_eth_driver
);
574 "ramips_eth: Error registering platfom driver!\n");
586 ramips_eth_cleanup(void)
588 platform_driver_unregister(&ramips_eth_driver
);
592 module_init(ramips_eth_init
);
593 module_exit(ramips_eth_cleanup
);
595 MODULE_LICENSE("GPL");
596 MODULE_AUTHOR("John Crispin <blogic@openwrt.org>");
597 MODULE_DESCRIPTION("ethernet driver for ramips boards");