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 if (tx
== NUM_TX_DESC
- 1)
171 if ((priv
->tx_skb
[tx
]) || (priv
->tx_skb
[tx_next
]) ||
172 !(priv
->tx
[tx
].txd2
& TX_DMA_DONE
) ||
173 !(priv
->tx
[tx_next
].txd2
& TX_DMA_DONE
))
176 priv
->tx
[tx
].txd1
= mapped_addr
;
177 priv
->tx
[tx
].txd2
&= ~(TX_DMA_PLEN0_MASK
| TX_DMA_DONE
);
178 priv
->tx
[tx
].txd2
|= TX_DMA_PLEN0(skb
->len
);
179 dev
->stats
.tx_packets
++;
180 dev
->stats
.tx_bytes
+= skb
->len
;
181 priv
->tx_skb
[tx
] = skb
;
183 ramips_fe_wr((tx
+ 1) % NUM_TX_DESC
, RAMIPS_TX_CTX_IDX0
);
184 spin_unlock_irqrestore(&priv
->page_lock
, flags
);
188 spin_unlock_irqrestore(&priv
->page_lock
, flags
);
189 dev
->stats
.tx_dropped
++;
195 ramips_eth_rx_hw(unsigned long ptr
)
197 struct net_device
*dev
= (struct net_device
*) ptr
;
198 struct raeth_priv
*priv
= netdev_priv(dev
);
203 struct sk_buff
*rx_skb
, *new_skb
;
205 rx
= (ramips_fe_rr(RAMIPS_RX_CALC_IDX0
) + 1) % NUM_RX_DESC
;
206 if (!(priv
->rx
[rx
].rxd2
& RX_DMA_DONE
))
210 rx_skb
= priv
->rx_skb
[rx
];
211 rx_skb
->len
= RX_DMA_PLEN0(priv
->rx
[rx
].rxd2
);
213 rx_skb
->protocol
= eth_type_trans(rx_skb
, dev
);
214 rx_skb
->ip_summed
= CHECKSUM_NONE
;
215 dev
->stats
.rx_packets
++;
216 dev
->stats
.rx_bytes
+= rx_skb
->len
;
219 new_skb
= netdev_alloc_skb(dev
, MAX_RX_LENGTH
+ 2);
220 priv
->rx_skb
[rx
] = new_skb
;
222 skb_reserve(new_skb
, 2);
223 priv
->rx
[rx
].rxd1
= dma_map_single(NULL
,
227 priv
->rx
[rx
].rxd2
&= ~RX_DMA_DONE
;
229 ramips_fe_wr(rx
, RAMIPS_RX_CALC_IDX0
);
233 tasklet_schedule(&priv
->rx_tasklet
);
235 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) | RAMIPS_RX_DLY_INT
,
236 RAMIPS_FE_INT_ENABLE
);
240 ramips_eth_tx_housekeeping(unsigned long ptr
)
242 struct net_device
*dev
= (struct net_device
*)ptr
;
243 struct raeth_priv
*priv
= netdev_priv(dev
);
245 while ((priv
->tx
[priv
->skb_free_idx
].txd2
& TX_DMA_DONE
) &&
246 (priv
->tx_skb
[priv
->skb_free_idx
])) {
247 dev_kfree_skb_irq((struct sk_buff
*) priv
->tx_skb
[priv
->skb_free_idx
]);
248 priv
->tx_skb
[priv
->skb_free_idx
] = 0;
249 priv
->skb_free_idx
++;
250 if (priv
->skb_free_idx
>= NUM_TX_DESC
)
251 priv
->skb_free_idx
= 0;
254 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) | RAMIPS_TX_DLY_INT
,
255 RAMIPS_FE_INT_ENABLE
);
259 ramips_eth_set_mac_addr(struct net_device
*dev
, void *priv
)
261 unsigned char *mac
= (unsigned char *) priv
;
263 if (netif_running(dev
))
266 memcpy(dev
->dev_addr
, ((struct sockaddr
*)priv
)->sa_data
, dev
->addr_len
);
267 ramips_fe_wr((mac
[0] << 8) | mac
[1], RAMIPS_GDMA1_MAC_ADRH
);
268 ramips_fe_wr((mac
[2] << 24) | (mac
[3] << 16) | (mac
[4] << 8) | mac
[5],
269 RAMIPS_GDMA1_MAC_ADRL
);
274 ramips_eth_timeout(struct net_device
*dev
)
276 struct raeth_priv
*priv
= netdev_priv(dev
);
278 tasklet_schedule(&priv
->tx_housekeeping_tasklet
);
282 ramips_eth_irq(int irq
, void *dev
)
284 struct raeth_priv
*priv
= netdev_priv(dev
);
285 unsigned long fe_int
= ramips_fe_rr(RAMIPS_FE_INT_STATUS
);
287 ramips_fe_wr(0xFFFFFFFF, RAMIPS_FE_INT_STATUS
);
289 if (fe_int
& RAMIPS_RX_DLY_INT
) {
290 ramips_fe_wr(ramips_fe_rr(RAMIPS_FE_INT_ENABLE
) & ~(RAMIPS_RX_DLY_INT
),
291 RAMIPS_FE_INT_ENABLE
);
292 tasklet_schedule(&priv
->rx_tasklet
);
295 if (fe_int
& RAMIPS_TX_DLY_INT
)
296 ramips_eth_tx_housekeeping((unsigned long)dev
);
302 ramips_eth_open(struct net_device
*dev
)
304 struct raeth_priv
*priv
= netdev_priv(dev
);
307 err
= request_irq(dev
->irq
, ramips_eth_irq
, IRQF_DISABLED
,
312 err
= ramips_alloc_dma(priv
);
316 ramips_setup_dma(priv
);
317 ramips_fe_wr((ramips_fe_rr(RAMIPS_PDMA_GLO_CFG
) & 0xff) |
318 (RAMIPS_TX_WB_DDONE
| RAMIPS_RX_DMA_EN
|
319 RAMIPS_TX_DMA_EN
| RAMIPS_PDMA_SIZE_4DWORDS
),
320 RAMIPS_PDMA_GLO_CFG
);
321 ramips_fe_wr((ramips_fe_rr(RAMIPS_FE_GLO_CFG
) &
322 ~(RAMIPS_US_CYC_CNT_MASK
<< RAMIPS_US_CYC_CNT_SHIFT
)) |
323 ((rt305x_sys_freq
/ RAMIPS_US_CYC_CNT_DIVISOR
) << RAMIPS_US_CYC_CNT_SHIFT
),
326 tasklet_init(&priv
->tx_housekeeping_tasklet
, ramips_eth_tx_housekeeping
,
328 tasklet_init(&priv
->rx_tasklet
, ramips_eth_rx_hw
, (unsigned long)dev
);
330 ramips_fe_wr(RAMIPS_DELAY_INIT
, RAMIPS_DLY_INT_CFG
);
331 ramips_fe_wr(RAMIPS_TX_DLY_INT
| RAMIPS_RX_DLY_INT
, RAMIPS_FE_INT_ENABLE
);
332 ramips_fe_wr(ramips_fe_rr(RAMIPS_GDMA1_FWD_CFG
) &
333 ~(RAMIPS_GDM1_ICS_EN
| RAMIPS_GDM1_TCS_EN
| RAMIPS_GDM1_UCS_EN
| 0xffff),
334 RAMIPS_GDMA1_FWD_CFG
);
335 ramips_fe_wr(ramips_fe_rr(RAMIPS_CDMA_CSG_CFG
) &
336 ~(RAMIPS_ICS_GEN_EN
| RAMIPS_TCS_GEN_EN
| RAMIPS_UCS_GEN_EN
),
337 RAMIPS_CDMA_CSG_CFG
);
338 ramips_fe_wr(RAMIPS_PSE_FQFC_CFG_INIT
, RAMIPS_PSE_FQ_CFG
);
339 ramips_fe_wr(1, RAMIPS_FE_RST_GL
);
340 ramips_fe_wr(0, RAMIPS_FE_RST_GL
);
342 netif_start_queue(dev
);
346 free_irq(dev
->irq
, dev
);
351 ramips_eth_stop(struct net_device
*dev
)
353 struct raeth_priv
*priv
= netdev_priv(dev
);
355 ramips_fe_wr(ramips_fe_rr(RAMIPS_PDMA_GLO_CFG
) &
356 ~(RAMIPS_TX_WB_DDONE
| RAMIPS_RX_DMA_EN
| RAMIPS_TX_DMA_EN
),
357 RAMIPS_PDMA_GLO_CFG
);
358 free_irq(dev
->irq
, dev
);
359 netif_stop_queue(dev
);
360 tasklet_kill(&priv
->tx_housekeeping_tasklet
);
361 tasklet_kill(&priv
->rx_tasklet
);
362 ramips_cleanup_dma(priv
);
363 printk(KERN_DEBUG
"ramips_eth: stopped\n");
368 ramips_eth_probe(struct net_device
*dev
)
370 struct raeth_priv
*priv
= netdev_priv(dev
);
371 struct sockaddr addr
;
373 BUG_ON(!priv
->plat
->reset_fe
);
374 priv
->plat
->reset_fe();
375 net_srandom(jiffies
);
376 memcpy(addr
.sa_data
, priv
->plat
->mac
, 6);
377 ramips_eth_set_mac_addr(dev
, &addr
);
381 dev
->watchdog_timeo
= TX_TIMEOUT
;
382 spin_lock_init(&priv
->page_lock
);
387 static const struct net_device_ops ramips_eth_netdev_ops
= {
388 .ndo_init
= ramips_eth_probe
,
389 .ndo_open
= ramips_eth_open
,
390 .ndo_stop
= ramips_eth_stop
,
391 .ndo_start_xmit
= ramips_eth_hard_start_xmit
,
392 .ndo_tx_timeout
= ramips_eth_timeout
,
393 .ndo_change_mtu
= eth_change_mtu
,
394 .ndo_set_mac_address
= ramips_eth_set_mac_addr
,
395 .ndo_validate_addr
= eth_validate_addr
,
399 ramips_eth_plat_probe(struct platform_device
*plat
)
401 struct raeth_priv
*priv
;
402 struct ramips_eth_platform_data
*data
= plat
->dev
.platform_data
;
403 struct resource
*res
;
407 dev_err(&plat
->dev
, "no platform data specified\n");
411 res
= platform_get_resource(plat
, IORESOURCE_MEM
, 0);
413 dev_err(&plat
->dev
, "no memory resource found\n");
417 ramips_fe_base
= ioremap_nocache(res
->start
, res
->end
- res
->start
+ 1);
421 ramips_dev
= alloc_etherdev(sizeof(struct raeth_priv
));
423 dev_err(&plat
->dev
, "alloc_etherdev failed\n");
428 strcpy(ramips_dev
->name
, "eth%d");
429 ramips_dev
->irq
= platform_get_irq(plat
, 0);
430 if (ramips_dev
->irq
< 0) {
431 dev_err(&plat
->dev
, "no IRQ resource found\n");
435 ramips_dev
->addr_len
= ETH_ALEN
;
436 ramips_dev
->base_addr
= (unsigned long)ramips_fe_base
;
437 ramips_dev
->netdev_ops
= &ramips_eth_netdev_ops
;
439 priv
= netdev_priv(ramips_dev
);
442 err
= register_netdev(ramips_dev
);
444 dev_err(&plat
->dev
, "error bringing up device\n");
448 #ifdef CONFIG_RALINK_RT305X
451 printk(KERN_DEBUG
"ramips_eth: loaded\n");
457 iounmap(ramips_fe_base
);
462 ramips_eth_plat_remove(struct platform_device
*plat
)
464 unregister_netdev(ramips_dev
);
465 free_netdev(ramips_dev
);
466 printk(KERN_DEBUG
"ramips_eth: unloaded\n");
470 static struct platform_driver ramips_eth_driver
= {
471 .probe
= ramips_eth_plat_probe
,
472 .remove
= ramips_eth_plat_remove
,
474 .name
= "ramips_eth",
475 .owner
= THIS_MODULE
,
480 ramips_eth_init(void)
482 int ret
= platform_driver_register(&ramips_eth_driver
);
485 "ramips_eth: Error registering platfom driver!\n");
490 ramips_eth_cleanup(void)
492 platform_driver_unregister(&ramips_eth_driver
);
495 module_init(ramips_eth_init
);
496 module_exit(ramips_eth_cleanup
);
498 MODULE_LICENSE("GPL");
499 MODULE_AUTHOR("John Crispin <blogic@openwrt.org>");
500 MODULE_DESCRIPTION("ethernet driver for ramips boards");