diff options
author | Andrea Bastoni <bastoni@cs.unc.edu> | 2010-05-30 19:16:45 -0400 |
---|---|---|
committer | Andrea Bastoni <bastoni@cs.unc.edu> | 2010-05-30 19:16:45 -0400 |
commit | ada47b5fe13d89735805b566185f4885f5a3f750 (patch) | |
tree | 644b88f8a71896307d71438e9b3af49126ffb22b /drivers/net/arm/ep93xx_eth.c | |
parent | 43e98717ad40a4ae64545b5ba047c7b86aa44f4f (diff) | |
parent | 3280f21d43ee541f97f8cda5792150d2dbec20d5 (diff) |
Merge branch 'wip-2.6.34' into old-private-masterarchived-private-master
Diffstat (limited to 'drivers/net/arm/ep93xx_eth.c')
-rw-r--r-- | drivers/net/arm/ep93xx_eth.c | 151 |
1 files changed, 74 insertions, 77 deletions
diff --git a/drivers/net/arm/ep93xx_eth.c b/drivers/net/arm/ep93xx_eth.c index b25467ac895c..cd17d09f385c 100644 --- a/drivers/net/arm/ep93xx_eth.c +++ b/drivers/net/arm/ep93xx_eth.c | |||
@@ -9,6 +9,8 @@ | |||
9 | * (at your option) any later version. | 9 | * (at your option) any later version. |
10 | */ | 10 | */ |
11 | 11 | ||
12 | #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__ | ||
13 | |||
12 | #include <linux/dma-mapping.h> | 14 | #include <linux/dma-mapping.h> |
13 | #include <linux/module.h> | 15 | #include <linux/module.h> |
14 | #include <linux/kernel.h> | 16 | #include <linux/kernel.h> |
@@ -20,9 +22,10 @@ | |||
20 | #include <linux/moduleparam.h> | 22 | #include <linux/moduleparam.h> |
21 | #include <linux/platform_device.h> | 23 | #include <linux/platform_device.h> |
22 | #include <linux/delay.h> | 24 | #include <linux/delay.h> |
23 | #include <mach/ep93xx-regs.h> | 25 | #include <linux/io.h> |
24 | #include <mach/platform.h> | 26 | #include <linux/slab.h> |
25 | #include <asm/io.h> | 27 | |
28 | #include <mach/hardware.h> | ||
26 | 29 | ||
27 | #define DRV_MODULE_NAME "ep93xx-eth" | 30 | #define DRV_MODULE_NAME "ep93xx-eth" |
28 | #define DRV_MODULE_VERSION "0.1" | 31 | #define DRV_MODULE_VERSION "0.1" |
@@ -185,7 +188,47 @@ struct ep93xx_priv | |||
185 | #define wrw(ep, off, val) __raw_writew((val), (ep)->base_addr + (off)) | 188 | #define wrw(ep, off, val) __raw_writew((val), (ep)->base_addr + (off)) |
186 | #define wrl(ep, off, val) __raw_writel((val), (ep)->base_addr + (off)) | 189 | #define wrl(ep, off, val) __raw_writel((val), (ep)->base_addr + (off)) |
187 | 190 | ||
188 | static int ep93xx_mdio_read(struct net_device *dev, int phy_id, int reg); | 191 | static int ep93xx_mdio_read(struct net_device *dev, int phy_id, int reg) |
192 | { | ||
193 | struct ep93xx_priv *ep = netdev_priv(dev); | ||
194 | int data; | ||
195 | int i; | ||
196 | |||
197 | wrl(ep, REG_MIICMD, REG_MIICMD_READ | (phy_id << 5) | reg); | ||
198 | |||
199 | for (i = 0; i < 10; i++) { | ||
200 | if ((rdl(ep, REG_MIISTS) & REG_MIISTS_BUSY) == 0) | ||
201 | break; | ||
202 | msleep(1); | ||
203 | } | ||
204 | |||
205 | if (i == 10) { | ||
206 | pr_info("mdio read timed out\n"); | ||
207 | data = 0xffff; | ||
208 | } else { | ||
209 | data = rdl(ep, REG_MIIDATA); | ||
210 | } | ||
211 | |||
212 | return data; | ||
213 | } | ||
214 | |||
215 | static void ep93xx_mdio_write(struct net_device *dev, int phy_id, int reg, int data) | ||
216 | { | ||
217 | struct ep93xx_priv *ep = netdev_priv(dev); | ||
218 | int i; | ||
219 | |||
220 | wrl(ep, REG_MIIDATA, data); | ||
221 | wrl(ep, REG_MIICMD, REG_MIICMD_WRITE | (phy_id << 5) | reg); | ||
222 | |||
223 | for (i = 0; i < 10; i++) { | ||
224 | if ((rdl(ep, REG_MIISTS) & REG_MIISTS_BUSY) == 0) | ||
225 | break; | ||
226 | msleep(1); | ||
227 | } | ||
228 | |||
229 | if (i == 10) | ||
230 | pr_info("mdio write timed out\n"); | ||
231 | } | ||
189 | 232 | ||
190 | static struct net_device_stats *ep93xx_get_stats(struct net_device *dev) | 233 | static struct net_device_stats *ep93xx_get_stats(struct net_device *dev) |
191 | { | 234 | { |
@@ -217,14 +260,11 @@ static int ep93xx_rx(struct net_device *dev, int processed, int budget) | |||
217 | rstat->rstat1 = 0; | 260 | rstat->rstat1 = 0; |
218 | 261 | ||
219 | if (!(rstat0 & RSTAT0_EOF)) | 262 | if (!(rstat0 & RSTAT0_EOF)) |
220 | printk(KERN_CRIT "ep93xx_rx: not end-of-frame " | 263 | pr_crit("not end-of-frame %.8x %.8x\n", rstat0, rstat1); |
221 | " %.8x %.8x\n", rstat0, rstat1); | ||
222 | if (!(rstat0 & RSTAT0_EOB)) | 264 | if (!(rstat0 & RSTAT0_EOB)) |
223 | printk(KERN_CRIT "ep93xx_rx: not end-of-buffer " | 265 | pr_crit("not end-of-buffer %.8x %.8x\n", rstat0, rstat1); |
224 | " %.8x %.8x\n", rstat0, rstat1); | ||
225 | if ((rstat1 & RSTAT1_BUFFER_INDEX) >> 16 != entry) | 266 | if ((rstat1 & RSTAT1_BUFFER_INDEX) >> 16 != entry) |
226 | printk(KERN_CRIT "ep93xx_rx: entry mismatch " | 267 | pr_crit("entry mismatch %.8x %.8x\n", rstat0, rstat1); |
227 | " %.8x %.8x\n", rstat0, rstat1); | ||
228 | 268 | ||
229 | if (!(rstat0 & RSTAT0_RWE)) { | 269 | if (!(rstat0 & RSTAT0_RWE)) { |
230 | ep->stats.rx_errors++; | 270 | ep->stats.rx_errors++; |
@@ -241,8 +281,7 @@ static int ep93xx_rx(struct net_device *dev, int processed, int budget) | |||
241 | 281 | ||
242 | length = rstat1 & RSTAT1_FRAME_LENGTH; | 282 | length = rstat1 & RSTAT1_FRAME_LENGTH; |
243 | if (length > MAX_PKT_SIZE) { | 283 | if (length > MAX_PKT_SIZE) { |
244 | printk(KERN_NOTICE "ep93xx_rx: invalid length " | 284 | pr_notice("invalid length %.8x %.8x\n", rstat0, rstat1); |
245 | " %.8x %.8x\n", rstat0, rstat1); | ||
246 | goto err; | 285 | goto err; |
247 | } | 286 | } |
248 | 287 | ||
@@ -272,11 +311,6 @@ err: | |||
272 | processed++; | 311 | processed++; |
273 | } | 312 | } |
274 | 313 | ||
275 | if (processed) { | ||
276 | wrw(ep, REG_RXDENQ, processed); | ||
277 | wrw(ep, REG_RXSTSENQ, processed); | ||
278 | } | ||
279 | |||
280 | return processed; | 314 | return processed; |
281 | } | 315 | } |
282 | 316 | ||
@@ -311,6 +345,11 @@ poll_some_more: | |||
311 | goto poll_some_more; | 345 | goto poll_some_more; |
312 | } | 346 | } |
313 | 347 | ||
348 | if (rx) { | ||
349 | wrw(ep, REG_RXDENQ, rx); | ||
350 | wrw(ep, REG_RXSTSENQ, rx); | ||
351 | } | ||
352 | |||
314 | return rx; | 353 | return rx; |
315 | } | 354 | } |
316 | 355 | ||
@@ -371,11 +410,9 @@ static void ep93xx_tx_complete(struct net_device *dev) | |||
371 | tstat->tstat0 = 0; | 410 | tstat->tstat0 = 0; |
372 | 411 | ||
373 | if (tstat0 & TSTAT0_FA) | 412 | if (tstat0 & TSTAT0_FA) |
374 | printk(KERN_CRIT "ep93xx_tx_complete: frame aborted " | 413 | pr_crit("frame aborted %.8x\n", tstat0); |
375 | " %.8x\n", tstat0); | ||
376 | if ((tstat0 & TSTAT0_BUFFER_INDEX) != entry) | 414 | if ((tstat0 & TSTAT0_BUFFER_INDEX) != entry) |
377 | printk(KERN_CRIT "ep93xx_tx_complete: entry mismatch " | 415 | pr_crit("entry mismatch %.8x\n", tstat0); |
378 | " %.8x\n", tstat0); | ||
379 | 416 | ||
380 | if (tstat0 & TSTAT0_TXWE) { | 417 | if (tstat0 & TSTAT0_TXWE) { |
381 | int length = ep->descs->tdesc[entry].tdesc1 & 0xfff; | 418 | int length = ep->descs->tdesc[entry].tdesc1 & 0xfff; |
@@ -536,7 +573,7 @@ static int ep93xx_start_hw(struct net_device *dev) | |||
536 | } | 573 | } |
537 | 574 | ||
538 | if (i == 10) { | 575 | if (i == 10) { |
539 | printk(KERN_CRIT DRV_MODULE_NAME ": hw failed to reset\n"); | 576 | pr_crit("hw failed to reset\n"); |
540 | return 1; | 577 | return 1; |
541 | } | 578 | } |
542 | 579 | ||
@@ -581,7 +618,7 @@ static int ep93xx_start_hw(struct net_device *dev) | |||
581 | } | 618 | } |
582 | 619 | ||
583 | if (i == 10) { | 620 | if (i == 10) { |
584 | printk(KERN_CRIT DRV_MODULE_NAME ": hw failed to start\n"); | 621 | pr_crit("hw failed to start\n"); |
585 | return 1; | 622 | return 1; |
586 | } | 623 | } |
587 | 624 | ||
@@ -617,7 +654,7 @@ static void ep93xx_stop_hw(struct net_device *dev) | |||
617 | } | 654 | } |
618 | 655 | ||
619 | if (i == 10) | 656 | if (i == 10) |
620 | printk(KERN_CRIT DRV_MODULE_NAME ": hw failed to reset\n"); | 657 | pr_crit("hw failed to reset\n"); |
621 | } | 658 | } |
622 | 659 | ||
623 | static int ep93xx_open(struct net_device *dev) | 660 | static int ep93xx_open(struct net_device *dev) |
@@ -681,48 +718,6 @@ static int ep93xx_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) | |||
681 | return generic_mii_ioctl(&ep->mii, data, cmd, NULL); | 718 | return generic_mii_ioctl(&ep->mii, data, cmd, NULL); |
682 | } | 719 | } |
683 | 720 | ||
684 | static int ep93xx_mdio_read(struct net_device *dev, int phy_id, int reg) | ||
685 | { | ||
686 | struct ep93xx_priv *ep = netdev_priv(dev); | ||
687 | int data; | ||
688 | int i; | ||
689 | |||
690 | wrl(ep, REG_MIICMD, REG_MIICMD_READ | (phy_id << 5) | reg); | ||
691 | |||
692 | for (i = 0; i < 10; i++) { | ||
693 | if ((rdl(ep, REG_MIISTS) & REG_MIISTS_BUSY) == 0) | ||
694 | break; | ||
695 | msleep(1); | ||
696 | } | ||
697 | |||
698 | if (i == 10) { | ||
699 | printk(KERN_INFO DRV_MODULE_NAME ": mdio read timed out\n"); | ||
700 | data = 0xffff; | ||
701 | } else { | ||
702 | data = rdl(ep, REG_MIIDATA); | ||
703 | } | ||
704 | |||
705 | return data; | ||
706 | } | ||
707 | |||
708 | static void ep93xx_mdio_write(struct net_device *dev, int phy_id, int reg, int data) | ||
709 | { | ||
710 | struct ep93xx_priv *ep = netdev_priv(dev); | ||
711 | int i; | ||
712 | |||
713 | wrl(ep, REG_MIIDATA, data); | ||
714 | wrl(ep, REG_MIICMD, REG_MIICMD_WRITE | (phy_id << 5) | reg); | ||
715 | |||
716 | for (i = 0; i < 10; i++) { | ||
717 | if ((rdl(ep, REG_MIISTS) & REG_MIISTS_BUSY) == 0) | ||
718 | break; | ||
719 | msleep(1); | ||
720 | } | ||
721 | |||
722 | if (i == 10) | ||
723 | printk(KERN_INFO DRV_MODULE_NAME ": mdio write timed out\n"); | ||
724 | } | ||
725 | |||
726 | static void ep93xx_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) | 721 | static void ep93xx_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) |
727 | { | 722 | { |
728 | strcpy(info->driver, DRV_MODULE_NAME); | 723 | strcpy(info->driver, DRV_MODULE_NAME); |
@@ -825,12 +820,19 @@ static int ep93xx_eth_probe(struct platform_device *pdev) | |||
825 | struct ep93xx_eth_data *data; | 820 | struct ep93xx_eth_data *data; |
826 | struct net_device *dev; | 821 | struct net_device *dev; |
827 | struct ep93xx_priv *ep; | 822 | struct ep93xx_priv *ep; |
823 | struct resource *mem; | ||
824 | int irq; | ||
828 | int err; | 825 | int err; |
829 | 826 | ||
830 | if (pdev == NULL) | 827 | if (pdev == NULL) |
831 | return -ENODEV; | 828 | return -ENODEV; |
832 | data = pdev->dev.platform_data; | 829 | data = pdev->dev.platform_data; |
833 | 830 | ||
831 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
832 | irq = platform_get_irq(pdev, 0); | ||
833 | if (!mem || irq < 0) | ||
834 | return -ENXIO; | ||
835 | |||
834 | dev = ep93xx_dev_alloc(data); | 836 | dev = ep93xx_dev_alloc(data); |
835 | if (dev == NULL) { | 837 | if (dev == NULL) { |
836 | err = -ENOMEM; | 838 | err = -ENOMEM; |
@@ -842,23 +844,21 @@ static int ep93xx_eth_probe(struct platform_device *pdev) | |||
842 | 844 | ||
843 | platform_set_drvdata(pdev, dev); | 845 | platform_set_drvdata(pdev, dev); |
844 | 846 | ||
845 | ep->res = request_mem_region(pdev->resource[0].start, | 847 | ep->res = request_mem_region(mem->start, resource_size(mem), |
846 | pdev->resource[0].end - pdev->resource[0].start + 1, | 848 | dev_name(&pdev->dev)); |
847 | dev_name(&pdev->dev)); | ||
848 | if (ep->res == NULL) { | 849 | if (ep->res == NULL) { |
849 | dev_err(&pdev->dev, "Could not reserve memory region\n"); | 850 | dev_err(&pdev->dev, "Could not reserve memory region\n"); |
850 | err = -ENOMEM; | 851 | err = -ENOMEM; |
851 | goto err_out; | 852 | goto err_out; |
852 | } | 853 | } |
853 | 854 | ||
854 | ep->base_addr = ioremap(pdev->resource[0].start, | 855 | ep->base_addr = ioremap(mem->start, resource_size(mem)); |
855 | pdev->resource[0].end - pdev->resource[0].start); | ||
856 | if (ep->base_addr == NULL) { | 856 | if (ep->base_addr == NULL) { |
857 | dev_err(&pdev->dev, "Failed to ioremap ethernet registers\n"); | 857 | dev_err(&pdev->dev, "Failed to ioremap ethernet registers\n"); |
858 | err = -EIO; | 858 | err = -EIO; |
859 | goto err_out; | 859 | goto err_out; |
860 | } | 860 | } |
861 | ep->irq = pdev->resource[1].start; | 861 | ep->irq = irq; |
862 | 862 | ||
863 | ep->mii.phy_id = data->phy_id; | 863 | ep->mii.phy_id = data->phy_id; |
864 | ep->mii.phy_id_mask = 0x1f; | 864 | ep->mii.phy_id_mask = 0x1f; |
@@ -877,11 +877,8 @@ static int ep93xx_eth_probe(struct platform_device *pdev) | |||
877 | goto err_out; | 877 | goto err_out; |
878 | } | 878 | } |
879 | 879 | ||
880 | printk(KERN_INFO "%s: ep93xx on-chip ethernet, IRQ %d, " | 880 | printk(KERN_INFO "%s: ep93xx on-chip ethernet, IRQ %d, %pM\n", |
881 | "%.2x:%.2x:%.2x:%.2x:%.2x:%.2x.\n", dev->name, | 881 | dev->name, ep->irq, dev->dev_addr); |
882 | ep->irq, data->dev_addr[0], data->dev_addr[1], | ||
883 | data->dev_addr[2], data->dev_addr[3], | ||
884 | data->dev_addr[4], data->dev_addr[5]); | ||
885 | 882 | ||
886 | return 0; | 883 | return 0; |
887 | 884 | ||