From: juhosg <juhosg@3c298f89-4303-0410-b956-a3cf2f4a3e73>
Date: Sun, 13 Nov 2011 11:26:54 +0000 (+0000)
Subject: ar71xx: configure MII interface type from ar71xx_setup_phy_if_mode
X-Git-Url: https://git.rohieb.name/openwrt.git/commitdiff_plain/13e0098939bc3c67dd0f2e9b395318c4914b56de

ar71xx: configure MII interface type from ar71xx_setup_phy_if_mode

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@29010 3c298f89-4303-0410-b956-a3cf2f4a3e73
---

diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/devices.c b/target/linux/ar71xx/files/arch/mips/ar71xx/devices.c
index e62d1123d..2d73dd044 100644
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/devices.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/devices.c
@@ -190,6 +190,22 @@ static void ar71xx_set_pll(u32 cfg_reg, u32 pll_reg, u32 pll_val, u32 shift)
 	iounmap(base);
 }
 
+static void __init ar71xx_mii_ctrl_set_if(unsigned int reg,
+					  unsigned int mii_if)
+{
+	void __iomem *base;
+	u32 t;
+
+	base = ioremap(AR71XX_MII_BASE, AR71XX_MII_SIZE);
+
+	t = __raw_readl(base + reg);
+	t &= ~(MII_CTRL_IF_MASK);
+	t |= (mii_if & MII_CTRL_IF_MASK);
+	__raw_writel(t, base + reg);
+
+	iounmap(base);
+}
+
 void __init ar71xx_add_device_mdio(unsigned int id, u32 phy_mask)
 {
 	struct platform_device *mdio_dev;
@@ -588,6 +604,8 @@ static void __init ar71xx_init_eth_pll_data(unsigned int id)
 static int __init ar71xx_setup_phy_if_mode(unsigned int id,
 					   struct ag71xx_platform_data *pdata)
 {
+	unsigned int mii_if;
+
 	switch (id) {
 	case 0:
 		switch (ar71xx_soc) {
@@ -598,20 +616,21 @@ static int __init ar71xx_setup_phy_if_mode(unsigned int id,
 		case AR71XX_SOC_AR9132:
 			switch (pdata->phy_if_mode) {
 			case PHY_INTERFACE_MODE_MII:
-				pdata->mii_if = MII0_CTRL_IF_MII;
+				mii_if = MII0_CTRL_IF_MII;
 				break;
 			case PHY_INTERFACE_MODE_GMII:
-				pdata->mii_if = MII0_CTRL_IF_GMII;
+				mii_if = MII0_CTRL_IF_GMII;
 				break;
 			case PHY_INTERFACE_MODE_RGMII:
-				pdata->mii_if = MII0_CTRL_IF_RGMII;
+				mii_if = MII0_CTRL_IF_RGMII;
 				break;
 			case PHY_INTERFACE_MODE_RMII:
-				pdata->mii_if = MII0_CTRL_IF_RMII;
+				mii_if = MII0_CTRL_IF_RMII;
 				break;
 			default:
 				return -EINVAL;
 			}
+			ar71xx_mii_ctrl_set_if(MII_REG_MII0_CTRL, mii_if);
 			break;
 
 		case AR71XX_SOC_AR7240:
@@ -651,14 +670,15 @@ static int __init ar71xx_setup_phy_if_mode(unsigned int id,
 		case AR71XX_SOC_AR9132:
 			switch (pdata->phy_if_mode) {
 			case PHY_INTERFACE_MODE_RMII:
-				pdata->mii_if = MII1_CTRL_IF_RMII;
+				mii_if = MII1_CTRL_IF_RMII;
 				break;
 			case PHY_INTERFACE_MODE_RGMII:
-				pdata->mii_if = MII1_CTRL_IF_RGMII;
+				mii_if = MII1_CTRL_IF_RGMII;
 				break;
 			default:
 				return -EINVAL;
 			}
+			ar71xx_mii_ctrl_set_if(MII_REG_MII1_CTRL, mii_if);
 			break;
 
 		case AR71XX_SOC_AR7240:
diff --git a/target/linux/ar71xx/files/arch/mips/include/asm/mach-ar71xx/ar71xx.h b/target/linux/ar71xx/files/arch/mips/include/asm/mach-ar71xx/ar71xx.h
index 99f34973b..c447e3e8f 100644
--- a/target/linux/ar71xx/files/arch/mips/include/asm/mach-ar71xx/ar71xx.h
+++ b/target/linux/ar71xx/files/arch/mips/include/asm/mach-ar71xx/ar71xx.h
@@ -816,6 +816,8 @@ void ar71xx_flash_release(void);
 #define MII_REG_MII0_CTRL	0x00
 #define MII_REG_MII1_CTRL	0x04
 
+#define MII_CTRL_IF_MASK	3
+
 #define MII0_CTRL_IF_GMII	0
 #define MII0_CTRL_IF_MII	1
 #define MII0_CTRL_IF_RGMII	2