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

   1 /*
   2  *  Atheros AR71xx SoC specific prom routines
   3  *
   4  *  Copyright (C) 2008-2009 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 void __init ar71xx_prom_append_cmdline(const char *name,
  37                                               const char *value)
  38 {
  39         char buf[COMMAND_LINE_SIZE];
  40
  41         snprintf(buf, sizeof(buf), " %s=%s", name, value);
  42         strlcat(arcs_cmdline, buf, sizeof(arcs_cmdline));
  43 }
  44
  45 static void __init ar71xx_prom_find_env(char **envp, const char *name)
  46 {
  47         int len = strlen(name);
  48         char **p;
  49
  50         if (!is_valid_ram_addr(envp))
  51                 return;
  52
  53         for (p = envp; is_valid_ram_addr(*p); p++) {
  54                 if (strncmp(name, *p, len) == 0 && (*p)[len] == '=') {
  55                         ar71xx_prom_append_cmdline(name, *p + len + 1);
  56                         break;
  57                 }
  58
  59                 /* RedBoot env comes in pointer pairs - key, value */
  60                 if (strncmp(name, *p, len) == 0 && (*p)[len] == 0)
  61                         if (is_valid_ram_addr(*(++p))) {
  62                                 ar71xx_prom_append_cmdline(name, *p);
  63                                 break;
  64                         }
  65         }
  66 }
  67
  68 static int __init ar71xx_prom_init_myloader(void)
  69 {
  70         struct myloader_info *mylo;
  71         char mac_buf[32];
  72         char *mac;
  73
  74         mylo = myloader_get_info();
  75         if (!mylo)
  76                 return 0;
  77
  78         switch (mylo->did) {
  79         case DEVID_COMPEX_WP543:
  80                 ar71xx_prom_append_cmdline("board", "WP543");
  81                 break;
  82         default:
  83                 printk(KERN_WARNING "prom: unknown device id: %x\n",
  84                                 mylo->did);
  85                 return 0;
  86         }
  87
  88         mac = mylo->macs[0];
  89         snprintf(mac_buf, sizeof(mac_buf), "%02x:%02x:%02x:%02x:%02x:%02x",
  90                  mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
  91
  92         ar71xx_prom_append_cmdline("ethaddr", mac_buf);
  93
  94         return 1;
  95 }
  96
  97 #ifdef CONFIG_IMAGE_CMDLINE_HACK
  98 extern char __image_cmdline[];
  99
 100 static int __init ar71xx_use__image_cmdline(void)
 101 {
 102         char *p = __image_cmdline;
 103         int replace = 0;
 104
 105         if (*p == '-') {
 106                 replace = 1;
 107                 p++;
 108         }
 109
 110         if (*p == '\0')
 111                 return 0;
 112
 113         if (replace) {
 114                 strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline));
 115         } else {
 116                 strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
 117                 strlcat(arcs_cmdline, p, sizeof(arcs_cmdline));
 118         }
 119
 120         return 1;
 121 }
 122 #else
 123 static int inline ar71xx_use__image_cmdline(void) { return 0; }
 124 #endif
 125
 126 static __init void ar71xx_prom_init_cmdline(int argc, char **argv)
 127 {
 128         int i;
 129
 130         if (ar71xx_use__image_cmdline())
 131                 return;
 132
 133         if (!is_valid_ram_addr(argv))
 134                 return;
 135
 136         for (i = 0; i < argc; i++)
 137                 if (is_valid_ram_addr(argv[i])) {
 138                         strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
 139                         strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline));
 140                 }
 141 }
 142
 143 void __init prom_init(void)
 144 {
 145         char **envp;
 146
 147         printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
 148                         "fw_arg2=%08x, fw_arg3=%08x\n",
 149                         (unsigned int)fw_arg0, (unsigned int)fw_arg1,
 150                         (unsigned int)fw_arg2, (unsigned int)fw_arg3);
 151
 152
 153         if (ar71xx_prom_init_myloader())
 154                 return;
 155
 156         ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1);
 157
 158         envp = (char **)fw_arg2;
 159         ar71xx_prom_find_env(envp, "board");
 160         ar71xx_prom_find_env(envp, "ethaddr");
 161 }
 162
 163 void __init prom_free_prom_memory(void)
 164 {
 165         /* We do not have to prom memory to free */
 166 }