From fdd05db0d82444904825dfd6b0abdc5f7d37cb5a Mon Sep 17 00:00:00 2001
From: Gabor Juhos <juhosg@openwrt.org>
Date: Tue, 25 Nov 2008 17:55:46 +0000
Subject: [PATCH] enable gigabit feature if the SoC supports it

SVN-Revision: 13350
---
 .../ar71xx/files/arch/mips/ar71xx/platform.c  | 54 +++++++++++++++----
 1 file changed, 43 insertions(+), 11 deletions(-)

diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
index 1ebbe748b0f4..81cd20a4e845 100644
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
@@ -254,6 +254,7 @@ static int ar71xx_eth_instance __initdata;
 void __init ar71xx_add_device_eth(unsigned int id)
 {
 	struct platform_device *pdev;
+	struct ag71xx_platform_data *pdata;
 
 	switch (id) {
 	case 0:
@@ -271,10 +272,10 @@ void __init ar71xx_add_device_eth(unsigned int id)
 			ar71xx_eth0_data.mii_if = MII0_CTRL_IF_RMII;
 			break;
 		default:
-			BUG();
+			printk(KERN_ERR "ar71xx: invalid PHY interface mode "
+					"for eth0\n");
+			return;
 		}
-		memcpy(ar71xx_eth0_data.mac_addr, ar71xx_mac_base, ETH_ALEN);
-		ar71xx_eth0_data.mac_addr[5] += ar71xx_eth_instance;
 		pdev = &ar71xx_eth0_device;
 		break;
 	case 1:
@@ -286,21 +287,52 @@ void __init ar71xx_add_device_eth(unsigned int id)
 			ar71xx_eth1_data.mii_if = MII1_CTRL_IF_RGMII;
 			break;
 		default:
-			BUG();
+			printk(KERN_ERR "ar71xx: invalid PHY interface mode "
+					"for eth1\n");
+			return;
 		}
-		memcpy(ar71xx_eth1_data.mac_addr, ar71xx_mac_base, ETH_ALEN);
-		ar71xx_eth1_data.mac_addr[5] += ar71xx_eth_instance;
 		pdev = &ar71xx_eth1_device;
 		break;
 	default:
-		pdev = NULL;
+		printk(KERN_ERR "ar71xx: invalid ethernet id %d\n", id);
+		return;
+	}
+
+	pdata = pdev->dev.platform_data;
+
+	switch (ar71xx_soc) {
+	case AR71XX_SOC_AR7141:
+	case AR71XX_SOC_AR7161:
+	case AR71XX_SOC_AR9132:
+		pdata->has_gbit = 1;
 		break;
+
+	case AR71XX_SOC_AR7130:
+	case AR71XX_SOC_AR9130:
+		break;
+
+	default:
+		BUG();
 	}
 
-	if (pdev) {
-		platform_device_register(pdev);
-		ar71xx_eth_instance++;
+	switch (pdata->phy_if_mode) {
+	case PHY_INTERFACE_MODE_GMII:
+	case PHY_INTERFACE_MODE_RGMII:
+		if (!pdata->has_gbit) {
+			printk(KERN_ERR "ar71xx: no gigabit available on eth%d\n",
+					id);
+			return;
+		}
+		/* fallthrough */
+	default:
+		break;
 	}
+
+	memcpy(pdata->mac_addr, ar71xx_mac_base, ETH_ALEN);
+	pdata->mac_addr[5] += ar71xx_eth_instance;
+
+	platform_device_register(pdev);
+	ar71xx_eth_instance++;
 }
 
 static struct resource ar71xx_spi_resources[] = {
@@ -432,7 +464,7 @@ void __init ar71xx_parse_mac_addr(char *mac_str)
 	if (t == ETH_ALEN)
 		ar71xx_set_mac_base(tmp);
 	else
-		printk(KERN_DEBUG "AR71XX: failed to parse mac address "
+		printk(KERN_DEBUG "ar71xx: failed to parse mac address "
 				"\"%s\"\n", mac_str);
 }
 
-- 
2.30.2