1
0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2024-12-26 00:26:47 +02:00

[ar7] rework multi_probe patch to be cleaner

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@22850 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
florian 2010-08-31 14:09:25 +00:00
parent 1aeafdb62d
commit c275201bb6

View File

@ -21,7 +21,21 @@
static void cpmac_dump_regs(struct net_device *dev) static void cpmac_dump_regs(struct net_device *dev)
{ {
int i; int i;
@@ -1122,12 +1129,39 @@ static int __devinit cpmac_probe(struct @@ -1111,9 +1118,13 @@ static int __devinit cpmac_probe(struct
struct cpmac_priv *priv;
struct net_device *dev;
struct plat_cpmac_data *pdata;
+ void __iomem *mii_reg;
+ u32 tmp;
+ unsigned external_mii = 0;
pdata = pdev->dev.platform_data;
+detect_again:
for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) {
if (!(pdata->phy_mask & (1 << phy_id)))
continue;
@@ -1122,12 +1133,43 @@ static int __devinit cpmac_probe(struct
strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE); strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE);
break; break;
} }
@ -30,22 +44,26 @@
- dev_err(&pdev->dev, "no PHY present\n"); - dev_err(&pdev->dev, "no PHY present\n");
- return -ENODEV; - return -ENODEV;
+ +
+ if (phy_id < PHY_MAX_ADDR) + if (phy_id < PHY_MAX_ADDR && !external_mii)
+ goto dev_alloc; + goto dev_alloc;
+ +
+ dev_info(&pdev->dev, "trying external MII\n");
+ /* Now disable EPHY and enable MII */ + /* Now disable EPHY and enable MII */
+ dev_info(&pdev->dev, "trying external MII\n");
+ ar7_device_disable(AR7_RESET_BIT_EPHY); + ar7_device_disable(AR7_RESET_BIT_EPHY);
+ *(unsigned long*) ioremap(0x08611A08, 4) |= 0x00000001;
+ +
+ for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) { + mii_reg = ioremap(AR7_REGS_MII, 4);
+ if (!(pdata->phy_mask & (1 << phy_id))) + if (!mii_reg) {
+ continue; + dev_err(&pdev->dev, "failed to iorenamp MII_SEL\n");
+ if (!cpmac_mii->phy_map[phy_id]) + return -ENOMEM;
+ continue; }
+ strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE);
+ break; + tmp = readl(mii_reg);
+ } + tmp |= 1;
+ writel(tmp, mii_reg);
+ external_mii++;
+
+ if (external_mii == 1)
+ goto detect_again;
+ +
+ if (phy_id < PHY_MAX_ADDR) + if (phy_id < PHY_MAX_ADDR)
+ goto dev_alloc; + goto dev_alloc;
@ -56,8 +74,8 @@
+ if (rc && rc != -ENODEV) { + if (rc && rc != -ENODEV) {
+ dev_err(&pdev->dev, "unable to register fixed PHY\n"); + dev_err(&pdev->dev, "unable to register fixed PHY\n");
+ return rc; + return rc;
} + }
+
+ strncpy(mdio_bus_id, "0", MII_BUS_ID_SIZE); /* fixed phys bus */ + strncpy(mdio_bus_id, "0", MII_BUS_ID_SIZE); /* fixed phys bus */
+ phy_id = pdev->id; + phy_id = pdev->id;
+ +
@ -65,3 +83,13 @@
dev = alloc_etherdev_mq(sizeof(*priv), CPMAC_QUEUES); dev = alloc_etherdev_mq(sizeof(*priv), CPMAC_QUEUES);
if (!dev) { if (!dev) {
--- a/arch/mips/include/asm/mach-ar7/ar7.h
+++ b/arch/mips/include/asm/mach-ar7/ar7.h
@@ -41,6 +41,7 @@
#define AR7_REGS_RESET (AR7_REGS_BASE + 0x1600)
#define AR7_REGS_VLYNQ0 (AR7_REGS_BASE + 0x1800)
#define AR7_REGS_DCL (AR7_REGS_BASE + 0x1a00)
+#define AR7_REGS_MII (AR7_REGS_BASE + 0x1a08)
#define AR7_REGS_VLYNQ1 (AR7_REGS_BASE + 0x1c00)
#define AR7_REGS_MDIO (AR7_REGS_BASE + 0x1e00)
#define AR7_REGS_IRQ (AR7_REGS_BASE + 0x2400)