[ar71xx] parse RedBoot environments as well (patch by Jonas <jmajau@ubnt.com>)
[openwrt/svn-archive/archive.git] / target / linux / ar71xx / files / arch / mips / ar71xx / prom.c
index 69425d50c01cd04b1a9a85a6af8bf4c690e67056..29c6c97cc634a5b8f6336c26092abc22cc7e9e04 100644 (file)
@@ -1,7 +1,7 @@
 /*
  *  Atheros AR71xx SoC specific prom routines
  *
- *  Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>
+ *  Copyright (C) 2008-2009 Gabor Juhos <juhosg@openwrt.org>
  *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
  *
  *  This program is free software; you can redistribute it and/or modify it
@@ -16,6 +16,7 @@
 
 #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>
@@ -32,48 +33,98 @@ static char **ar71xx_prom_envp __initdata;
 static struct board_rec boards[] __initdata = {
        {
                .name           = "411",
-               .mach_type      = MACH_AR71XX_RB_411,
+               .mach_type      = AR71XX_MACH_RB_411,
        }, {
                .name           = "433",
-               .mach_type      = MACH_AR71XX_RB_433,
+               .mach_type      = AR71XX_MACH_RB_433,
        }, {
                .name           = "450",
-               .mach_type      = MACH_AR71XX_RB_450,
+               .mach_type      = AR71XX_MACH_RB_450,
+       }, {
+               .name           = "493",
+               .mach_type      = AR71XX_MACH_RB_493,
+       }, {
+               .name           = "AW-NR580",
+               .mach_type      = AR71XX_MACH_AW_NR580,
+       }, {
+               .name           = "AP83",
+               .mach_type      = AR71XX_MACH_AP83,
+       }, {
+               .name           = "TEW-632BRP",
+               .mach_type      = AR71XX_MACH_TEW_632BRP,
+       }, {
+               .name           = "UBNT-RS",
+               .mach_type      = AR71XX_MACH_UBNT_RS,
+       }, {
+               .name           = "UBNT-LSX",
+               .mach_type      = AR71XX_MACH_UBNT_LSX,
+       }, {
+               .name           = "WNR2000",
+               .mach_type      = AR71XX_MACH_WNR2000,
+       }, {
+               .name           = "PB42",
+               .mach_type      = AR71XX_MACH_PB42,
+       }, {
+               .name           = "MZK-W300NH",
+               .mach_type      = AR71XX_MACH_MZK_W300NH,
+       }, {
+               .name           = "MZK-W04NU",
+               .mach_type      = AR71XX_MACH_MZK_W04NU,
        }
 };
 
-static __init void routerboot_printargs(void)
+static inline int is_valid_ram_addr(void *addr)
 {
-       int i;
+       if (((u32) addr > KSEG0) &&
+           ((u32) addr < (KSEG0 + AR71XX_MEM_SIZE_MAX)))
+               return 1;
+
+       if (((u32) addr > KSEG1) &&
+           ((u32) addr < (KSEG1 + AR71XX_MEM_SIZE_MAX)))
+               return 1;
 
-       for (i = 0; i < ar71xx_prom_argc; i++)
-               printk(KERN_DEBUG "prom: routerboot envp[%d]: %s\n",
-                               i, ar71xx_prom_argv[i]);
+       return 0;
 }
 
-static __init char *routerboot_getenv(const char *envname)
+static __init char *ar71xx_prom_getargv(const char *name)
 {
-       int len = strlen(envname);
+       int len = strlen(name);
        int i;
 
+       if (!is_valid_ram_addr(ar71xx_prom_argv))
+               return NULL;
+
        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;
+               char *argv = ar71xx_prom_argv[i];
+
+               if (!is_valid_ram_addr(argv))
+                       continue;
+
+               if (strncmp(name, argv, len) == 0 && (argv)[len] == '=')
+                       return argv + len + 1;
        }
 
        return NULL;
 }
 
-static __init char *redboot_getenv(const char *envname)
+static __init char *ar71xx_prom_getenv(const char *envname)
 {
        int len = strlen(envname);
        char **env;
 
-       for (env = ar71xx_prom_envp; *env != NULL; env++)
+       if (!is_valid_ram_addr(ar71xx_prom_envp))
+               return NULL;
+
+       for (env = ar71xx_prom_envp; is_valid_ram_addr(*env); env++) {
                if (strncmp(envname, *env, len) == 0 && (*env)[len] == '=')
                        return *env + len + 1;
 
+               /* RedBoot env comes in pointer pairs - key, value */
+               if (strncmp(envname, *env, len) == 0 && (*env)[len] == 0)
+                       if (is_valid_ram_addr(*(++env)))
+                               return *env;
+       }
+
        return NULL;
 }
 
@@ -85,43 +136,64 @@ static __init unsigned long find_board_byname(char *name)
                if (strcmp(name, boards[i].name) == 0)
                        return boards[i].mach_type;
 
-       return MACH_AR71XX_GENERIC;
+       return AR71XX_MACH_GENERIC;
 }
 
-void __init prom_init(void)
+static int ar71xx_prom_init_myloader(void)
 {
-       char *board = NULL;
-       char *mac = NULL;
+       struct myloader_info *mylo;
+
+       mylo = myloader_get_info();
+       if (!mylo)
+               return 0;
+
+       switch (mylo->did) {
+       case DEVID_COMPEX_WP543:
+               ar71xx_mach_type = AR71XX_MACH_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)
+               ar71xx_mach_type = 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);
 
-       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");
-       }
-
-       if (board)
-               mips_machtype = find_board_byname(board);
-       else
-               mips_machtype = MACH_AR71XX_GENERIC;
+       ar71xx_mach_type = AR71XX_MACH_GENERIC;
 
-       if (mac)
-               ar71xx_set_mac_base(mac);
+       if (ar71xx_prom_init_myloader())
+               return;
 
-       ar71xx_print_cmdline();
+       ar71xx_prom_init_generic();
 }
 
 void __init prom_free_prom_memory(void)