target/linux/ar71xx/files/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         default:
 116                 printk(KERN_WARNING "prom: unknown device id: %x\n",
 117                                 mylo->did);
 118                 return 0;
 119         }
 120
 121         mac = mylo->macs[0];
 122         snprintf(mac_buf, sizeof(mac_buf), "%02x:%02x:%02x:%02x:%02x:%02x",
 123                  mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
 124
 125         ar71xx_prom_append_cmdline("ethaddr", mac_buf);
 126
 127         ar71xx_use__image_cmdline();
 128
 129         return 1;
 130 }
 131
 132 static __init void ar71xx_prom_init_cmdline(int argc, char **argv)
 133 {
 134         int i;
 135
 136         if (ar71xx_use__image_cmdline())
 137                 return;
 138
 139         if (!is_valid_ram_addr(argv))
 140                 return;
 141
 142         for (i = 0; i < argc; i++)
 143                 if (is_valid_ram_addr(argv[i])) {
 144                         strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
 145                         strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline));
 146                 }
 147 }
 148
 149 void __init prom_init(void)
 150 {
 151         const char *env;
 152         char **envp;
 153
 154         printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
 155                         "fw_arg2=%08x, fw_arg3=%08x\n",
 156                         (unsigned int)fw_arg0, (unsigned int)fw_arg1,
 157                         (unsigned int)fw_arg2, (unsigned int)fw_arg3);
 158
 159
 160         if (ar71xx_prom_init_myloader())
 161                 return;
 162
 163         ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1);
 164
 165         envp = (char **)fw_arg2;
 166         if (!strstr(arcs_cmdline, "ethaddr=")) {
 167                 env = ar71xx_prom_find_env(envp, "ethaddr");
 168                 if (env)
 169                         ar71xx_prom_append_cmdline("ethaddr", env);
 170         }
 171
 172         if (!strstr(arcs_cmdline, "board=")) {
 173                 env = ar71xx_prom_find_env(envp, "board");
 174                 if (env) {
 175                         /* Workaround for buggy bootloaders */
 176                         if (strcmp(env, "RouterStation") == 0 ||
 177                             strcmp(env, "Ubiquiti AR71xx-based board") == 0)
 178                                 env = "UBNT-RS";
 179
 180                         if (strcmp(env, "RouterStation PRO") == 0)
 181                                 env = "UBNT-RSPRO";
 182
 183                         ar71xx_prom_append_cmdline("board", env);
 184                 }
 185         }
 186 }
 187
 188 void __init prom_free_prom_memory(void)
 189 {
 190         /* We do not have to prom memory to free */
 191 }