Register the second uart on tnetd7300 and fix the watchdog register for 7200/7300...

[openwrt.git] / target / linux / ar7-2.6 / files / arch / mips / ar7 / prom.c

diff --git a/target/linux/ar7-2.6/files/arch/mips/ar7/prom.c b/target/linux/ar7-2.6/files/arch/mips/ar7/prom.c
index 7176be3..2839742 100644 (file)
--- a/target/linux/ar7-2.6/files/arch/mips/ar7/prom.c
+++ b/target/linux/ar7-2.6/files/arch/mips/ar7/prom.c
@@ -26,11 +26,14 @@
 #include <linux/serial_reg.h>
 #include <linux/spinlock.h>
 #include <linux/module.h>
 #include <linux/serial_reg.h>
 #include <linux/spinlock.h>
 #include <linux/module.h>

+#include <linux/string.h>

 #include <asm/io.h>
 #include <asm/bootinfo.h>
 #include <asm/mips-boards/prom.h>
 #include <asm/io.h>
 #include <asm/bootinfo.h>
 #include <asm/mips-boards/prom.h>

+#include <asm/gdb-stub.h>

 
 #include <asm/ar7/ar7.h>
 
 #include <asm/ar7/ar7.h>

+#include <asm/ar7/prom.h>

 
 #define MAX_ENTRY 80
 
 
 #define MAX_ENTRY 80
 


@@ -39,75 +42,9 @@ struct env_var {
        char *value;
 };
 
        char *value;
 };
 

-struct psp_chip_map {
-       u16 chip;
-       char *names[50];
-};
-
-/* I hate this. No. *I* *HATE* *THIS* */
-static __initdata struct psp_chip_map psp_chip_map[] = {
-       {
-               .chip = 0x5,
-               .names = {
-                       "dummy", "cpufrequency", "memsize",
-                       "flashsize", "modetty0", "modetty1", "prompt",
-                       "bootcfg", "maca", "macb", "usb_rndis_mac",
-                       "macap", "my_ipaddress", "server_ipaddress",
-                       "bline_maca", "bline_macb", "bline_rndis",
-                       "bline_atm", "usb_pid", "usb_vid",
-                       "usb_eppolli", "gateway_ipaddress",
-                       "subnet_mask", "usb_serial", "usb_board_mac",
-                       "remote_user", "remote_pass", "remote_dir",
-                       "sysfrequency", "link_timeout", "mac_port",
-                       "path", "hostname", "tftpcfg", "buildops",
-                       "tftp_fo_fname", "tftp_fo_ports",
-                       "console_state", "mipsfrequency", 
-               },
-       },
-       {
-               .chip = 0x18,
-               .names = {
-                       "dummy", "cpufrequency", "memsize",
-                       "flashsize", "modetty0", "modetty1", "prompt",
-                       "bootcfg", "maca", "macb", "usb_rndis_mac",
-                       "macap", "my_ipaddress", "server_ipaddress",
-                       "bline_maca", "bline_macb", "bline_rndis",
-                       "bline_atm", "usb_pid", "usb_vid",
-                       "usb_eppolli", "gateway_ipaddress",
-                       "subnet_mask", "usb_serial", "usb_board_mac",
-                       "remote_user", "remote_pass", "remote_dir",
-                       "sysfrequency", "link_timeout", "mac_port",
-                       "path", "hostname", "tftpcfg", "buildops",
-                       "tftp_fo_fname", "tftp_fo_ports",
-                       "console_state", "mipsfrequency", 
-               },
-       },
-       {
-               .chip = 0x2b,
-               .names = {
-                       "dummy", "cpufrequency", "memsize",
-                       "flashsize", "modetty0", "modetty1", "prompt",
-                       "bootcfg", "maca", "macb", "usb_rndis_mac",
-                       "macap", "my_ipaddress", "server_ipaddress",
-                       "bline_maca", "bline_macb", "bline_rndis",
-                       "bline_atm", "usb_pid", "usb_vid",
-                       "usb_eppolli", "gateway_ipaddress",
-                       "subnet_mask", "usb_serial", "usb_board_mac",
-                       "remote_user", "remote_pass", "remote_dir",
-                       "sysfrequency", "link_timeout", "mac_port",
-                       "path", "hostname", "tftpcfg", "buildops",
-                       "tftp_fo_fname", "tftp_fo_ports",
-                       "console_state", "mipsfrequency", 
-               },
-       },
-       {
-               .chip = 0x0,
-       },
-};
-

 static struct env_var adam2_env[MAX_ENTRY] = { { 0, }, };
 
 static struct env_var adam2_env[MAX_ENTRY] = { { 0, }, };
 

-char * __init prom_getenv(char *name)
+char * prom_getenv(char *name)

 {
        int i;
        for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
 {
        int i;
        for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)


@@ -153,15 +90,71 @@ struct psbl_rec {
 
 static __initdata char psp_env_version[] = "TIENV0.8";
 
 
 static __initdata char psp_env_version[] = "TIENV0.8";
 

-struct psp_env_var {
-       unsigned char num;
-       unsigned char ctrl;
-       unsigned short csum;
-       unsigned char len;
-       unsigned char data[11];
+struct psp_env_chunk {
+       u8 num;
+       u8 ctrl;
+       u16 csum;
+       u8 len;
+       char data[11];
+} __attribute__ ((packed));
+
+struct psp_var_map_entry {
+       u8 num;
+       char *value;
+};
+
+static struct psp_var_map_entry psp_var_map[] = {
+       { 1, "cpufrequency" },
+       { 2, "memsize" },
+       { 3, "flashsize" },
+       { 4, "modetty0" },
+       { 5, "modetty1" },
+       { 8, "maca" },
+       { 9, "macb" },
+       { 28, "sysfrequency" },
+       { 38, "mipsfrequency" },

 };
 
 };
 

-static char psp_env_data[2048] = { 0, };
+/*
+
+Well-known variable (num is looked up in table above for matching variable name)
+Example: cpufrequency=211968000
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+
+| 01 |CTRL|CHECKSUM | 01 | _2 | _1 | _1 | _9 | _6 | _8 | _0 | _0 | _0 | \0 | FF |
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+
+
+Name=Value pair in a single chunk
+Example: NAME=VALUE
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+
+| 00 |CTRL|CHECKSUM | 01 | _N | _A | _M | _E | _0 | _V | _A | _L | _U | _E | \0 |
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+
+
+Name=Value pair in 2 chunks (len is the number of chunks)
+Example: bootloaderVersion=1.3.7.15
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+
+| 00 |CTRL|CHECKSUM | 02 | _b | _o | _o | _t | _l | _o | _a | _d | _e | _r | _V |
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+
+| _e | _r | _s | _i | _o | _n | \0 | _1 | _. | _3 | _. | _7 | _. | _1 | _5 | \0 |
++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+ 
+
+Data is padded with 0xFF
+
+*/
+
+#define PSP_ENV_SIZE  4096
+
+static char psp_env_data[PSP_ENV_SIZE] = { 0, };
+
+static char * __init lookup_psp_var_map(u8 num)
+{
+       int i;
+
+       for (i = 0; i < sizeof(psp_var_map); i++)
+               if (psp_var_map[i].num == num)
+                       return psp_var_map[i].value;
+       
+       return NULL;
+}

 
 static void __init add_adam2_var(char *name, char *value)
 {
 
 static void __init add_adam2_var(char *name, char *value)
 {


@@ -178,41 +171,29 @@ static void __init add_adam2_var(char *name, char *value)
        }
 }
 
        }
 }
 

-static int __init parse_psp_env(void *start)
+static int __init parse_psp_env(void *psp_env_base)

 {
 {

-       int i, j;
-       u16 chip;
-       struct psp_chip_map *map;
-       char *src, *dest, *name, *value;
-       struct psp_env_var *vars = start;
-
-       chip = get_chip_id();
-       for (map = psp_chip_map; map->chip; map++)
-               if (map->chip == chip)
-                       break;
+       int i, n;
+       char *name, *value;
+       struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data;

 
 

-       if (!map->chip)
-               return -EINVAL;
+       memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE);

 
        i = 1;
 
        i = 1;

-       j = 0;
-       dest = psp_env_data;
-       while (vars[i].num < 0xff) {
-               src = vars[i].data;
-               if (vars[i].num) {
-                       strcpy(dest, map->names[vars[i].num]);
-                       name = dest;
+       n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk);
+       while (i < n) {
+               if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n))
+                       break;
+               value = chunks[i].data;
+               if (chunks[i].num) {
+                       name = lookup_psp_var_map(chunks[i].num);

                } else {
                } else {

-                       strcpy(dest, src);
-                       name = dest;
-                       src += strlen(src) + 1;
-               }                       
-               dest += strlen(dest) + 1;
-               strcpy(dest, src);
-               value = dest;
-               dest += strlen(dest) + 1;
-               add_adam2_var(name, value);
-               i += vars[i].len;
+                       name = value;
+                       value += strlen(name) + 1;
+               }
+               if (name)
+                       add_adam2_var(name, value);
+               i += chunks[i].len;

        }
        return 0;
 }
        }
        return 0;
 }


@@ -232,11 +213,57 @@ static void __init ar7_init_env(struct env_var *env)
        }
 }
 
        }
 }
 

+static void __init console_config(void)
+{
+#ifdef CONFIG_SERIAL_8250_CONSOLE
+       char console_string[40];
+       int baud = 0;
+       char parity = '\0', bits = '\0', flow = '\0';
+       char *s, *p;
+
+       if (strstr(prom_getcmdline(), "console="))
+               return;
+
+#ifdef CONFIG_KGDB
+       if (!strstr(prom_getcmdline(), "nokgdb"))
+       {
+            strcat(prom_getcmdline(), " console=kgdb");
+            kgdb_enabled = 1;
+            return;
+       }
+#endif
+
+       if ((s = prom_getenv("modetty0"))) {
+               baud = simple_strtoul(s, &p, 10);
+               s = p;
+               if (*s == ',') s++;
+               if (*s) parity = *s++;
+               if (*s == ',') s++;
+               if (*s) bits = *s++;
+               if (*s == ',') s++;
+               if (*s == 'h') flow = 'r';
+       }
+
+       if (baud == 0)
+               baud = 38400;
+       if (parity != 'n' && parity != 'o' && parity != 'e')
+               parity = 'n';
+       if (bits != '7' && bits != '8')
+               bits = '8';
+       if (flow == '\0')
+               flow = 'r';
+
+       sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
+               parity, bits, flow);
+       strcat(prom_getcmdline(), console_string);
+#endif
+}
+

 void __init prom_init(void)
 {
 void __init prom_init(void)
 {

-       prom_printf("\nLINUX running...\n");

        ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
        ar7_init_env((struct env_var *)fw_arg2);
        ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
        ar7_init_env((struct env_var *)fw_arg2);

+       console_config();

 }
 
 #define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
 }
 
 #define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))


@@ -263,4 +290,38 @@ int prom_putchar(char c)
        return 1;
 }
 
        return 1;
 }
 

+// from adm5120/prom.c
+void prom_printf(char *fmt, ...)
+{
+    va_list args;
+    int l;
+    char *p, *buf_end;
+    char buf[1024];
+
+    va_start(args, fmt);
+    l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
+    va_end(args);
+
+    buf_end = buf + l;
+
+    for (p = buf; p < buf_end; p++) {
+        /* Crude cr/nl handling is better than none */
+        if (*p == '\n')
+            prom_putchar('\r');
+        prom_putchar(*p);
+    }
+}
+
+#ifdef CONFIG_KGDB
+int putDebugChar(char c)
+{
+       return prom_putchar(c);
+}
+
+char getDebugChar(void)
+{
+       return prom_getchar();
+}
+#endif
+

 EXPORT_SYMBOL(prom_getenv);
 EXPORT_SYMBOL(prom_getenv);