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 #include "devices.h"
  24
  25 struct board_rec {
  26         char                    *name;
  27         enum ar71xx_mach_type   mach_type;
  28 };
  29
  30 static struct board_rec boards[] __initdata = {
  31         {
  32                 .name           = "411",
  33                 .mach_type      = AR71XX_MACH_RB_411,
  34         }, {
  35                 .name           = "411U",
  36                 .mach_type      = AR71XX_MACH_RB_411U,
  37         }, {
  38                 .name           = "433",
  39                 .mach_type      = AR71XX_MACH_RB_433,
  40         }, {
  41                 .name           = "433U",
  42                 .mach_type      = AR71XX_MACH_RB_433U,
  43         }, {
  44                 .name           = "450",
  45                 .mach_type      = AR71XX_MACH_RB_450,
  46         }, {
  47                 .name           = "450G",
  48                 .mach_type      = AR71XX_MACH_RB_450G,
  49         }, {
  50                 .name           = "493",
  51                 .mach_type      = AR71XX_MACH_RB_493,
  52         }, {
  53                 .name           = "AP81",
  54                 .mach_type      = AR71XX_MACH_AP81,
  55         }, {
  56                 .name           = "AP83",
  57                 .mach_type      = AR71XX_MACH_AP83,
  58         }, {
  59                 .name           = "AW-NR580",
  60                 .mach_type      = AR71XX_MACH_AW_NR580,
  61         }, {
  62                 .name           = "DIR825B1",
  63                 .mach_type      = AR71XX_MACH_DIR825B1,
  64         }, {
  65                 .name           = "TEW-632BRP",
  66                 .mach_type      = AR71XX_MACH_TEW_632BRP,
  67         }, {
  68                 .name           = "TL-WR741ND",
  69                 .mach_type      = AR71XX_MACH_TL_WR741ND,
  70         }, {
  71                 .name           = "TL-WR941ND",
  72                 .mach_type      = AR71XX_MACH_TL_WR941ND,
  73         }, {
  74                 .name           = "UBNT-RS",
  75                 .mach_type      = AR71XX_MACH_UBNT_RS,
  76         }, {
  77                 .name           = "UBNT-RSPRO",
  78                 .mach_type      = AR71XX_MACH_UBNT_RSPRO,
  79         }, {
  80                 .name           = "Ubiquiti AR71xx-based board",
  81                 .mach_type      = AR71XX_MACH_UBNT_RS,
  82         }, {
  83                 .name           = "UBNT-LS-SR71",
  84                 .mach_type      = AR71XX_MACH_UBNT_LSSR71,
  85         }, {
  86                 .name           = "UBNT-LSX",
  87                 .mach_type      = AR71XX_MACH_UBNT_LSX,
  88         }, {
  89                 .name           = "UBNT-BM",
  90                 .mach_type      = AR71XX_MACH_UBNT_BULLET_M,
  91         }, {
  92                 .name           = "UBNT-RM",
  93                 .mach_type      = AR71XX_MACH_UBNT_ROCKET_M,
  94         }, {
  95                 .name           = "UBNT-NM",
  96                 .mach_type      = AR71XX_MACH_UBNT_NANO_M,
  97         }, {
  98                 .name           = "WNDR3700",
  99                 .mach_type      = AR71XX_MACH_WNDR3700,
 100         }, {
 101                 .name           = "WNR2000",
 102                 .mach_type      = AR71XX_MACH_WNR2000,
 103         }, {
 104                 .name           = "WRT160NL",
 105                 .mach_type      = AR71XX_MACH_WRT160NL,
 106         }, {
 107                 .name           = "WP543",
 108                 .mach_type      = AR71XX_MACH_WP543,
 109         }, {
 110                 .name           = "WRT400N",
 111                 .mach_type      = AR71XX_MACH_WRT400N,
 112         }, {
 113                 .name           = "PB42",
 114                 .mach_type      = AR71XX_MACH_PB42,
 115         }, {
 116                 .name           = "PB44",
 117                 .mach_type      = AR71XX_MACH_PB44,
 118         }, {
 119                 .name           = "MZK-W300NH",
 120                 .mach_type      = AR71XX_MACH_MZK_W300NH,
 121         }, {
 122                 .name           = "MZK-W04NU",
 123                 .mach_type      = AR71XX_MACH_MZK_W04NU,
 124         }
 125 };
 126
 127 static int __init ar71xx_board_setup(char *name)
 128 {
 129         int i;
 130
 131         for (i = 0; i < ARRAY_SIZE(boards); i++)
 132                 if (strcmp(name, boards[i].name) == 0) {
 133                         ar71xx_mach = boards[i].mach_type;
 134                         break;
 135                 }
 136
 137         return 1;
 138 }
 139 __setup("board=", ar71xx_board_setup);
 140
 141 static int __init ar71xx_ethaddr_setup(char *str)
 142 {
 143         ar71xx_parse_mac_addr(str);
 144         return 1;
 145 }
 146 __setup("ethaddr=", ar71xx_ethaddr_setup);
 147
 148 static int __init ar71xx_kmac_setup(char *str)
 149 {
 150         ar71xx_parse_mac_addr(str);
 151         return 1;
 152 }
 153 __setup("kmac=", ar71xx_kmac_setup);
 154
 155 static inline int is_valid_ram_addr(void *addr)
 156 {
 157         if (((u32) addr > KSEG0) &&
 158             ((u32) addr < (KSEG0 + AR71XX_MEM_SIZE_MAX)))
 159                 return 1;
 160
 161         if (((u32) addr > KSEG1) &&
 162             ((u32) addr < (KSEG1 + AR71XX_MEM_SIZE_MAX)))
 163                 return 1;
 164
 165         return 0;
 166 }
 167
 168 static void __init ar71xx_prom_append_cmdline(const char *name,
 169                                               const char *value)
 170 {
 171         char buf[CL_SIZE];
 172
 173         snprintf(buf, sizeof(buf), " %s=%s", name, value);
 174         strlcat(arcs_cmdline, buf, sizeof(arcs_cmdline));
 175 }
 176
 177 static void __init ar71xx_prom_find_env(char **envp, const char *name)
 178 {
 179         int len = strlen(name);
 180         char **p;
 181
 182         if (!is_valid_ram_addr(envp))
 183                 return;
 184
 185         for (p = envp; is_valid_ram_addr(*p); p++) {
 186                 if (strncmp(name, *p, len) == 0 && (*p)[len] == '=') {
 187                         ar71xx_prom_append_cmdline(name, *p + len + 1);
 188                         break;
 189                 }
 190
 191                 /* RedBoot env comes in pointer pairs - key, value */
 192                 if (strncmp(name, *p, len) == 0 && (*p)[len] == 0)
 193                         if (is_valid_ram_addr(*(++p))) {
 194                                 ar71xx_prom_append_cmdline(name, *p);
 195                                 break;
 196                         }
 197         }
 198 }
 199
 200 static int __init ar71xx_prom_init_myloader(void)
 201 {
 202         struct myloader_info *mylo;
 203         char mac_buf[32];
 204         char *mac;
 205
 206         mylo = myloader_get_info();
 207         if (!mylo)
 208                 return 0;
 209
 210         switch (mylo->did) {
 211         case DEVID_COMPEX_WP543:
 212                 ar71xx_prom_append_cmdline("board", "WP543");
 213                 break;
 214         default:
 215                 printk(KERN_WARNING "prom: unknown device id: %x\n",
 216                                 mylo->did);
 217                 return 0;
 218         }
 219
 220         mac = mylo->macs[0];
 221         snprintf(mac_buf, sizeof(mac_buf), "%02x:%02x:%02x:%02x:%02x:%02x",
 222                  mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
 223
 224         ar71xx_prom_append_cmdline("ethaddr", mac_buf);
 225
 226         return 1;
 227 }
 228
 229 #ifdef CONFIG_IMAGE_CMDLINE_HACK
 230 extern char __image_cmdline[];
 231
 232 static int __init ar71xx_use__image_cmdline(void)
 233 {
 234         char *p = __image_cmdline;
 235         int replace = 0;
 236
 237         if (*p == '-') {
 238                 replace = 1;
 239                 p++;
 240         }
 241
 242         if (*p == '\0')
 243                 return 0;
 244
 245         if (replace) {
 246                 strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline));
 247         } else {
 248                 strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
 249                 strlcat(arcs_cmdline, p, sizeof(arcs_cmdline));
 250         }
 251
 252         return 1;
 253 }
 254 #else
 255 static int inline ar71xx_use__image_cmdline(void) { return 0; }
 256 #endif
 257
 258 static __init void ar71xx_prom_init_cmdline(int argc, char **argv)
 259 {
 260         int i;
 261
 262         if (ar71xx_use__image_cmdline())
 263                 return;
 264
 265         if (!is_valid_ram_addr(argv))
 266                 return;
 267
 268         for (i = 0; i < argc; i++)
 269                 if (is_valid_ram_addr(argv[i])) {
 270                         strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
 271                         strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline));
 272                 }
 273 }
 274
 275 void __init prom_init(void)
 276 {
 277         char **envp;
 278
 279         printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
 280                         "fw_arg2=%08x, fw_arg3=%08x\n",
 281                         (unsigned int)fw_arg0, (unsigned int)fw_arg1,
 282                         (unsigned int)fw_arg2, (unsigned int)fw_arg3);
 283
 284
 285         ar71xx_mach = AR71XX_MACH_GENERIC;
 286
 287         if (ar71xx_prom_init_myloader())
 288                 return;
 289
 290         ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1);
 291
 292         envp = (char **)fw_arg2;
 293         ar71xx_prom_find_env(envp, "board");
 294         ar71xx_prom_find_env(envp, "ethaddr");
 295 }
 296
 297 void __init prom_free_prom_memory(void)
 298 {
 299         /* We do not have to prom memory to free */
 300 }