2 files changed, 45 insertions, 8 deletions

diff --git a/arch/ppc/platforms/4xx/bamboo.c b/arch/ppc/platforms/4xx/bamboo.c
index f116787b0b76..05e2824db71c 100644
--- a/arch/ppc/platforms/4xx/bamboo.c
+++ b/arch/ppc/platforms/4xx/bamboo.c
@@ -123,33 +123,69 @@ bamboo_map_irq(struct pci_dev *dev, unsigned char idsel, unsigned char pin)
 
 static void __init bamboo_set_emacdata(void)
 {
-        unsigned char * selection1_base;
+        u8 * base_addr;
         struct ocp_def *def;
         struct ocp_func_emac_data *emacdata;
-        u8 selection1_val;
+        u8 val;
         int mode;
+        u32 excluded = 0;
 
-        selection1_base = ioremap64(BAMBOO_FPGA_SELECTION1_REG_ADDR, 16);
-        selection1_val = readb(selection1_base);
-        iounmap((void *) selection1_base);
-        if (BAMBOO_SEL_MII(selection1_val))
+        base_addr = ioremap64(BAMBOO_FPGA_SELECTION1_REG_ADDR, 16);
+        val = readb(base_addr);
+        iounmap((void *) base_addr);
+        if (BAMBOO_SEL_MII(val))
                 mode = PHY_MODE_MII;
-        else if (BAMBOO_SEL_RMII(selection1_val))
+        else if (BAMBOO_SEL_RMII(val))
                 mode = PHY_MODE_RMII;
         else
                 mode = PHY_MODE_SMII;
 
-        /* Set mac_addr and phy mode for each EMAC */
+        /*
+         * SW2 on the Bamboo is used for ethernet configuration and is accessed
+         * via the CONFIG2 register in the FPGA.  If the ANEG pin is set,
+         * overwrite the supported features with the settings in SW2.
+         *
+         * This is used as a workaround for the improperly biased RJ-45 sockets
+         * on the Rev. 0 Bamboo.  By default only 10baseT is functional.
+         * Removing inductors L17 and L18 from the board allows 100baseT, but
+         * disables 10baseT.  The Rev. 1 has no such limitations.
+         */
+
+        base_addr = ioremap64(BAMBOO_FPGA_CONFIG2_REG_ADDR, 8);
+        val = readb(base_addr);
+        iounmap((void *) base_addr);
+        if (!BAMBOO_AUTONEGOTIATE(val)) {
+                excluded |= SUPPORTED_Autoneg;
+                if (BAMBOO_FORCE_100Mbps(val)) {
+                        excluded |= SUPPORTED_10baseT_Full;
+                        excluded |= SUPPORTED_10baseT_Half;
+                        if (BAMBOO_FULL_DUPLEX_EN(val))
+                                excluded |= SUPPORTED_100baseT_Half;
+                        else
+                                excluded |= SUPPORTED_100baseT_Full;
+                } else {
+                        excluded |= SUPPORTED_100baseT_Full;
+                        excluded |= SUPPORTED_100baseT_Half;
+                        if (BAMBOO_FULL_DUPLEX_EN(val))
+                                excluded |= SUPPORTED_10baseT_Half;
+                        else
+                                excluded |= SUPPORTED_10baseT_Full;
+                }
+        }
+
+        /* Set mac_addr, phy mode and unsupported phy features for each EMAC */
 
         def = ocp_get_one_device(OCP_VENDOR_IBM, OCP_FUNC_EMAC, 0);
         emacdata = def->additions;
         memcpy(emacdata->mac_addr, __res.bi_enetaddr, 6);
         emacdata->phy_mode = mode;
+        emacdata->phy_feat_exc = excluded;
 
         def = ocp_get_one_device(OCP_VENDOR_IBM, OCP_FUNC_EMAC, 1);
         emacdata = def->additions;
         memcpy(emacdata->mac_addr, __res.bi_enet1addr, 6);
         emacdata->phy_mode = mode;
+        emacdata->phy_feat_exc = excluded;
 }
 
 static int
diff --git a/include/asm-ppc/ibm_ocp.h b/include/asm-ppc/ibm_ocp.h
index 3f7b5669e6d5..a33053503ed1 100644
--- a/include/asm-ppc/ibm_ocp.h
+++ b/include/asm-ppc/ibm_ocp.h
@@ -67,6 +67,7 @@ struct ocp_func_emac_data {
         int     phy_mode;       /* PHY type or configurable mode */
         u8      mac_addr[6];    /* EMAC mac address */
         u32     phy_map;        /* EMAC phy map */
+        u32     phy_feat_exc;   /* Excluded PHY features */
 };
 
 /* Sysfs support */