parse mac address on RouterBOARDs

SVN-Revision: 11910

5 files changed, 78 insertions, 29 deletions

diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
index 9c91fa3..07bec24 100644
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
@@ -22,6 +22,8 @@
 #include <asm/mach-ar71xx/ar71xx.h>
 #include <asm/mach-ar71xx/platform.h>
 
+static u8 ar71xx_mac_base[ETH_ALEN] __initdata;
+
 /*
  * OHCI (USB full speed host controller)
  */
@@ -232,6 +234,7 @@ void __init ar71xx_add_device_eth(unsigned int id, phy_interface_t phy_if_mode,
 		default:
 			BUG();
 		}
+		memcpy(ar71xx_eth0_data.mac_addr, ar71xx_mac_base, ETH_ALEN);
 		ar71xx_eth0_data.phy_if_mode = phy_if_mode;
 		ar71xx_eth0_data.phy_mask = phy_mask;
 		pdev = &ar71xx_eth0_device;
@@ -247,6 +250,8 @@ void __init ar71xx_add_device_eth(unsigned int id, phy_interface_t phy_if_mode,
 		default:
 			BUG();
 		}
+		memcpy(ar71xx_eth1_data.mac_addr, ar71xx_mac_base, ETH_ALEN);
+		ar71xx_eth1_data.mac_addr[5] += id;
 		ar71xx_eth1_data.phy_if_mode = phy_if_mode;
 		ar71xx_eth1_data.phy_mask = phy_mask;
 		pdev = &ar71xx_eth1_device;
@@ -286,6 +291,21 @@ void __init ar71xx_add_device_spi(struct ar71xx_spi_platform_data *pdata,
 	platform_device_register(&ar71xx_spi_device);
 }
 
+void __init ar71xx_set_mac_base(char *mac_str)
+{
+	u8 tmp[ETH_ALEN];
+	int t;
+
+	t = sscanf(mac_str, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",
+			&tmp[0], &tmp[1], &tmp[2], &tmp[3], &tmp[4], &tmp[5]);
+
+	if (t == ETH_ALEN)
+		memcpy(ar71xx_mac_base, tmp, ETH_ALEN);
+	else
+		printk(KERN_DEBUG "AR71XX: failed to parse mac address "
+				"\"%s\"\n", mac_str);
+}
+
 static int __init ar71xx_machine_setup(void)
 {
 	ar71xx_print_cmdline();
diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c b/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c
index e21464f..69425d5 100644
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c
@@ -18,15 +18,16 @@
 #include <asm/addrspace.h>
 
 #include <asm/mach-ar71xx/ar71xx.h>
+#include <asm/mach-ar71xx/platform.h>
 
 struct board_rec {
 	char		*name;
 	unsigned long	mach_type;
 };
 
-static int prom_argc __initdata;
-static char **prom_argv __initdata;
-static char **prom_envp __initdata;
+static int ar71xx_prom_argc __initdata;
+static char **ar71xx_prom_argv __initdata;
+static char **ar71xx_prom_envp __initdata;
 
 static struct board_rec boards[] __initdata = {
 	{
@@ -41,30 +42,37 @@ static struct board_rec boards[] __initdata = {
 	}
 };
 
-char *(*prom_getenv)(const char *envname) __initdata;
-
-static __init char *dummy_getenv(const char *envname)
+static __init void routerboot_printargs(void)
 {
-	return NULL;
+	int i;
+
+	for (i = 0; i < ar71xx_prom_argc; i++)
+		printk(KERN_DEBUG "prom: routerboot envp[%d]: %s\n",
+				i, ar71xx_prom_argv[i]);
 }
 
-static void __init routerboot_printargs(void)
+static __init char *routerboot_getenv(const char *envname)
 {
+	int len = strlen(envname);
 	int i;
 
-	for (i = 0; i < prom_argc; i++)
-		printk(KERN_DEBUG "prom: routerboot envp[%d]: %s\n",
-				i, prom_envp[i]);
+	for (i = 0; i < ar71xx_prom_argc; i++) {
+		char *env = ar71xx_prom_argv[i];
+		if (strncmp(envname, env, len) == 0 && (env)[len] == '=')
+			return env + len + 1;
+	}
+
+	return NULL;
 }
 
-static __init char *routerboot_getenv(const char *envname)
+static __init char *redboot_getenv(const char *envname)
 {
+	int len = strlen(envname);
 	char **env;
-	int i = strlen(envname);
 
-	for (env = prom_envp; *env != NULL; env++)
-		if (strncmp(envname, *env, i) == 0 && (*env)[i] == '=')
-			return *env + i + 1;
+	for (env = ar71xx_prom_envp; *env != NULL; env++)
+		if (strncmp(envname, *env, len) == 0 && (*env)[len] == '=')
+			return *env + len + 1;
 
 	return NULL;
 }
@@ -82,28 +90,37 @@ static __init unsigned long find_board_byname(char *name)
 
 void __init prom_init(void)
 {
-	char *board;
+	char *board = NULL;
+	char *mac = NULL;
 
 	printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
 			"fw_arg2=%08x, fw_arg3=%08x\n",
 			(unsigned int)fw_arg0, (unsigned int)fw_arg1,
 			(unsigned int)fw_arg2, (unsigned int)fw_arg3);
 
-	prom_getenv = dummy_getenv;
-
-	if ((fw_arg0 == 7) && (fw_arg2 == 0)) {
-		prom_argc = fw_arg0;
-		prom_envp = (char **)fw_arg1;
-		prom_getenv = routerboot_getenv;
+	if ((fw_arg0 == 7) && (fw_arg2 == 0) && (fw_arg3 == 0)) {
+		 /* assume RouterBOOT */
+		ar71xx_prom_argc = fw_arg0;
+		ar71xx_prom_argv = (char **)fw_arg1;
 		routerboot_printargs();
+		board = routerboot_getenv("board");
+		mac = routerboot_getenv("kmac");
+	} else {
+		/* assume Redboot */
+		ar71xx_prom_argc = fw_arg0;
+		ar71xx_prom_argv = (char **)fw_arg1;
+		ar71xx_prom_envp = (char **)fw_arg2;
+		mac = redboot_getenv("ethaddr");
 	}
 
-	board = prom_getenv("board");
 	if (board)
 		mips_machtype = find_board_byname(board);
 	else
 		mips_machtype = MACH_AR71XX_GENERIC;
 
+	if (mac)
+		ar71xx_set_mac_base(mac);
+
 	ar71xx_print_cmdline();
 }
 
diff --git a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx.h b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx.h
index e22a7e6..247667d 100644
--- a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx.h
+++ b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx.h
@@ -18,6 +18,7 @@
 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/types.h>
+#include <linux/random.h>
 #include <linux/spinlock.h>
 #include <linux/interrupt.h>
 #include <linux/platform_device.h>
@@ -35,7 +36,7 @@
 #define ETH_FCS_LEN	4
 
 #define AG71XX_DRV_NAME		"ag71xx"
-#define AG71XX_DRV_VERSION	"0.3.9"
+#define AG71XX_DRV_VERSION	"0.3.10"
 
 #define AG71XX_NAPI_TX		1
 
diff --git a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_main.c b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_main.c
index d4eebda..065f603 100644
--- a/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_main.c
+++ b/target/linux/ar71xx/files/drivers/net/ag71xx/ag71xx_main.c
@@ -692,13 +692,14 @@ static void ag71xx_set_multicast_list(struct net_device *dev)
 
 static int __init ag71xx_probe(struct platform_device *pdev)
 {
-	static u8 default_mac[ETH_ALEN] = {0x00, 0xba, 0xdb, 0xad, 0xba, 0xd0};
 	struct net_device *dev;
 	struct resource *res;
 	struct ag71xx *ag;
+	struct ag71xx_platform_data *pdata;
 	int err;
 
-	if (!pdev->dev.platform_data) {
+	pdata = pdev->dev.platform_data;
+	if (!pdata) {
 		dev_err(&pdev->dev, "no platform data specified\n");
 		err = -ENXIO;
 		goto err_out;
@@ -765,8 +766,14 @@ static int __init ag71xx_probe(struct platform_device *pdev)
 
 	netif_napi_add(dev, &ag->napi, ag71xx_poll, AG71XX_NAPI_WEIGHT);
 
-	memcpy(dev->dev_addr, default_mac, ETH_ALEN);
-	dev->dev_addr[5] += pdev->id & 0xff;
+	if (is_valid_ether_addr(pdata->mac_addr))
+		memcpy(dev->dev_addr, pdata->mac_addr, ETH_ALEN);
+	else {
+		dev->dev_addr[0] = 0xde;
+		dev->dev_addr[1] = 0xad;
+		get_random_bytes(&dev->dev_addr[2], 3);
+		dev->dev_addr[5] = pdev->id & 0xff;
+	}
 
 	err = register_netdev(dev);
 	if (err) {
diff --git a/target/linux/ar71xx/files/include/asm-mips/mach-ar71xx/platform.h b/target/linux/ar71xx/files/include/asm-mips/mach-ar71xx/platform.h
index 6c23340..f24ff80 100644
--- a/target/linux/ar71xx/files/include/asm-mips/mach-ar71xx/platform.h
+++ b/target/linux/ar71xx/files/include/asm-mips/mach-ar71xx/platform.h
@@ -12,6 +12,7 @@
 #ifndef __ASM_MACH_AR71XX_PLATFORM_H
 #define __ASM_MACH_AR71XX_PLATFORM_H
 
+#include <linux/if_ether.h>
 #include <linux/skbuff.h>
 #include <linux/phy.h>
 #include <linux/spi/spi.h>
@@ -22,6 +23,7 @@ struct ag71xx_platform_data {
 	u32		phy_mask;
 	phy_interface_t	phy_if_mode;
 	u32		mii_if;
+	u8		mac_addr[ETH_ALEN];
 };
 
 struct ar71xx_spi_platform_data {
@@ -36,6 +38,8 @@ struct ar71xx_spi_platform_data {
 extern void ar71xx_add_device_spi(struct ar71xx_spi_platform_data *pdata,
 				struct spi_board_info const *info,
 				unsigned n) __init;
+
+extern void ar71xx_set_mac_base(char *mac_str) __init;
 extern void ar71xx_add_device_eth(unsigned int id, phy_interface_t phy_if_mode,
 				u32 phy_mask) __init;