[ar71xx] fix RB-493 detection

[openwrt/svn-archive/archive.git] / target / linux / ar71xx / files / arch / mips / ar71xx / prom.c

diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c b/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c
index e21464fc18b033503615e7d5aa74d7b3a7d0dc0b..1d55328aad024ce41b7b97b8d3656e0e6d49e545 100644 (file)
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c
@@ -16,17 +16,19 @@
 
 #include <asm/bootinfo.h>
 #include <asm/addrspace.h>
+#include <asm/fw/myloader/myloader.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 = {
        {
@@ -38,33 +40,40 @@ static struct board_rec boards[] __initdata = {
        }, {
                .name           = "450",
                .mach_type      = MACH_AR71XX_RB_450,
+       }, {
+               .name           = "493",
+               .mach_type      = MACH_AR71XX_RB_493,
        }
 };
 
-char *(*prom_getenv)(const char *envname) __initdata;
-
-static __init char *dummy_getenv(const char *envname)
-{
-       return NULL;
-}
-
-static void __init routerboot_printargs(void)
+static __init char *ar71xx_prom_getargv(const char *name)
 {
+       int len = strlen(name);
        int i;
 
-       for (i = 0; i < prom_argc; i++)
-               printk(KERN_DEBUG "prom: routerboot envp[%d]: %s\n",
-                               i, prom_envp[i]);
+       if (!ar71xx_prom_argv)
+               return NULL;
+
+       for (i = 0; i < ar71xx_prom_argc; i++) {
+               char *argv = ar71xx_prom_argv[i];
+               if (strncmp(name, argv, len) == 0 && (argv)[len] == '=')
+                       return argv + len + 1;
+       }
+
+       return NULL;
 }
 
-static __init char *routerboot_getenv(const char *envname)
+static __init char *ar71xx_prom_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;
+       if (!ar71xx_prom_envp)
+               return NULL;
+
+       for (env = ar71xx_prom_envp; *env != NULL; env++)
+               if (strncmp(envname, *env, len) == 0 && (*env)[len] == '=')
+                       return *env + len + 1;
 
        return NULL;
 }
@@ -80,31 +89,61 @@ static __init unsigned long find_board_byname(char *name)
        return MACH_AR71XX_GENERIC;
 }
 
-void __init prom_init(void)
+static int ar71xx_prom_init_myloader(void)
 {
-       char *board;
+       struct myloader_info *mylo;
+
+       mylo = myloader_get_info();
+       if (!mylo)
+               return 0;
+
+       switch (mylo->did) {
+       case DEVID_COMPEX_WP543:
+               mips_machtype = MACH_AR71XX_WP543;
+               break;
+       default:
+               printk(KERN_WARNING "prom: unknown device id: %x\n",
+                               mylo->did);
+       }
+       ar71xx_set_mac_base(mylo->macs[0]);
+
+       return 1;
+}
 
+static void ar71xx_prom_init_generic(void)
+{
+       char *p;
+
+       ar71xx_prom_argc = fw_arg0;
+       ar71xx_prom_argv = (char **)fw_arg1;
+       ar71xx_prom_envp = (char **)fw_arg2;
+
+       p = ar71xx_prom_getenv("board");
+       if (!p)
+               p = ar71xx_prom_getargv("board");
+       if (p)
+               mips_machtype = find_board_byname(p);
+
+       p = ar71xx_prom_getenv("ethaddr");
+       if (!p)
+               p = ar71xx_prom_getargv("kmac");
+       if (p)
+               ar71xx_parse_mac_addr(p);
+}
+
+void __init prom_init(void)
+{
        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;
-               routerboot_printargs();
-       }
+       mips_machtype = MACH_AR71XX_GENERIC;
 
-       board = prom_getenv("board");
-       if (board)
-               mips_machtype = find_board_byname(board);
-       else
-               mips_machtype = MACH_AR71XX_GENERIC;
+       if (ar71xx_prom_init_myloader())
+               return;
 
-       ar71xx_print_cmdline();
+       ar71xx_prom_init_generic();
 }
 
 void __init prom_free_prom_memory(void)