target/linux/ar7-2.6/files/arch/mips/ar7/prom.c

   1 /*
   2  * $Id$
   3  *
   4  * Copyright (C) 2006, 2007 OpenWrt.org
   5  *
   6  * Carsten Langgaard, carstenl@mips.com
   7  * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
   8  *
   9  *  This program is free software; you can distribute it and/or modify it
  10  *  under the terms of the GNU General Public License (Version 2) as
  11  *  published by the Free Software Foundation.
  12  *
  13  *  This program is distributed in the hope it will be useful, but WITHOUT
  14  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  15  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  16  *  for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License along
  19  *  with this program; if not, write to the Free Software Foundation, Inc.,
  20  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  21  *
  22  * Putting things on the screen/serial line using YAMONs facilities.
  23  */
  24 #include <linux/init.h>
  25 #include <linux/kernel.h>
  26 #include <linux/serial_reg.h>
  27 #include <linux/spinlock.h>
  28 #include <linux/module.h>
  29 #include <asm/io.h>
  30 #include <asm/bootinfo.h>
  31 #include <asm/mips-boards/prom.h>
  32 #include <asm/gdb-stub.h>
  33
  34 #include <asm/ar7/ar7.h>
  35
  36 #define MAX_ENTRY 80
  37
  38 struct env_var {
  39         char *name;
  40         char *value;
  41 };
  42
  43 struct psp_chip_map {
  44         u16 chip;
  45         char *names[50];
  46 };
  47
  48 /* I hate this. No. *I* *HATE* *THIS* */
  49 static __initdata struct psp_chip_map psp_chip_map[] = {
  50         {
  51                 .chip = AR7_CHIP_7100,
  52                 .names = {
  53                         "dummy", "cpufrequency", "memsize",
  54                         "flashsize", "modetty0", "modetty1", "prompt",
  55                         "bootcfg", "maca", "macb", "usb_rndis_mac",
  56                         "macap", "my_ipaddress", "server_ipaddress",
  57                         "bline_maca", "bline_macb", "bline_rndis",
  58                         "bline_atm", "usb_pid", "usb_vid",
  59                         "usb_eppolli", "gateway_ipaddress",
  60                         "subnet_mask", "usb_serial", "usb_board_mac",
  61                         "remote_user", "remote_pass", "remote_dir",
  62                         "sysfrequency", "link_timeout", "mac_port",
  63                         "path", "hostname", "tftpcfg", "buildops",
  64                         "tftp_fo_fname", "tftp_fo_ports",
  65                         "console_state", "mipsfrequency",
  66                 },
  67         },
  68         {
  69                 .chip = AR7_CHIP_7200,
  70                 .names = {
  71                         "dummy", "cpufrequency", "memsize",
  72                         "flashsize", "modetty0", "modetty1", "prompt",
  73                         "bootcfg", "maca", "macb", "usb_rndis_mac",
  74                         "macap", "my_ipaddress", "server_ipaddress",
  75                         "bline_maca", "bline_macb", "bline_rndis",
  76                         "bline_atm", "usb_pid", "usb_vid",
  77                         "usb_eppolli", "gateway_ipaddress",
  78                         "subnet_mask", "usb_serial", "usb_board_mac",
  79                         "remote_user", "remote_pass", "remote_dir",
  80                         "sysfrequency", "link_timeout", "mac_port",
  81                         "path", "hostname", "tftpcfg", "buildops",
  82                         "tftp_fo_fname", "tftp_fo_ports",
  83                         "console_state", "mipsfrequency",
  84                 },
  85         },
  86         {
  87                 .chip = AR7_CHIP_7300,
  88                 .names = {
  89                         "dummy", "cpufrequency", "memsize",
  90                         "flashsize", "modetty0", "modetty1", "prompt",
  91                         "bootcfg", "maca", "macb", "usb_rndis_mac",
  92                         "macap", "my_ipaddress", "server_ipaddress",
  93                         "bline_maca", "bline_macb", "bline_rndis",
  94                         "bline_atm", "usb_pid", "usb_vid",
  95                         "usb_eppolli", "gateway_ipaddress",
  96                         "subnet_mask", "usb_serial", "usb_board_mac",
  97                         "remote_user", "remote_pass", "remote_dir",
  98                         "sysfrequency", "link_timeout", "mac_port",
  99                         "path", "hostname", "tftpcfg", "buildops",
 100                         "tftp_fo_fname", "tftp_fo_ports",
 101                         "console_state", "mipsfrequency",
 102                 },
 103         },
 104         {
 105                 .chip = 0x0,
 106         },
 107 };
 108
 109 static struct env_var adam2_env[MAX_ENTRY] = { { 0, }, };
 110
 111 char * prom_getenv(char *name)
 112 {
 113         int i;
 114         for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
 115                 if (!strcmp(name, adam2_env[i].name))
 116                         return adam2_env[i].value;
 117
 118         return NULL;
 119 }
 120
 121 char * __init prom_getcmdline(void)
 122 {
 123         return &(arcs_cmdline[0]);
 124 }
 125
 126 static void  __init ar7_init_cmdline(int argc, char *argv[])
 127 {
 128         char *cp;
 129         int actr;
 130
 131         actr = 1; /* Always ignore argv[0] */
 132
 133         cp = &(arcs_cmdline[0]);
 134         while(actr < argc) {
 135                 strcpy(cp, argv[actr]);
 136                 cp += strlen(argv[actr]);
 137                 *cp++ = ' ';
 138                 actr++;
 139         }
 140         if (cp != &(arcs_cmdline[0])) {
 141                 /* get rid of trailing space */
 142                 --cp;
 143                 *cp = '\0';
 144         }
 145 }
 146
 147 struct psbl_rec {
 148         u32 psbl_size;
 149         u32 env_base;
 150         u32 env_size;
 151         u32 ffs_base;
 152         u32 ffs_size;
 153 };
 154
 155 static __initdata char psp_env_version[] = "TIENV0.8";
 156
 157 struct psp_env_var {
 158         unsigned char num;
 159         unsigned char ctrl;
 160         unsigned short csum;
 161         unsigned char len;
 162         unsigned char data[11];
 163 };
 164
 165 static char psp_env_data[2048] = { 0, };
 166
 167 static void __init add_adam2_var(char *name, char *value)
 168 {
 169         int i;
 170         for (i = 0; i < MAX_ENTRY; i++) {
 171                 if (!adam2_env[i].name) {
 172                         adam2_env[i].name = name;
 173                         adam2_env[i].value = value;
 174                         return;
 175                 } else if (!strcmp(adam2_env[i].name, name)) {
 176                         adam2_env[i].value = value;
 177                         return;
 178                 }
 179         }
 180 }
 181
 182 static int __init parse_psp_env(void *start)
 183 {
 184         int i, j;
 185         u16 chip;
 186         struct psp_chip_map *map;
 187         char *src, *dest, *name, *value;
 188         struct psp_env_var *vars = start;
 189
 190         chip = ar7_chip_id();
 191         for (map = psp_chip_map; map->chip; map++)
 192                 if (map->chip == chip)
 193                         break;
 194
 195         if (!map->chip)
 196                 return -EINVAL;
 197
 198         i = 1;
 199         j = 0;
 200         dest = psp_env_data;
 201         while (vars[i].num < 0xff) {
 202                 src = vars[i].data;
 203                 if (vars[i].num) {
 204                         strcpy(dest, map->names[vars[i].num]);
 205                         name = dest;
 206                 } else {
 207                         strcpy(dest, src);
 208                         name = dest;
 209                         src += strlen(src) + 1;
 210                 }
 211                 dest += strlen(dest) + 1;
 212                 strcpy(dest, src);
 213                 value = dest;
 214                 dest += strlen(dest) + 1;
 215                 add_adam2_var(name, value);
 216                 i += vars[i].len;
 217         }
 218         return 0;
 219 }
 220
 221 static void __init ar7_init_env(struct env_var *env)
 222 {
 223         int i;
 224         struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300));
 225         void *psp_env = (void *)KSEG1ADDR(psbl->env_base);
 226
 227         if(strcmp(psp_env, psp_env_version) == 0) {
 228                 parse_psp_env(psp_env);
 229         } else {
 230                 for (i = 0; i < MAX_ENTRY; i++, env++)
 231                         if (env->name)
 232                                 add_adam2_var(env->name, env->value);
 233         }
 234 }
 235
 236 static void __init console_config(void)
 237 {
 238 #ifdef CONFIG_SERIAL_8250_CONSOLE
 239         char console_string[40];
 240         int baud = 0;
 241         char parity = '\0', bits = '\0', flow = '\0';
 242         char *s, *p;
 243
 244         if (strstr(prom_getcmdline(), "console="))
 245                 return;
 246
 247 #ifdef CONFIG_KGDB
 248         strcat(prom_getcmdline(), " console=kgdb");
 249         kgdb_enabled = 1;
 250         return;
 251 #endif
 252
 253         if ((s = prom_getenv("modetty0"))) {
 254                 baud = simple_strtoul(s, &p, 10);
 255                 s = p;
 256                 if (*s == ',') s++;
 257                 if (*s) parity = *s++;
 258                 if (*s == ',') s++;
 259                 if (*s) bits = *s++;
 260                 if (*s == ',') s++;
 261                 if (*s == 'h') flow = 'r';
 262         }
 263
 264         if (baud == 0)
 265                 baud = 38400;
 266         if (parity != 'n' && parity != 'o' && parity != 'e')
 267                 parity = 'n';
 268         if (bits != '7' && bits != '8')
 269                 bits = '8';
 270         if (flow == '\0')
 271                 flow = 'r';
 272
 273         sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
 274                 parity, bits, flow);
 275         strcat(prom_getcmdline(), console_string);
 276 #endif
 277 }
 278
 279 void __init prom_init(void)
 280 {
 281         ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
 282         ar7_init_env((struct env_var *)fw_arg2);
 283         console_config();
 284 }
 285
 286 #define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
 287 static inline unsigned int serial_in(int offset)
 288 {
 289         return readb((void *)PORT(offset));
 290 }
 291
 292 static inline void serial_out(int offset, int value)
 293 {
 294         writeb(value, (void *)PORT(offset));
 295 }
 296
 297 char prom_getchar(void)
 298 {
 299         while (!(serial_in(UART_LSR) & UART_LSR_DR));
 300         return serial_in(UART_RX);
 301 }
 302
 303 int prom_putchar(char c)
 304 {
 305         while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0);
 306         serial_out(UART_TX, c);
 307         return 1;
 308 }
 309
 310 #ifdef CONFIG_KGDB
 311 int putDebugChar(char c)
 312 {
 313         return prom_putchar(c);
 314 }
 315
 316 char getDebugChar(void)
 317 {
 318        return prom_getchar();
 319 }
 320 #endif
 321
 322 EXPORT_SYMBOL(prom_getenv);