X-Git-Url: https://git.rohieb.name/openwrt.git/blobdiff_plain/6e38bb04576b38458e3c2b66edb72f875fc662a5..247c33e26da97e26cc6dde23aad675c8c63d2050:/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 7176be302..28397427d 100644 --- 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 #include #include +#include #include #include #include +#include #include +#include #define MAX_ENTRY 80 @@ -39,75 +42,9 @@ struct env_var { 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, }, }; -char * __init prom_getenv(char *name) +char * prom_getenv(char *name) { 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"; -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) { @@ -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; - 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 { - 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; } @@ -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) { - prom_printf("\nLINUX running...\n"); 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))) @@ -263,4 +290,38 @@ int prom_putchar(char c) 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);