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/serial_reg.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 int ar71xx_prom_argc __initdata;
  31 static char **ar71xx_prom_argv __initdata;
  32 static char **ar71xx_prom_envp __initdata;
  33
  34 static struct board_rec boards[] __initdata = {
  35         {
  36                 .name           = "411",
  37                 .mach_type      = AR71XX_MACH_RB_411,
  38         }, {
  39                 .name           = "433",
  40                 .mach_type      = AR71XX_MACH_RB_433,
  41         }, {
  42                 .name           = "433U",
  43                 .mach_type      = AR71XX_MACH_RB_433U,
  44         }, {
  45                 .name           = "450",
  46                 .mach_type      = AR71XX_MACH_RB_450,
  47         }, {
  48                 .name           = "450G",
  49                 .mach_type      = AR71XX_MACH_RB_450G,
  50         }, {
  51                 .name           = "493",
  52                 .mach_type      = AR71XX_MACH_RB_493,
  53         }, {
  54                 .name           = "AP81",
  55                 .mach_type      = AR71XX_MACH_AP81,
  56         }, {
  57                 .name           = "AP83",
  58                 .mach_type      = AR71XX_MACH_AP83,
  59         }, {
  60                 .name           = "AW-NR580",
  61                 .mach_type      = AR71XX_MACH_AW_NR580,
  62         }, {
  63                 .name           = "TEW-632BRP",
  64                 .mach_type      = AR71XX_MACH_TEW_632BRP,
  65         }, {
  66                 .name           = "TL-WR741ND",
  67                 .mach_type      = AR71XX_MACH_TL_WR741ND,
  68         }, {
  69                 .name           = "TL-WR941ND",
  70                 .mach_type      = AR71XX_MACH_TL_WR941ND,
  71         }, {
  72                 .name           = "UBNT-RS",
  73                 .mach_type      = AR71XX_MACH_UBNT_RS,
  74         }, {
  75                 .name           = "UBNT-RSPRO",
  76                 .mach_type      = AR71XX_MACH_UBNT_RSPRO,
  77         }, {
  78                 .name           = "Ubiquiti AR71xx-based board",
  79                 .mach_type      = AR71XX_MACH_UBNT_RS,
  80         }, {
  81                 .name           = "UBNT-LS-SR71",
  82                 .mach_type      = AR71XX_MACH_UBNT_LSSR71,
  83         }, {
  84                 .name           = "UBNT-LSX",
  85                 .mach_type      = AR71XX_MACH_UBNT_LSX,
  86         }, {
  87                 .name           = "WNR2000",
  88                 .mach_type      = AR71XX_MACH_WNR2000,
  89         }, {
  90                 .name           = "WRT160NL",
  91                 .mach_type      = AR71XX_MACH_WRT160NL,
  92         }, {
  93                 .name           = "WRT400N",
  94                 .mach_type      = AR71XX_MACH_WRT400N,
  95         }, {
  96                 .name           = "PB42",
  97                 .mach_type      = AR71XX_MACH_PB42,
  98         }, {
  99                 .name           = "PB44",
 100                 .mach_type      = AR71XX_MACH_PB44,
 101         }, {
 102                 .name           = "MZK-W300NH",
 103                 .mach_type      = AR71XX_MACH_MZK_W300NH,
 104         }, {
 105                 .name           = "MZK-W04NU",
 106                 .mach_type      = AR71XX_MACH_MZK_W04NU,
 107         }
 108 };
 109
 110 static inline int is_valid_ram_addr(void *addr)
 111 {
 112         if (((u32) addr > KSEG0) &&
 113             ((u32) addr < (KSEG0 + AR71XX_MEM_SIZE_MAX)))
 114                 return 1;
 115
 116         if (((u32) addr > KSEG1) &&
 117             ((u32) addr < (KSEG1 + AR71XX_MEM_SIZE_MAX)))
 118                 return 1;
 119
 120         return 0;
 121 }
 122
 123 static __init char *ar71xx_prom_getargv(const char *name)
 124 {
 125         int len = strlen(name);
 126         int i;
 127
 128         if (!is_valid_ram_addr(ar71xx_prom_argv))
 129                 return NULL;
 130
 131         for (i = 0; i < ar71xx_prom_argc; i++) {
 132                 char *argv = ar71xx_prom_argv[i];
 133
 134                 if (!is_valid_ram_addr(argv))
 135                         continue;
 136
 137                 if (strncmp(name, argv, len) == 0 && (argv)[len] == '=')
 138                         return argv + len + 1;
 139         }
 140
 141         return NULL;
 142 }
 143
 144 static __init char *ar71xx_prom_getenv(const char *envname)
 145 {
 146         int len = strlen(envname);
 147         char **env;
 148
 149         if (!is_valid_ram_addr(ar71xx_prom_envp))
 150                 return NULL;
 151
 152         for (env = ar71xx_prom_envp; is_valid_ram_addr(*env); env++) {
 153                 if (strncmp(envname, *env, len) == 0 && (*env)[len] == '=')
 154                         return *env + len + 1;
 155
 156                 /* RedBoot env comes in pointer pairs - key, value */
 157                 if (strncmp(envname, *env, len) == 0 && (*env)[len] == 0)
 158                         if (is_valid_ram_addr(*(++env)))
 159                                 return *env;
 160         }
 161
 162         return NULL;
 163 }
 164
 165 static __init unsigned long find_board_byname(char *name)
 166 {
 167         int i;
 168
 169         for (i = 0; i < ARRAY_SIZE(boards); i++)
 170                 if (strcmp(name, boards[i].name) == 0)
 171                         return boards[i].mach_type;
 172
 173         return AR71XX_MACH_GENERIC;
 174 }
 175
 176 static int ar71xx_prom_init_myloader(void)
 177 {
 178         struct myloader_info *mylo;
 179
 180         mylo = myloader_get_info();
 181         if (!mylo)
 182                 return 0;
 183
 184         switch (mylo->did) {
 185         case DEVID_COMPEX_WP543:
 186                 ar71xx_mach = AR71XX_MACH_WP543;
 187                 break;
 188         default:
 189                 printk(KERN_WARNING "prom: unknown device id: %x\n",
 190                                 mylo->did);
 191         }
 192         ar71xx_set_mac_base(mylo->macs[0]);
 193
 194         return 1;
 195 }
 196
 197 static void ar71xx_prom_init_generic(void)
 198 {
 199         char *p;
 200
 201         ar71xx_prom_argc = fw_arg0;
 202         ar71xx_prom_argv = (char **)fw_arg1;
 203         ar71xx_prom_envp = (char **)fw_arg2;
 204
 205         p = ar71xx_prom_getargv("board");
 206         if (!p)
 207                 p = ar71xx_prom_getenv("board");
 208         if (p)
 209                 ar71xx_mach = find_board_byname(p);
 210
 211         p = ar71xx_prom_getenv("ethaddr");
 212         if (!p)
 213                 p = ar71xx_prom_getargv("kmac");
 214         if (p)
 215                 ar71xx_parse_mac_addr(p);
 216 }
 217
 218 void __init prom_init(void)
 219 {
 220         printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
 221                         "fw_arg2=%08x, fw_arg3=%08x\n",
 222                         (unsigned int)fw_arg0, (unsigned int)fw_arg1,
 223                         (unsigned int)fw_arg2, (unsigned int)fw_arg3);
 224
 225         ar71xx_mach = AR71XX_MACH_GENERIC;
 226
 227         if (ar71xx_prom_init_myloader())
 228                 return;
 229
 230         ar71xx_prom_init_generic();
 231 }
 232
 233 void __init prom_free_prom_memory(void)
 234 {
 235         /* We do not have to prom memory to free */
 236 }
 237
 238 #define UART_READ(r) \
 239         __raw_readl((void __iomem *)(KSEG1ADDR(AR71XX_UART_BASE) + 4 * (r)))
 240
 241 #define UART_WRITE(r, v) \
 242         __raw_writel((v), (void __iomem *)(KSEG1ADDR(AR71XX_UART_BASE) + 4*(r)))
 243
 244 void prom_putchar(unsigned char ch)
 245 {
 246         while (((UART_READ(UART_LSR)) & UART_LSR_THRE) == 0);
 247         UART_WRITE(UART_TX, ch);
 248         while (((UART_READ(UART_LSR)) & UART_LSR_THRE) == 0);
 249 }