target/linux/ar71xx/files-2.6.39/arch/mips/ar71xx/prom.c

   1 /*
   2  *  Atheros AR71xx SoC specific prom routines
   3  *
   4  *  Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>
   5  *  Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
   6  *
   7  *  This program is free software; you can redistribute it and/or modify it
   8  *  under the terms of the GNU General Public License version 2 as published
   9  *  by the Free Software Foundation.
  10  */
  11
  12 #include <linux/kernel.h>
  13 #include <linux/init.h>
  14 #include <linux/io.h>
  15 #include <linux/string.h>
  16
  17 #include <asm/bootinfo.h>
  18 #include <asm/addrspace.h>
  19 #include <asm/fw/myloader/myloader.h>
  20
  21 #include <asm/mach-ar71xx/ar71xx.h>
  22
  23 static inline int is_valid_ram_addr(void *addr)
  24 {
  25         if (((u32) addr > KSEG0) &&
  26             ((u32) addr < (KSEG0 + AR71XX_MEM_SIZE_MAX)))
  27                 return 1;
  28
  29         if (((u32) addr > KSEG1) &&
  30             ((u32) addr < (KSEG1 + AR71XX_MEM_SIZE_MAX)))
  31                 return 1;
  32
  33         return 0;
  34 }
  35
  36 static char ar71xx_cmdline_buf[COMMAND_LINE_SIZE] __initdata;
  37 static void __init ar71xx_prom_append_cmdline(const char *name,
  38                                               const char *value)
  39 {
  40         snprintf(ar71xx_cmdline_buf, sizeof(ar71xx_cmdline_buf),
  41                  " %s=%s", name, value);
  42         strlcat(arcs_cmdline, ar71xx_cmdline_buf, sizeof(arcs_cmdline));
  43 }
  44
  45 static const char * __init ar71xx_prom_find_env(char **envp, const char *name)
  46 {
  47         const char *ret = NULL;
  48         int len;
  49         char **p;
  50
  51         if (!is_valid_ram_addr(envp))
  52                 return NULL;
  53
  54         len = strlen(name);
  55         for (p = envp; is_valid_ram_addr(*p); p++) {
  56                 if (strncmp(name, *p, len) == 0 && (*p)[len] == '=') {
  57                         ret = *p + len + 1;
  58                         break;
  59                 }
  60
  61                 /* RedBoot env comes in pointer pairs - key, value */
  62                 if (strncmp(name, *p, len) == 0 && (*p)[len] == 0)
  63                         if (is_valid_ram_addr(*(++p))) {
  64                                 ret = *p;
  65                                 break;
  66                         }
  67         }
  68
  69         return ret;
  70 }
  71
  72 #ifdef CONFIG_IMAGE_CMDLINE_HACK
  73 extern char __image_cmdline[];
  74
  75 static int __init ar71xx_use__image_cmdline(void)
  76 {
  77         char *p = __image_cmdline;
  78         int replace = 0;
  79
  80         if (*p == '-') {
  81                 replace = 1;
  82                 p++;
  83         }
  84
  85         if (*p == '\0')
  86                 return 0;
  87
  88         if (replace) {
  89                 strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline));
  90         } else {
  91                 strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
  92                 strlcat(arcs_cmdline, p, sizeof(arcs_cmdline));
  93         }
  94
  95         return 1;
  96 }
  97 #else
  98 static inline int ar71xx_use__image_cmdline(void) { return 0; }
  99 #endif
 100
 101 static int __init ar71xx_prom_init_myloader(void)
 102 {
 103         struct myloader_info *mylo;
 104         char mac_buf[32];
 105         unsigned char *mac;
 106
 107         mylo = myloader_get_info();
 108         if (!mylo)
 109                 return 0;
 110
 111         switch (mylo->did) {
 112         case DEVID_COMPEX_WP543:
 113                 ar71xx_prom_append_cmdline("board", "WP543");
 114                 break;
 115         case DEVID_COMPEX_WPE72:
 116                 ar71xx_prom_append_cmdline("board", "WPE72");
 117                 break;
 118         default:
 119                 printk(KERN_WARNING "prom: unknown device id: %x\n",
 120                                 mylo->did);
 121                 return 0;
 122         }
 123
 124         mac = mylo->macs[0];
 125         snprintf(mac_buf, sizeof(mac_buf), "%02x:%02x:%02x:%02x:%02x:%02x",
 126                  mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
 127
 128         ar71xx_prom_append_cmdline("ethaddr", mac_buf);
 129
 130         ar71xx_use__image_cmdline();
 131
 132         return 1;
 133 }
 134
 135 static __init void ar71xx_prom_init_cmdline(int argc, char **argv)
 136 {
 137         int i;
 138
 139         if (ar71xx_use__image_cmdline())
 140                 return;
 141
 142         if (!is_valid_ram_addr(argv))
 143                 return;
 144
 145         for (i = 0; i < argc; i++)
 146                 if (is_valid_ram_addr(argv[i])) {
 147                         strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
 148                         strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline));
 149                 }
 150 }
 151
 152 void __init prom_init(void)
 153 {
 154         const char *env;
 155         char **envp;
 156
 157         printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
 158                         "fw_arg2=%08x, fw_arg3=%08x\n",
 159                         (unsigned int)fw_arg0, (unsigned int)fw_arg1,
 160                         (unsigned int)fw_arg2, (unsigned int)fw_arg3);
 161
 162
 163         if (ar71xx_prom_init_myloader())
 164                 return;
 165
 166         ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1);
 167
 168         envp = (char **)fw_arg2;
 169         if (!strstr(arcs_cmdline, "ethaddr=")) {
 170                 env = ar71xx_prom_find_env(envp, "ethaddr");
 171                 if (env)
 172                         ar71xx_prom_append_cmdline("ethaddr", env);
 173         }
 174
 175         if (!strstr(arcs_cmdline, "board=")) {
 176                 env = ar71xx_prom_find_env(envp, "board");
 177                 if (env) {
 178                         /* Workaround for buggy bootloaders */
 179                         if (strcmp(env, "RouterStation") == 0 ||
 180                             strcmp(env, "Ubiquiti AR71xx-based board") == 0)
 181                                 env = "UBNT-RS";
 182
 183                         if (strcmp(env, "RouterStation PRO") == 0)
 184                                 env = "UBNT-RSPRO";
 185
 186                         ar71xx_prom_append_cmdline("board", env);
 187                 }
 188         }
 189 }
 190
 191 void __init prom_free_prom_memory(void)
 192 {
 193         /* We do not have to prom memory to free */
 194 }