source: trunk/target/linux/ar71xx/files-2.6.39/arch/mips/ar71xx/prom.c @ 29912

Last change on this file since 29912 was 29912, checked in by juhosg, 5 years ago

ar71xx: add support for Compex WPE72/WPE72NX

This patch adds support for Compex WPE72 bare board and Compex WPE72NX
Indoor Access Point.

[juhosg: add support to 3.2 as well]

Signed-off-by: Johnathan Boyce <jon.boyce@…>

  • Property svn:eol-style set to native
File size: 4.2 KB
Line 
1/*
2 *  Atheros AR71xx SoC specific prom routines
3 *
4 *  Copyright (C) 2008-2010 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/string.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
23static inline int is_valid_ram_addr(void *addr)
24{
25        if (((u32) addr > KSEG0) &&
26            ((u32) addr < (KSEG0 + AR71XX_MEM_SIZE_MAX)))
27                return 1;
28
29        if (((u32) addr > KSEG1) &&
30            ((u32) addr < (KSEG1 + AR71XX_MEM_SIZE_MAX)))
31                return 1;
32
33        return 0;
34}
35
36static char ar71xx_cmdline_buf[COMMAND_LINE_SIZE] __initdata;
37static void __init ar71xx_prom_append_cmdline(const char *name,
38                                              const char *value)
39{
40        snprintf(ar71xx_cmdline_buf, sizeof(ar71xx_cmdline_buf),
41                 " %s=%s", name, value);
42        strlcat(arcs_cmdline, ar71xx_cmdline_buf, sizeof(arcs_cmdline));
43}
44
45static const char * __init ar71xx_prom_find_env(char **envp, const char *name)
46{
47        const char *ret = NULL;
48        int len;
49        char **p;
50
51        if (!is_valid_ram_addr(envp))
52                return NULL;
53
54        len = strlen(name);
55        for (p = envp; is_valid_ram_addr(*p); p++) {
56                if (strncmp(name, *p, len) == 0 && (*p)[len] == '=') {
57                        ret = *p + len + 1;
58                        break;
59                }
60
61                /* RedBoot env comes in pointer pairs - key, value */
62                if (strncmp(name, *p, len) == 0 && (*p)[len] == 0)
63                        if (is_valid_ram_addr(*(++p))) {
64                                ret = *p;
65                                break;
66                        }
67        }
68
69        return ret;
70}
71
72#ifdef CONFIG_IMAGE_CMDLINE_HACK
73extern char __image_cmdline[];
74
75static int __init ar71xx_use__image_cmdline(void)
76{
77        char *p = __image_cmdline;
78        int replace = 0;
79
80        if (*p == '-') {
81                replace = 1;
82                p++;
83        }
84
85        if (*p == '\0')
86                return 0;
87
88        if (replace) {
89                strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline));
90        } else {
91                strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
92                strlcat(arcs_cmdline, p, sizeof(arcs_cmdline));
93        }
94
95        return 1;
96}
97#else
98static inline int ar71xx_use__image_cmdline(void) { return 0; }
99#endif
100
101static int __init ar71xx_prom_init_myloader(void)
102{
103        struct myloader_info *mylo;
104        char mac_buf[32];
105        unsigned char *mac;
106
107        mylo = myloader_get_info();
108        if (!mylo)
109                return 0;
110
111        switch (mylo->did) {
112        case DEVID_COMPEX_WP543:
113                ar71xx_prom_append_cmdline("board", "WP543");
114                break;
115        case DEVID_COMPEX_WPE72:
116                ar71xx_prom_append_cmdline("board", "WPE72");
117                break;
118        default:
119                printk(KERN_WARNING "prom: unknown device id: %x\n",
120                                mylo->did);
121                return 0;
122        }
123
124        mac = mylo->macs[0];
125        snprintf(mac_buf, sizeof(mac_buf), "%02x:%02x:%02x:%02x:%02x:%02x",
126                 mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
127
128        ar71xx_prom_append_cmdline("ethaddr", mac_buf);
129
130        ar71xx_use__image_cmdline();
131
132        return 1;
133}
134
135static __init void ar71xx_prom_init_cmdline(int argc, char **argv)
136{
137        int i;
138
139        if (ar71xx_use__image_cmdline())
140                return;
141
142        if (!is_valid_ram_addr(argv))
143                return;
144
145        for (i = 0; i < argc; i++)
146                if (is_valid_ram_addr(argv[i])) {
147                        strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
148                        strlcat(arcs_cmdline, argv[i], sizeof(arcs_cmdline));
149                }
150}
151
152void __init prom_init(void)
153{
154        const char *env;
155        char **envp;
156
157        printk(KERN_DEBUG "prom: fw_arg0=%08x, fw_arg1=%08x, "
158                        "fw_arg2=%08x, fw_arg3=%08x\n",
159                        (unsigned int)fw_arg0, (unsigned int)fw_arg1,
160                        (unsigned int)fw_arg2, (unsigned int)fw_arg3);
161
162
163        if (ar71xx_prom_init_myloader())
164                return;
165
166        ar71xx_prom_init_cmdline(fw_arg0, (char **)fw_arg1);
167
168        envp = (char **)fw_arg2;
169        if (!strstr(arcs_cmdline, "ethaddr=")) {
170                env = ar71xx_prom_find_env(envp, "ethaddr");
171                if (env)
172                        ar71xx_prom_append_cmdline("ethaddr", env);
173        }
174
175        if (!strstr(arcs_cmdline, "board=")) {
176                env = ar71xx_prom_find_env(envp, "board");
177                if (env) {
178                        /* Workaround for buggy bootloaders */
179                        if (strcmp(env, "RouterStation") == 0 ||
180                            strcmp(env, "Ubiquiti AR71xx-based board") == 0)
181                                env = "UBNT-RS";
182
183                        if (strcmp(env, "RouterStation PRO") == 0)
184                                env = "UBNT-RSPRO";
185
186                        ar71xx_prom_append_cmdline("board", env);
187                }
188        }
189}
190
191void __init prom_free_prom_memory(void)
192{
193        /* We do not have to prom memory to free */
194}
Note: See TracBrowser for help on using the repository browser.