X-Git-Url: https://git.enpas.org/?a=blobdiff_plain;f=target%2Flinux%2Far71xx%2Ffiles%2Farch%2Fmips%2Far71xx%2Fprom.c;h=293f9b25eb4101c6a29e1095b1452fab2dd84ece;hb=11a837ce029534fc38f6deb2a2f31d80fe5a1f7f;hp=0116d0f5c5adf687d66b54c40a2c13f828d6a3ff;hpb=ca18bd2e66accae4cb8ca110a5a372b4b081d100;p=openwrt.git diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c b/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c index 0116d0f5c5..293f9b25eb 100644 --- a/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c +++ b/target/linux/ar71xx/files/arch/mips/ar71xx/prom.c @@ -1,7 +1,7 @@ /* * Atheros AR71xx SoC specific prom routines * - * Copyright (C) 2008-2009 Gabor Juhos + * Copyright (C) 2008-2010 Gabor Juhos * Copyright (C) 2008 Imre Kaloz * * This program is free software; you can redistribute it and/or modify it @@ -12,69 +12,13 @@ #include #include #include -#include +#include #include #include #include #include -#include - -struct board_rec { - char *name; - unsigned long mach_type; -}; - -static int ar71xx_prom_argc __initdata; -static char **ar71xx_prom_argv __initdata; -static char **ar71xx_prom_envp __initdata; - -static struct board_rec boards[] __initdata = { - { - .name = "411", - .mach_type = AR71XX_MACH_RB_411, - }, { - .name = "433", - .mach_type = AR71XX_MACH_RB_433, - }, { - .name = "450", - .mach_type = AR71XX_MACH_RB_450, - }, { - .name = "493", - .mach_type = AR71XX_MACH_RB_493, - }, { - .name = "AW-NR580", - .mach_type = AR71XX_MACH_AW_NR580, - }, { - .name = "AP83", - .mach_type = AR71XX_MACH_AP83, - }, { - .name = "TEW-632BRP", - .mach_type = AR71XX_MACH_TEW_632BRP, - }, { - .name = "UBNT-RS", - .mach_type = AR71XX_MACH_UBNT_RS, - }, { - .name = "UBNT-LS-SR71", - .mach_type = AR71XX_MACH_UBNT_LSSR71, - }, { - .name = "UBNT-LSX", - .mach_type = AR71XX_MACH_UBNT_LSX, - }, { - .name = "WNR2000", - .mach_type = AR71XX_MACH_WNR2000, - }, { - .name = "PB42", - .mach_type = AR71XX_MACH_PB42, - }, { - .name = "MZK-W300NH", - .mach_type = AR71XX_MACH_MZK_W300NH, - }, { - .name = "MZK-W04NU", - .mach_type = AR71XX_MACH_MZK_W04NU, - } -}; static inline int is_valid_ram_addr(void *addr) { @@ -89,62 +33,47 @@ static inline int is_valid_ram_addr(void *addr) return 0; } -static __init char *ar71xx_prom_getargv(const char *name) +static char ar71xx_cmdline_buf[COMMAND_LINE_SIZE] __initdata; +static void __init ar71xx_prom_append_cmdline(const char *name, + const char *value) { - int len = strlen(name); - int i; - - if (!is_valid_ram_addr(ar71xx_prom_argv)) - return NULL; - - for (i = 0; i < ar71xx_prom_argc; i++) { - char *argv = ar71xx_prom_argv[i]; - - if (!is_valid_ram_addr(argv)) - continue; - - if (strncmp(name, argv, len) == 0 && (argv)[len] == '=') - return argv + len + 1; - } - - return NULL; + snprintf(ar71xx_cmdline_buf, sizeof(ar71xx_cmdline_buf), + " %s=%s", name, value); + strlcat(arcs_cmdline, ar71xx_cmdline_buf, sizeof(arcs_cmdline)); } -static __init char *ar71xx_prom_getenv(const char *envname) +static const char * __init ar71xx_prom_find_env(char **envp, const char *name) { - int len = strlen(envname); - char **env; + const char *ret = NULL; + int len; + char **p; - if (!is_valid_ram_addr(ar71xx_prom_envp)) + if (!is_valid_ram_addr(envp)) return NULL; - for (env = ar71xx_prom_envp; is_valid_ram_addr(*env); env++) { - if (strncmp(envname, *env, len) == 0 && (*env)[len] == '=') - return *env + len + 1; + len = strlen(name); + for (p = envp; is_valid_ram_addr(*p); p++) { + if (strncmp(name, *p, len) == 0 && (*p)[len] == '=') { + ret = *p + len + 1; + break; + } /* RedBoot env comes in pointer pairs - key, value */ - if (strncmp(envname, *env, len) == 0 && (*env)[len] == 0) - if (is_valid_ram_addr(*(++env))) - return *env; + if (strncmp(name, *p, len) == 0 && (*p)[len] == 0) + if (is_valid_ram_addr(*(++p))) { + ret = *p; + break; + } } - return NULL; -} - -static __init unsigned long find_board_byname(char *name) -{ - int i; - - for (i = 0; i < ARRAY_SIZE(boards); i++) - if (strcmp(name, boards[i].name) == 0) - return boards[i].mach_type; - - return AR71XX_MACH_GENERIC; + return ret; } -static int ar71xx_prom_init_myloader(void) +static int __init ar71xx_prom_init_myloader(void) { struct myloader_info *mylo; + char mac_buf[32]; + char *mac; mylo = myloader_get_info(); if (!mylo) @@ -152,67 +81,109 @@ static int ar71xx_prom_init_myloader(void) switch (mylo->did) { case DEVID_COMPEX_WP543: - ar71xx_mach_type = AR71XX_MACH_WP543; + ar71xx_prom_append_cmdline("board", "WP543"); break; default: printk(KERN_WARNING "prom: unknown device id: %x\n", mylo->did); + return 0; + } + + mac = mylo->macs[0]; + snprintf(mac_buf, sizeof(mac_buf), "%02x:%02x:%02x:%02x:%02x:%02x", + mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); + + ar71xx_prom_append_cmdline("ethaddr", mac_buf); + + return 1; +} + +#ifdef CONFIG_IMAGE_CMDLINE_HACK +extern char __image_cmdline[]; + +static int __init ar71xx_use__image_cmdline(void) +{ + char *p = __image_cmdline; + int replace = 0; + + if (*p == '-') { + replace = 1; + p++; + } + + if (*p == '\0') + return 0; + + if (replace) { + strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline)); + } else { + strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline)); + strlcat(arcs_cmdline, p, sizeof(arcs_cmdline)); } - ar71xx_set_mac_base(mylo->macs[0]); return 1; } +#else +static inline int ar71xx_use__image_cmdline(void) { return 0; } +#endif -static void ar71xx_prom_init_generic(void) +static __init void ar71xx_prom_init_cmdline(int argc, char **argv) { - char *p; - - ar71xx_prom_argc = fw_arg0; - ar71xx_prom_argv = (char **)fw_arg1; - ar71xx_prom_envp = (char **)fw_arg2; - - p = ar71xx_prom_getargv("board"); - if (!p) - p = ar71xx_prom_getenv("board"); - if (p) - ar71xx_mach_type = find_board_byname(p); - - p = ar71xx_prom_getenv("ethaddr"); - if (!p) - p = ar71xx_prom_getargv("kmac"); - if (p) - ar71xx_parse_mac_addr(p); + int i; + + if (ar71xx_use__image_cmdline()) + return; + + if (!is_valid_ram_addr(argv)) + return; + + for (i = 0; i < argc; i++) + if (is_valid_ram_addr(argv[i])) { + strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline)); + strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline)); + } } void __init prom_init(void) { + const char *env; + char **envp; + printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, " "fw_arg2=%08x, fw_arg3=%08x\n", (unsigned int)fw_arg0, (unsigned int)fw_arg1, (unsigned int)fw_arg2, (unsigned int)fw_arg3); - ar71xx_mach_type = AR71XX_MACH_GENERIC; if (ar71xx_prom_init_myloader()) return; - ar71xx_prom_init_generic(); -} + ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1); -void __init prom_free_prom_memory(void) -{ - /* We do not have to prom memory to free */ -} + envp = (char **)fw_arg2; + if (!strstr(arcs_cmdline, "ethaddr=")) { + env = ar71xx_prom_find_env(envp, "ethaddr"); + if (env) + ar71xx_prom_append_cmdline("ethaddr", env); + } + + if (!strstr(arcs_cmdline, "board=")) { + env = ar71xx_prom_find_env(envp, "board"); + if (env) { + /* Workaround for buggy bootloaders */ + if (strcmp(env, "RouterStation") == 0 || + strcmp(env, "Ubiquiti AR71xx-based board") == 0) + env = "UBNT-RS"; -#define UART_READ(r) \ - __raw_readl((void __iomem *)(KSEG1ADDR(AR71XX_UART_BASE) + 4 * (r))) + if (strcmp(env, "RouterStation PRO") == 0) + env = "UBNT-RSPRO"; -#define UART_WRITE(r, v) \ - __raw_writel((v), (void __iomem *)(KSEG1ADDR(AR71XX_UART_BASE) + 4*(r))) + ar71xx_prom_append_cmdline("board", env); + } + } +} -void prom_putchar(unsigned char ch) +void __init prom_free_prom_memory(void) { - while (((UART_READ(UART_LSR)) & UART_LSR_THRE) == 0); - UART_WRITE(UART_TX, ch); - while (((UART_READ(UART_LSR)) & UART_LSR_THRE) == 0); + /* We do not have to prom memory to free */ }