Changeset 24180


Ignore:
Timestamp:
2010-11-28T19:03:56+01:00 (5 years ago)
Author:
florian
Message:

[ar7] refresh and refine 972-cpmac_multi_probe.patch, patch from sn9

File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/target/linux/ar7/patches-2.6.32/972-cpmac_multi_probe.patch

    r24142 r24180  
    11Index: linux-2.6.32.26/arch/mips/ar7/platform.c 
    22=================================================================== 
    3 --- linux-2.6.32.26.orig/arch/mips/ar7/platform.c       2010-11-24 13:16:31.367487844 -0800 
    4 +++ linux-2.6.32.26/arch/mips/ar7/platform.c    2010-11-24 13:16:49.677512306 -0800 
    5 @@ -33,7 +33,6 @@ 
    6  #include <linux/string.h> 
    7  #include <linux/etherdevice.h> 
    8  #include <linux/phy.h> 
    9 -#include <linux/phy_fixed.h> 
    10   
    11  #include <asm/addrspace.h> 
    12  #include <asm/mach-ar7/ar7.h> 
    13 @@ -46,7 +45,6 @@ 
     3--- linux-2.6.32.26.orig/arch/mips/ar7/platform.c       2010-11-28 03:22:24.522383766 -0800 
     4+++ linux-2.6.32.26/arch/mips/ar7/platform.c    2010-11-28 04:17:24.872413302 -0800 
     5@@ -46,7 +46,6 @@ 
    146        int reset_bit; 
    157 }; 
     
    1911 { 
    2012        int result; 
    21 @@ -72,7 +70,8 @@ 
     13@@ -72,7 +71,8 @@ 
    2214  
    2315        msleep(50); 
     
    2921  
    3022        return 0; 
    31 @@ -294,16 +293,10 @@ 
    32         .width = 2, 
    33  }; 
    34   
    35 -static struct fixed_phy_status fixed_phy_status __initdata = { 
    36 -       .link = 1, 
    37 -       .speed = 100, 
    38 -       .duplex = 1, 
    39 -}; 
    40 - 
    41  static struct plat_cpmac_data cpmac_low_data = { 
    42         .reset_bit = 17, 
    43         .power_bit = 20, 
    44 -       .phy_mask = 0x80000000, 
    45 +       .phy_mask = 0xffffffff, 
    46  }; 
    47   
    48  static struct plat_cpmac_data cpmac_high_data = { 
    49 @@ -716,11 +709,6 @@ 
    50         } 
    51   
    52         if (ar7_has_high_cpmac()) { 
     23@@ -601,6 +601,18 @@ 
     24        } 
     25 } 
     26  
     27+static void auto_mdix_on(void) 
     28+{ 
     29+       ar7_gpio_enable(28); 
     30+       ar7_gpio_disable(30); 
     31+} 
     32+ 
     33+/*static void auto_mdix_off(void) 
     34+{ 
     35+       ar7_gpio_disable(28); 
     36+       ar7_gpio_disable(30); 
     37+}*/ 
     38+ 
     39 static void cpmac_get_mac(int instance, unsigned char *dev_addr) 
     40 { 
     41        int i; 
     42@@ -662,6 +674,7 @@ 
     43        u16 chip_id; 
     44        int res; 
     45        u32 *bootcr, val; 
     46+       void __iomem *mii_reg; 
     47 #ifdef CONFIG_SERIAL_8250 
     48        static struct uart_port uart_port[2]; 
     49  
     50@@ -715,27 +728,6 @@ 
     51                        return res; 
     52        } 
     53  
     54-       if (ar7_has_high_cpmac()) { 
    5355-               res = fixed_phy_add(PHY_POLL, ar7_is_titan() ? cpmac_high_titan.id : cpmac_high.id, 
    5456-                                               &fixed_phy_status); 
     
    5658-                       return res; 
    5759- 
    58                 cpmac_get_mac(1, ar7_is_titan() ? cpmac_high_data_titan.dev_addr : 
    59                                                 cpmac_high_data.dev_addr); 
    60                 res = platform_device_register(ar7_is_titan() ? &cpmac_high_titan : 
    61 @@ -728,19 +716,8 @@ 
    62   
    63                 if (res) 
    64                         return res; 
     60-               cpmac_get_mac(1, ar7_is_titan() ? cpmac_high_data_titan.dev_addr : 
     61-                                               cpmac_high_data.dev_addr); 
     62-               res = platform_device_register(ar7_is_titan() ? &cpmac_high_titan : 
     63-                                               &cpmac_high); 
     64- 
     65-               if (res) 
     66-                       return res; 
    6567-       } else { 
    6668-               if (ar7_is_titan()) 
     
    6971-                       cpmac_low_data.phy_mask = 0xffffffff; 
    7072- 
    71         } 
    72   
    73 -       res = fixed_phy_add(PHY_POLL, ar7_is_titan() ? cpmac_low_titan.id : 
    74 -                       cpmac_low.id, &fixed_phy_status); 
    75 -       if (res && res != -ENODEV) 
    76 -               return res; 
    77 - 
    78         cpmac_get_mac(0, ar7_is_titan() ? cpmac_low_data_titan.dev_addr : 
    79                         cpmac_low_data.dev_addr); 
    80         res = platform_device_register(ar7_is_titan() ? &cpmac_low_titan : 
     73-       } 
     74- 
     75        res = fixed_phy_add(PHY_POLL, ar7_is_titan() ? cpmac_low_titan.id : 
     76                        cpmac_low.id, &fixed_phy_status); 
     77        if (res && res != -ENODEV) 
     78@@ -748,6 +740,34 @@ 
     79        if (res) 
     80                return res; 
     81  
     82+       if (ar7_has_high_cpmac()) { 
     83+               res = fixed_phy_add(PHY_POLL, ar7_is_titan() ? 
     84+                               cpmac_high_titan.id : cpmac_high.id, 
     85+                               &fixed_phy_status); 
     86+               if (res && res != -ENODEV) 
     87+                       return res; 
     88+ 
     89+               cpmac_get_mac(1, ar7_is_titan() ? 
     90+                               cpmac_high_data_titan.dev_addr : 
     91+                               cpmac_high_data.dev_addr); 
     92+               res = platform_device_register(ar7_is_titan() ? 
     93+                               &cpmac_high_titan : &cpmac_high); 
     94+ 
     95+               if (res) 
     96+                       return res; 
     97+       } else { 
     98+               mii_reg = ioremap(AR7_REGS_MII, 4); 
     99+               if (mii_reg) { 
     100+                       writel(readl(mii_reg) | 1, mii_reg); 
     101+                       iounmap(mii_reg); 
     102+               } 
     103+ 
     104+               ar7_gpio_disable(17); 
     105+               mdelay(20); 
     106+               ar7_gpio_enable(17); 
     107+               auto_mdix_on(); 
     108+       } 
     109+ 
     110        detect_leds(); 
     111        res = platform_device_register(&ar7_gpio_leds); 
     112        if (res) 
     113@@ -771,8 +791,10 @@ 
     114        ar7_wdt_res.end = ar7_wdt_res.start + 0x20; 
     115  
     116        bootcr = (u32 *)ioremap_nocache(AR7_REGS_DCL, 4); 
     117-       val = *bootcr; 
     118-       iounmap(bootcr); 
     119+       if (bootcr) { 
     120+               val = *bootcr; 
     121+               iounmap(bootcr); 
     122+       } 
     123  
     124        /* Register watchdog only if enabled in hardware */ 
     125        if (val & AR7_WDT_HW_ENA) 
    81126Index: linux-2.6.32.26/arch/mips/include/asm/mach-ar7/ar7.h 
    82127=================================================================== 
    83 --- linux-2.6.32.26.orig/arch/mips/include/asm/mach-ar7/ar7.h   2010-11-24 13:16:31.387502677 -0800 
    84 +++ linux-2.6.32.26/arch/mips/include/asm/mach-ar7/ar7.h        2010-11-24 13:16:37.117485679 -0800 
     128--- linux-2.6.32.26.orig/arch/mips/include/asm/mach-ar7/ar7.h   2010-11-28 03:22:24.522383766 -0800 
     129+++ linux-2.6.32.26/arch/mips/include/asm/mach-ar7/ar7.h        2010-11-28 03:22:25.012385426 -0800 
    85130@@ -41,6 +41,7 @@ 
    86131 #define AR7_REGS_RESET (AR7_REGS_BASE + 0x1600) 
     
    93138Index: linux-2.6.32.26/drivers/net/cpmac.c 
    94139=================================================================== 
    95 --- linux-2.6.32.26.orig/drivers/net/cpmac.c    2010-11-24 13:16:31.397493402 -0800 
    96 +++ linux-2.6.32.26/drivers/net/cpmac.c 2010-11-24 13:16:37.117485679 -0800 
    97 @@ -218,6 +218,12 @@ 
    98  static int cpmac_stop(struct net_device *dev); 
    99  static int cpmac_open(struct net_device *dev); 
    100   
    101 +static struct fixed_phy_status fixed_phy_status = { 
    102 +       .link = 1, 
    103 +       .speed = 100, 
    104 +       .duplex = 1, 
    105 +}; 
    106 + 
    107  static void cpmac_dump_regs(struct net_device *dev) 
    108  { 
    109         int i; 
    110 @@ -269,6 +275,18 @@ 
    111         printk("\n"); 
    112  } 
    113   
    114 +static void auto_mdix_on(void) 
    115 +{ 
    116 +       ar7_gpio_enable(28); 
    117 +       ar7_gpio_disable(30); 
    118 +} 
    119 + 
    120 +/*static void auto_mdix_off(void) 
    121 +{ 
    122 +       ar7_gpio_disable(28); 
    123 +       ar7_gpio_disable(30); 
    124 +}*/ 
    125 + 
    126  static int cpmac_mdio_read(struct mii_bus *bus, int phy_id, int reg) 
    127  { 
    128         u32 val; 
    129 @@ -1104,8 +1122,6 @@ 
     140--- linux-2.6.32.26.orig/drivers/net/cpmac.c    2010-11-28 03:22:24.982383427 -0800 
     141+++ linux-2.6.32.26/drivers/net/cpmac.c 2010-11-28 05:23:59.482390691 -0800 
     142@@ -668,9 +668,8 @@ 
     143        for (i = 0; i < 8; i++) 
     144                cpmac_write(priv->regs, CPMAC_MAC_ADDR_LO(i), dev->dev_addr[5]); 
     145        cpmac_write(priv->regs, CPMAC_MAC_ADDR_MID, dev->dev_addr[4]); 
     146-       cpmac_write(priv->regs, CPMAC_MAC_ADDR_HI, dev->dev_addr[0] | 
     147-                   (dev->dev_addr[1] << 8) | (dev->dev_addr[2] << 16) | 
     148-                   (dev->dev_addr[3] << 24)); 
     149+       cpmac_write(priv->regs, CPMAC_MAC_ADDR_HI, be32_to_cpu(*(u32 *) 
     150+                       dev->dev_addr)); 
     151        cpmac_write(priv->regs, CPMAC_MAX_LENGTH, CPMAC_SKB_SIZE); 
     152        cpmac_write(priv->regs, CPMAC_UNICAST_CLEAR, 0xff); 
     153        cpmac_write(priv->regs, CPMAC_RX_INT_CLEAR, 0xff); 
     154@@ -1104,8 +1103,6 @@ 
    130155        .ndo_set_mac_address    = eth_mac_addr, 
    131156 }; 
     
    136161 { 
    137162        int rc, phy_id; 
    138 @@ -1114,13 +1130,15 @@ 
    139         struct cpmac_priv *priv; 
    140         struct net_device *dev; 
    141         struct plat_cpmac_data *pdata; 
    142 +       void __iomem *mii_reg; 
    143 +       u32 tmp; 
    144 +       unsigned external_mii; 
     163@@ -1117,24 +1114,26 @@ 
    145164  
    146165        pdata = pdev->dev.platform_data; 
     
    150169-               phy_id = pdev->id; 
    151170-       } else { 
     171-               for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) { 
     172-                       if (!(pdata->phy_mask & (1 << phy_id))) 
     173-                               continue; 
     174-                       if (!cpmac_mii->phy_map[phy_id]) 
     175-                               continue; 
     176-                       strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE); 
     177-                       break; 
     178-               } 
    152179+       if (dumb_switch) 
    153180+               phy_id = PHY_MAX_ADDR; 
    154 +       else for (external_mii = 0; external_mii <= 1; external_mii++) { 
    155                 for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) { 
    156                         if (!(pdata->phy_mask & (1 << phy_id))) 
    157                                 continue; 
    158 @@ -1129,13 +1147,45 @@ 
    159                         strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE); 
    160                         break; 
    161                 } 
    162 + 
    163 +               if (phy_id == PHY_MAX_ADDR || external_mii || ar7_is_titan()) 
    164 +                       break; 
    165 + 
     181+       else for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) { 
     182+               if (!((pdata->phy_mask | cpmac_mii->phy_mask) & 
     183+                               (1 << phy_id))) 
     184+                       continue; 
     185+               if (cpmac_mii->phy_map[phy_id]) 
     186+                       continue; 
     187+               strncpy(mdio_bus_id, cpmac_mii->id, MII_BUS_ID_SIZE); 
     188+               break; 
     189        } 
     190  
     191        if (phy_id == PHY_MAX_ADDR) { 
     192                dev_err(&pdev->dev, "no PHY present, falling back to switch mode\n"); 
     193                strncpy(mdio_bus_id, "0", MII_BUS_ID_SIZE); /* fixed phys bus */ 
     194                phy_id = pdev->id; 
     195+       } else { 
    166196+               /* Now disable EPHY and enable MII */ 
    167197+               dev_info(&pdev->dev, "trying external MII\n"); 
    168198+               ar7_device_disable(AR7_RESET_BIT_EPHY); 
    169 + 
    170 +               if (!ar7_has_high_cpmac()) { 
    171 +                       mii_reg = ioremap(AR7_REGS_MII, 4); 
    172 +                       if (!mii_reg) { 
    173 +                               dev_err(&pdev->dev, "failed to iorenamp MII_SEL\n"); 
    174 +                               return -ENOMEM; 
    175 +                       } 
    176 + 
    177 +                       tmp = readl(mii_reg); 
    178 +                       tmp |= 1; 
    179 +                       writel(tmp, mii_reg); 
    180 +                       iounmap(mii_reg); 
    181 +               } 
    182 + 
    183 +               ar7_gpio_disable(17); 
    184 +               mdelay(20); 
    185 +               ar7_gpio_enable(17); 
    186         } 
    187   
    188         if (phy_id == PHY_MAX_ADDR) { 
    189 -               dev_err(&pdev->dev, "no PHY present, falling back to switch mode\n"); 
    190 +               /* This still does not work, so now we register a fixed phy */ 
    191 +               dev_info(&pdev->dev, "using fixed PHY\n"); 
    192 +               rc = fixed_phy_add(PHY_POLL, pdev->id, &fixed_phy_status); 
    193 +               if (rc && rc != -ENODEV) { 
    194 +                       dev_err(&pdev->dev, "unable to register fixed PHY\n"); 
    195 +                       return rc; 
    196 +               } 
    197 + 
    198                 strncpy(mdio_bus_id, "0", MII_BUS_ID_SIZE); /* fixed phys bus */ 
    199                 phy_id = pdev->id; 
    200 -       } 
    201 +       } else 
    202 +               auto_mdix_on(); 
     199        } 
    203200  
    204201        dev = alloc_etherdev_mq(sizeof(*priv), CPMAC_QUEUES); 
    205   
    206 @@ -1244,14 +1294,14 @@ 
     202@@ -1168,7 +1167,7 @@ 
     203        priv->dev = dev; 
     204        priv->ring_size = 64; 
     205        priv->msg_enable = netif_msg_init(debug_level, 0xff); 
     206-       memcpy(dev->dev_addr, pdata->dev_addr, sizeof(dev->dev_addr)); 
     207+       memcpy(dev->dev_addr, pdata->dev_addr, sizeof(pdata->dev_addr)); 
     208  
     209        snprintf(priv->phy_name, MII_BUS_ID_SIZE, PHY_ID_FMT, mdio_bus_id, phy_id); 
     210  
     211@@ -1244,14 +1243,14 @@ 
    207212        ar7_gpio_disable(26); 
    208213        ar7_gpio_disable(27); 
     
    224229  
    225230        cpmac_mii->reset(cpmac_mii); 
    226 @@ -1262,12 +1312,6 @@ 
     231@@ -1262,14 +1261,7 @@ 
    227232                else 
    228233                        msleep(10); 
     
    234239-       } 
    235240- 
    236         cpmac_mii->phy_mask = ar7_is_titan()? ~(mask | 0x80000000 | 0x40000000): 
    237                 ~(mask | 0x80000000); 
     241-       cpmac_mii->phy_mask = ar7_is_titan()? ~(mask | 0x80000000 | 0x40000000): 
     242-               ~(mask | 0x80000000); 
     243+       cpmac_mii->phy_mask = ~mask; 
    238244        snprintf(cpmac_mii->id, MII_BUS_ID_SIZE, "1"); 
     245  
     246        res = mdiobus_register(cpmac_mii); 
Note: See TracChangeset for help on using the changeset viewer.