1 /*
2 * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org>
3 * Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
4 * Copyright (C) 2006 Michael Buesch <m@bues.ch>
5 * Copyright (C) 2010 Waldemar Brodkorb <wbx@openadk.org>
6 * Copyright (C) 2010-2012 Hauke Mehrtens <hauke@hauke-m.de>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 *
13 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
14 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
15 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
16 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
17 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
18 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
19 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
20 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
21 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
22 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
23 *
24 * You should have received a copy of the GNU General Public License along
25 * with this program; if not, write to the Free Software Foundation, Inc.,
26 * 675 Mass Ave, Cambridge, MA 02139, USA.
27 */
28
29 #include <linux/export.h>
30 #include <linux/types.h>
31 #include <linux/ssb/ssb.h>
32 #include <linux/ssb/ssb_embedded.h>
33 #include <linux/bcma/bcma_soc.h>
34 #include <asm/bootinfo.h>
35 #include <asm/reboot.h>
36 #include <asm/time.h>
37 #include <bcm47xx.h>
38 #include <asm/mach-bcm47xx/nvram.h>
39
40 union bcm47xx_bus bcm47xx_bus;
41 EXPORT_SYMBOL(bcm47xx_bus);
42
43 enum bcm47xx_bus_type bcm47xx_bus_type;
44 EXPORT_SYMBOL(bcm47xx_bus_type);
45
bcm47xx_machine_restart(char * command)46 static void bcm47xx_machine_restart(char *command)
47 {
48 printk(KERN_ALERT "Please stand by while rebooting the system...\n");
49 local_irq_disable();
50 /* Set the watchdog timer to reset immediately */
51 switch (bcm47xx_bus_type) {
52 #ifdef CONFIG_BCM47XX_SSB
53 case BCM47XX_BUS_TYPE_SSB:
54 ssb_watchdog_timer_set(&bcm47xx_bus.ssb, 1);
55 break;
56 #endif
57 #ifdef CONFIG_BCM47XX_BCMA
58 case BCM47XX_BUS_TYPE_BCMA:
59 bcma_chipco_watchdog_timer_set(&bcm47xx_bus.bcma.bus.drv_cc, 1);
60 break;
61 #endif
62 }
63 while (1)
64 cpu_relax();
65 }
66
bcm47xx_machine_halt(void)67 static void bcm47xx_machine_halt(void)
68 {
69 /* Disable interrupts and watchdog and spin forever */
70 local_irq_disable();
71 switch (bcm47xx_bus_type) {
72 #ifdef CONFIG_BCM47XX_SSB
73 case BCM47XX_BUS_TYPE_SSB:
74 ssb_watchdog_timer_set(&bcm47xx_bus.ssb, 0);
75 break;
76 #endif
77 #ifdef CONFIG_BCM47XX_BCMA
78 case BCM47XX_BUS_TYPE_BCMA:
79 bcma_chipco_watchdog_timer_set(&bcm47xx_bus.bcma.bus.drv_cc, 0);
80 break;
81 #endif
82 }
83 while (1)
84 cpu_relax();
85 }
86
87 #ifdef CONFIG_BCM47XX_SSB
bcm47xx_get_sprom_ssb(struct ssb_bus * bus,struct ssb_sprom * out)88 static int bcm47xx_get_sprom_ssb(struct ssb_bus *bus, struct ssb_sprom *out)
89 {
90 char prefix[10];
91
92 if (bus->bustype == SSB_BUSTYPE_PCI) {
93 snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
94 bus->host_pci->bus->number + 1,
95 PCI_SLOT(bus->host_pci->devfn));
96 bcm47xx_fill_sprom(out, prefix);
97 return 0;
98 } else {
99 printk(KERN_WARNING "bcm47xx: unable to fill SPROM for given bustype.\n");
100 return -EINVAL;
101 }
102 }
103
bcm47xx_get_invariants(struct ssb_bus * bus,struct ssb_init_invariants * iv)104 static int bcm47xx_get_invariants(struct ssb_bus *bus,
105 struct ssb_init_invariants *iv)
106 {
107 char buf[20];
108
109 /* Fill boardinfo structure */
110 memset(&(iv->boardinfo), 0 , sizeof(struct ssb_boardinfo));
111
112 if (nvram_getenv("boardvendor", buf, sizeof(buf)) >= 0)
113 iv->boardinfo.vendor = (u16)simple_strtoul(buf, NULL, 0);
114 else
115 iv->boardinfo.vendor = SSB_BOARDVENDOR_BCM;
116 if (nvram_getenv("boardtype", buf, sizeof(buf)) >= 0)
117 iv->boardinfo.type = (u16)simple_strtoul(buf, NULL, 0);
118 if (nvram_getenv("boardrev", buf, sizeof(buf)) >= 0)
119 iv->boardinfo.rev = (u16)simple_strtoul(buf, NULL, 0);
120
121 bcm47xx_fill_sprom(&iv->sprom, NULL);
122
123 if (nvram_getenv("cardbus", buf, sizeof(buf)) >= 0)
124 iv->has_cardbus_slot = !!simple_strtoul(buf, NULL, 10);
125
126 return 0;
127 }
128
bcm47xx_register_ssb(void)129 static void __init bcm47xx_register_ssb(void)
130 {
131 int err;
132 char buf[100];
133 struct ssb_mipscore *mcore;
134
135 err = ssb_arch_register_fallback_sprom(&bcm47xx_get_sprom_ssb);
136 if (err)
137 printk(KERN_WARNING "bcm47xx: someone else already registered"
138 " a ssb SPROM callback handler (err %d)\n", err);
139
140 err = ssb_bus_ssbbus_register(&(bcm47xx_bus.ssb), SSB_ENUM_BASE,
141 bcm47xx_get_invariants);
142 if (err)
143 panic("Failed to initialize SSB bus (err %d)", err);
144
145 mcore = &bcm47xx_bus.ssb.mipscore;
146 if (nvram_getenv("kernel_args", buf, sizeof(buf)) >= 0) {
147 if (strstr(buf, "console=ttyS1")) {
148 struct ssb_serial_port port;
149
150 printk(KERN_DEBUG "Swapping serial ports!\n");
151 /* swap serial ports */
152 memcpy(&port, &mcore->serial_ports[0], sizeof(port));
153 memcpy(&mcore->serial_ports[0], &mcore->serial_ports[1],
154 sizeof(port));
155 memcpy(&mcore->serial_ports[1], &port, sizeof(port));
156 }
157 }
158 }
159 #endif
160
161 #ifdef CONFIG_BCM47XX_BCMA
bcm47xx_get_sprom_bcma(struct bcma_bus * bus,struct ssb_sprom * out)162 static int bcm47xx_get_sprom_bcma(struct bcma_bus *bus, struct ssb_sprom *out)
163 {
164 char prefix[10];
165 struct bcma_device *core;
166
167 switch (bus->hosttype) {
168 case BCMA_HOSTTYPE_PCI:
169 snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
170 bus->host_pci->bus->number + 1,
171 PCI_SLOT(bus->host_pci->devfn));
172 bcm47xx_fill_sprom(out, prefix);
173 return 0;
174 case BCMA_HOSTTYPE_SOC:
175 bcm47xx_fill_sprom_ethernet(out, NULL);
176 core = bcma_find_core(bus, BCMA_CORE_80211);
177 if (core) {
178 snprintf(prefix, sizeof(prefix), "sb/%u/",
179 core->core_index);
180 bcm47xx_fill_sprom(out, prefix);
181 }
182 return 0;
183 default:
184 pr_warn("bcm47xx: unable to fill SPROM for given bustype.\n");
185 return -EINVAL;
186 }
187 }
188
bcm47xx_register_bcma(void)189 static void __init bcm47xx_register_bcma(void)
190 {
191 int err;
192
193 err = bcma_arch_register_fallback_sprom(&bcm47xx_get_sprom_bcma);
194 if (err)
195 pr_warn("bcm47xx: someone else already registered a bcma SPROM callback handler (err %d)\n", err);
196
197 err = bcma_host_soc_register(&bcm47xx_bus.bcma);
198 if (err)
199 panic("Failed to initialize BCMA bus (err %d)", err);
200 }
201 #endif
202
plat_mem_setup(void)203 void __init plat_mem_setup(void)
204 {
205 struct cpuinfo_mips *c = ¤t_cpu_data;
206
207 if (c->cputype == CPU_74K) {
208 printk(KERN_INFO "bcm47xx: using bcma bus\n");
209 #ifdef CONFIG_BCM47XX_BCMA
210 bcm47xx_bus_type = BCM47XX_BUS_TYPE_BCMA;
211 bcm47xx_register_bcma();
212 #endif
213 } else {
214 printk(KERN_INFO "bcm47xx: using ssb bus\n");
215 #ifdef CONFIG_BCM47XX_SSB
216 bcm47xx_bus_type = BCM47XX_BUS_TYPE_SSB;
217 bcm47xx_register_ssb();
218 #endif
219 }
220
221 _machine_restart = bcm47xx_machine_restart;
222 _machine_halt = bcm47xx_machine_halt;
223 pm_power_off = bcm47xx_machine_halt;
224 }
225
bcm47xx_register_bus_complete(void)226 static int __init bcm47xx_register_bus_complete(void)
227 {
228 switch (bcm47xx_bus_type) {
229 #ifdef CONFIG_BCM47XX_SSB
230 case BCM47XX_BUS_TYPE_SSB:
231 /* Nothing to do */
232 break;
233 #endif
234 #ifdef CONFIG_BCM47XX_BCMA
235 case BCM47XX_BUS_TYPE_BCMA:
236 bcma_bus_register(&bcm47xx_bus.bcma.bus);
237 break;
238 #endif
239 }
240 return 0;
241 }
242 device_initcall(bcm47xx_register_bus_complete);
243