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/platform_device.h>
27 #include <ramips_eth_platform.h>
28 #include "ramips_eth.h"
30 #define TX_TIMEOUT (20 * HZ / 100)
31 #define MAX_RX_LENGTH 1600
33 #ifdef CONFIG_RALINK_RT305X
34 #include "ramips_esw.c"
37 #define phys_to_bus(a) (a & 0x1FFFFFFF)
39 static struct net_device
* ramips_dev
;
40 static void __iomem
*ramips_fe_base
= 0;
43 ramips_fe_wr(u32 val
, unsigned reg
)
45 __raw_writel(val
, ramips_fe_base
+ reg
);
49 ramips_fe_rr(unsigned reg
)
51 return __raw_readl(ramips_fe_base
+ reg
);
55 ramips_cleanup_dma(struct raeth_priv
*re
)
59 for (i
= 0; i
< NUM_RX_DESC
; i
++)
61 dev_kfree_skb_any(re
->rx_skb
[i
]);
64 dma_free_coherent(NULL
,
65 NUM_RX_DESC
* sizeof(struct ramips_rx_dma
),
69 dma_free_coherent(NULL
,
70 NUM_TX_DESC
* sizeof(struct ramips_tx_dma
),
75 ramips_alloc_dma(struct raeth_priv
*re
)
83 re
->tx
= dma_alloc_coherent(NULL
,
84 NUM_TX_DESC
* sizeof(struct ramips_tx_dma
),
85 &re
->phy_tx
, GFP_ATOMIC
);
89 memset(re
->tx
, 0, NUM_TX_DESC
* sizeof(struct ramips_tx_dma
));
90 for (i
= 0; i
< NUM_TX_DESC
; i
++) {
91 re
->tx
[i
].txd2
= TX_DMA_LSO
| TX_DMA_DONE
;
92 re
->tx
[i
].txd4
= TX_DMA_QN(3) | TX_DMA_PN(1);
96 re
->rx
= dma_alloc_coherent(NULL
,
97 NUM_RX_DESC
* sizeof(struct ramips_rx_dma
),
98 &re
->phy_rx
, GFP_ATOMIC
);
102 memset(re
->rx
, 0, sizeof(struct ramips_rx_dma
) * NUM_RX_DESC
);
103 for (i
= 0; i
< NUM_RX_DESC
; i
++) {
104 struct sk_buff
*new_skb
= dev_alloc_skb(MAX_RX_LENGTH
+ 2);
109 skb_reserve(new_skb
, 2);
110 re
->rx
[i
].rxd1
= dma_map_single(NULL
,
114 re
->rx
[i
].rxd2
|= RX_DMA_LSO
;
115 re
->rx_skb
[i
] = new_skb
;
121 ramips_cleanup_dma(re
);
126 ramips_setup_dma(struct raeth_priv
*re
)
128 ramips_fe_wr(phys_to_bus(re
->phy_tx
), RAMIPS_TX_BASE_PTR0
);
129 ramips_fe_wr(NUM_TX_DESC
, RAMIPS_TX_MAX_CNT0
);
130 ramips_fe_wr(0, RAMIPS_TX_CTX_IDX0
);
131 ramips_fe_wr(RAMIPS_PST_DTX_IDX0
, RAMIPS_PDMA_RST_CFG
);
133 ramips_fe_wr(phys_to_bus(re
->phy_rx
), RAMIPS_RX_BASE_PTR0
);
134 ramips_fe_wr(NUM_RX_DESC
, RAMIPS_RX_MAX_CNT0
);
135 ramips_fe_wr((NUM_RX_DESC
- 1), RAMIPS_RX_CALC_IDX0
);
136 ramips_fe_wr(RAMIPS_PST_DRX_IDX0
, RAMIPS_PDMA_RST_CFG
);
140 ramips_eth_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
142 struct raeth_priv
*priv
= netdev_priv(dev
);
144 unsigned int tx_next
;
145 unsigned int mapped_addr
;
148 if (priv
->plat
->min_pkt_len
) {
149 if (skb
->len
< priv
->plat
->min_pkt_len
) {
150 if (skb_padto(skb
, priv
->plat
->min_pkt_len
)) {
152 "ramips_eth: skb_padto failed\n");
156 skb_put(skb
, priv
->plat
->min_pkt_len
- skb
->len
);
160 dev
->trans_start
= jiffies
;
161 mapped_addr
= (unsigned int) dma_map_single(NULL
, skb
->data
, skb
->len
,
163 dma_sync_single_for_device(NULL
, mapped_addr
, skb
->len
, DMA_TO_DEVICE
);
164 spin_lock_irqsave(&priv
->page_lock
, flags
);
165 tx
= ramips_fe_rr(RAMIPS_TX_CTX_IDX0
);
166 tx_next
= (tx
+ 1) % NUM_TX_DESC
;
168 if ((priv
->tx_skb
[tx
]) || (priv
->tx_skb
[tx_next
]) ||
169 !(priv
->tx
[tx
].txd2
& TX_DMA_DONE
) ||
170 !(priv
->tx
[tx_next
].txd2
& TX_DMA_DONE
))
173 priv
->tx
[tx
].txd1
= mapped_addr
;
174 priv
->tx
[tx
].txd2
&= ~(TX_DMA_PLEN0_MASK
| TX_DMA_DONE
);
175 priv
->tx
[tx
].txd2
|= TX_DMA_PLEN0(skb
->len
);
176 dev
->stats
.tx_packets
++;
177 dev
->stats
.tx_bytes
+= skb
->len
;
178 priv
->tx_skb
[tx
] = skb
;
180 ramips_fe_wr(tx_next
, RAMIPS_TX_CTX_IDX0
);
181 spin_unlock_irqrestore(&priv
->page_lock
, flags
);
185 spin_unlock_irqrestore(&priv
->page_lock
, flags
);
186 dev
->stats
.tx_dropped
++;
192 ramips_eth_rx_hw(unsigned long ptr
)
194 struct net_device
*dev
= (struct net_device
*) ptr
;
195 struct raeth_priv
*priv
= netdev_priv(dev
);
200 struct sk_buff
*rx_skb
, *new_skb
;
202 rx
= (ramips_fe_rr(RAMIPS_RX_CALC_IDX0
) + 1) % NUM_RX_DESC
;
203 if (!(priv
->rx
[rx
].rxd2
& RX_DMA_DONE
))
207 rx_skb
= priv
->rx_skb
[rx
];
208 rx_skb
->len
= RX_DMA_PLEN0(priv
->rx
[rx
].rxd2
);
210 rx_skb
->protocol
= eth_type_trans(rx_skb
, dev
);
211 rx_skb
->ip_summed
= CHECKSUM_NONE
;
212 dev
->stats
.rx_packets
++;
213 dev
->stats
.rx_bytes
+= rx_skb
->len
;
216 new_skb
= netdev_alloc_skb(dev
, MAX_RX_LENGTH
+ 2);
217 priv
->rx_skb
[rx
] = new_skb
;
219 skb_reserve(new_skb
, 2);
220 priv
->rx
[rx
].rxd1
= dma_map_single(NULL
,
224 priv
->rx
[rx
].rxd2
&= ~RX_DMA_DONE
;
226 ramips_fe_wr(rx
, RAMIPS_RX_CALC_IDX0
);
230 tasklet_schedule(&priv
->rx_tasklet
);
232 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) | RAMIPS_RX_DLY_INT
,
233 RAMIPS_FE_INT_ENABLE
);
237 ramips_eth_tx_housekeeping(unsigned long ptr
)
239 struct net_device
*dev
= (struct net_device
*)ptr
;
240 struct raeth_priv
*priv
= netdev_priv(dev
);
242 while ((priv
->tx
[priv
->skb_free_idx
].txd2
& TX_DMA_DONE
) &&
243 (priv
->tx_skb
[priv
->skb_free_idx
])) {
244 dev_kfree_skb_irq((struct sk_buff
*) priv
->tx_skb
[priv
->skb_free_idx
]);
245 priv
->tx_skb
[priv
->skb_free_idx
] = 0;
246 priv
->skb_free_idx
++;
247 if (priv
->skb_free_idx
>= NUM_TX_DESC
)
248 priv
->skb_free_idx
= 0;
251 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) | RAMIPS_TX_DLY_INT
,
252 RAMIPS_FE_INT_ENABLE
);
256 ramips_eth_set_mac_addr(struct net_device
*dev
, void *priv
)
258 unsigned char *mac
= (unsigned char *) priv
;
260 if (netif_running(dev
))
263 memcpy(dev
->dev_addr
, ((struct sockaddr
*)priv
)->sa_data
, dev
->addr_len
);
264 ramips_fe_wr((mac
[0] << 8) | mac
[1], RAMIPS_GDMA1_MAC_ADRH
);
265 ramips_fe_wr((mac
[2] << 24) | (mac
[3] << 16) | (mac
[4] << 8) | mac
[5],
266 RAMIPS_GDMA1_MAC_ADRL
);
271 ramips_eth_timeout(struct net_device
*dev
)
273 struct raeth_priv
*priv
= netdev_priv(dev
);
275 tasklet_schedule(&priv
->tx_housekeeping_tasklet
);
279 ramips_eth_irq(int irq
, void *dev
)
281 struct raeth_priv
*priv
= netdev_priv(dev
);
282 unsigned long fe_int
= ramips_fe_rr(RAMIPS_FE_INT_STATUS
);
284 ramips_fe_wr(0xFFFFFFFF, RAMIPS_FE_INT_STATUS
);
286 if (fe_int
& RAMIPS_RX_DLY_INT
) {
287 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) & ~(RAMIPS_RX_DLY_INT
),
288 RAMIPS_FE_INT_ENABLE
);
289 tasklet_schedule(&priv
->rx_tasklet
);
292 if (fe_int
& RAMIPS_TX_DLY_INT
)
293 ramips_eth_tx_housekeeping((unsigned long)dev
);
299 ramips_eth_open(struct net_device
*dev
)
301 struct raeth_priv
*priv
= netdev_priv(dev
);
304 err
= request_irq(dev
->irq
, ramips_eth_irq
, IRQF_DISABLED
,
309 err
= ramips_alloc_dma(priv
);
313 ramips_setup_dma(priv
);
314 ramips_fe_wr((ramips_fe_rr(RAMIPS_PDMA_GLO_CFG
) & 0xff) |
315 (RAMIPS_TX_WB_DDONE
| RAMIPS_RX_DMA_EN
|
316 RAMIPS_TX_DMA_EN
| RAMIPS_PDMA_SIZE_4DWORDS
),
317 RAMIPS_PDMA_GLO_CFG
);
318 ramips_fe_wr((ramips_fe_rr(RAMIPS_FE_GLO_CFG
) &
319 ~(RAMIPS_US_CYC_CNT_MASK
<< RAMIPS_US_CYC_CNT_SHIFT
)) |
320 ((rt305x_sys_freq
/ RAMIPS_US_CYC_CNT_DIVISOR
) << RAMIPS_US_CYC_CNT_SHIFT
),
323 tasklet_init(&priv
->tx_housekeeping_tasklet
, ramips_eth_tx_housekeeping
,
325 tasklet_init(&priv
->rx_tasklet
, ramips_eth_rx_hw
, (unsigned long)dev
);
327 ramips_fe_wr(RAMIPS_DELAY_INIT
, RAMIPS_DLY_INT_CFG
);
328 ramips_fe_wr(RAMIPS_TX_DLY_INT
| RAMIPS_RX_DLY_INT
, RAMIPS_FE_INT_ENABLE
);
329 ramips_fe_wr(ramips_fe_rr(RAMIPS_GDMA1_FWD_CFG
) &
330 ~(RAMIPS_GDM1_ICS_EN
| RAMIPS_GDM1_TCS_EN
| RAMIPS_GDM1_UCS_EN
| 0xffff),
331 RAMIPS_GDMA1_FWD_CFG
);
332 ramips_fe_wr(ramips_fe_rr(RAMIPS_CDMA_CSG_CFG
) &
333 ~(RAMIPS_ICS_GEN_EN
| RAMIPS_TCS_GEN_EN
| RAMIPS_UCS_GEN_EN
),
334 RAMIPS_CDMA_CSG_CFG
);
335 ramips_fe_wr(RAMIPS_PSE_FQFC_CFG_INIT
, RAMIPS_PSE_FQ_CFG
);
336 ramips_fe_wr(1, RAMIPS_FE_RST_GL
);
337 ramips_fe_wr(0, RAMIPS_FE_RST_GL
);
339 netif_start_queue(dev
);
343 free_irq(dev
->irq
, dev
);
348 ramips_eth_stop(struct net_device
*dev
)
350 struct raeth_priv
*priv
= netdev_priv(dev
);
352 ramips_fe_wr(ramips_fe_rr(RAMIPS_PDMA_GLO_CFG
) &
353 ~(RAMIPS_TX_WB_DDONE
| RAMIPS_RX_DMA_EN
| RAMIPS_TX_DMA_EN
),
354 RAMIPS_PDMA_GLO_CFG
);
355 free_irq(dev
->irq
, dev
);
356 netif_stop_queue(dev
);
357 tasklet_kill(&priv
->tx_housekeeping_tasklet
);
358 tasklet_kill(&priv
->rx_tasklet
);
359 ramips_cleanup_dma(priv
);
360 printk(KERN_DEBUG
"ramips_eth: stopped\n");
365 ramips_eth_probe(struct net_device
*dev
)
367 struct raeth_priv
*priv
= netdev_priv(dev
);
368 struct sockaddr addr
;
370 BUG_ON(!priv
->plat
->reset_fe
);
371 priv
->plat
->reset_fe();
372 net_srandom(jiffies
);
373 memcpy(addr
.sa_data
, priv
->plat
->mac
, 6);
374 ramips_eth_set_mac_addr(dev
, &addr
);
378 dev
->watchdog_timeo
= TX_TIMEOUT
;
379 spin_lock_init(&priv
->page_lock
);
384 static const struct net_device_ops ramips_eth_netdev_ops
= {
385 .ndo_init
= ramips_eth_probe
,
386 .ndo_open
= ramips_eth_open
,
387 .ndo_stop
= ramips_eth_stop
,
388 .ndo_start_xmit
= ramips_eth_hard_start_xmit
,
389 .ndo_tx_timeout
= ramips_eth_timeout
,
390 .ndo_change_mtu
= eth_change_mtu
,
391 .ndo_set_mac_address
= ramips_eth_set_mac_addr
,
392 .ndo_validate_addr
= eth_validate_addr
,
396 ramips_eth_plat_probe(struct platform_device
*plat
)
398 struct raeth_priv
*priv
;
399 struct ramips_eth_platform_data
*data
= plat
->dev
.platform_data
;
400 struct resource
*res
;
404 dev_err(&plat
->dev
, "no platform data specified\n");
408 res
= platform_get_resource(plat
, IORESOURCE_MEM
, 0);
410 dev_err(&plat
->dev
, "no memory resource found\n");
414 ramips_fe_base
= ioremap_nocache(res
->start
, res
->end
- res
->start
+ 1);
418 ramips_dev
= alloc_etherdev(sizeof(struct raeth_priv
));
420 dev_err(&plat
->dev
, "alloc_etherdev failed\n");
425 strcpy(ramips_dev
->name
, "eth%d");
426 ramips_dev
->irq
= platform_get_irq(plat
, 0);
427 if (ramips_dev
->irq
< 0) {
428 dev_err(&plat
->dev
, "no IRQ resource found\n");
432 ramips_dev
->addr_len
= ETH_ALEN
;
433 ramips_dev
->base_addr
= (unsigned long)ramips_fe_base
;
434 ramips_dev
->netdev_ops
= &ramips_eth_netdev_ops
;
436 priv
= netdev_priv(ramips_dev
);
439 err
= register_netdev(ramips_dev
);
441 dev_err(&plat
->dev
, "error bringing up device\n");
445 #ifdef CONFIG_RALINK_RT305X
448 printk(KERN_DEBUG
"ramips_eth: loaded\n");
454 iounmap(ramips_fe_base
);
459 ramips_eth_plat_remove(struct platform_device
*plat
)
461 unregister_netdev(ramips_dev
);
462 free_netdev(ramips_dev
);
463 printk(KERN_DEBUG
"ramips_eth: unloaded\n");
467 static struct platform_driver ramips_eth_driver
= {
468 .probe
= ramips_eth_plat_probe
,
469 .remove
= ramips_eth_plat_remove
,
471 .name
= "ramips_eth",
472 .owner
= THIS_MODULE
,
477 ramips_eth_init(void)
479 int ret
= platform_driver_register(&ramips_eth_driver
);
482 "ramips_eth: Error registering platfom driver!\n");
487 ramips_eth_cleanup(void)
489 platform_driver_unregister(&ramips_eth_driver
);
492 module_init(ramips_eth_init
);
493 module_exit(ramips_eth_cleanup
);
495 MODULE_LICENSE("GPL");
496 MODULE_AUTHOR("John Crispin <blogic@openwrt.org>");
497 MODULE_DESCRIPTION("ethernet driver for ramips boards");