MIPS: BCM47XX: do not use cpu_wait instruction on BCM4706
[deliverable/linux.git] / arch / mips / bcm47xx / setup.c
CommitLineData
1c0c13eb
AJ
1/*
2 * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org>
1c0c13eb 3 * Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
eb032b98 4 * Copyright (C) 2006 Michael Buesch <m@bues.ch>
121915c4 5 * Copyright (C) 2010 Waldemar Brodkorb <wbx@openadk.org>
f384b3dd 6 * Copyright (C) 2010-2012 Hauke Mehrtens <hauke@hauke-m.de>
1c0c13eb
AJ
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
cae39d13 29#include <linux/export.h>
1c0c13eb
AJ
30#include <linux/types.h>
31#include <linux/ssb/ssb.h>
b06f3e19 32#include <linux/ssb/ssb_embedded.h>
c1d1c5d4 33#include <linux/bcma/bcma_soc.h>
25e5fb97 34#include <asm/bootinfo.h>
76b573e4 35#include <asm/idle.h>
7da4b6f8 36#include <asm/prom.h>
1c0c13eb
AJ
37#include <asm/reboot.h>
38#include <asm/time.h>
39#include <bcm47xx.h>
111bd981 40#include <bcm47xx_nvram.h>
786c497a 41#include <bcm47xx_board.h>
1c0c13eb 42
08ccf572
HM
43union bcm47xx_bus bcm47xx_bus;
44EXPORT_SYMBOL(bcm47xx_bus);
45
46enum bcm47xx_bus_type bcm47xx_bus_type;
47EXPORT_SYMBOL(bcm47xx_bus_type);
1c0c13eb
AJ
48
49static void bcm47xx_machine_restart(char *command)
50{
51 printk(KERN_ALERT "Please stand by while rebooting the system...\n");
52 local_irq_disable();
53 /* Set the watchdog timer to reset immediately */
08ccf572 54 switch (bcm47xx_bus_type) {
a656ffcb 55#ifdef CONFIG_BCM47XX_SSB
08ccf572
HM
56 case BCM47XX_BUS_TYPE_SSB:
57 ssb_watchdog_timer_set(&bcm47xx_bus.ssb, 1);
58 break;
c1d1c5d4
HM
59#endif
60#ifdef CONFIG_BCM47XX_BCMA
61 case BCM47XX_BUS_TYPE_BCMA:
62 bcma_chipco_watchdog_timer_set(&bcm47xx_bus.bcma.bus.drv_cc, 1);
63 break;
a656ffcb 64#endif
08ccf572 65 }
1c0c13eb
AJ
66 while (1)
67 cpu_relax();
68}
69
70static void bcm47xx_machine_halt(void)
71{
72 /* Disable interrupts and watchdog and spin forever */
73 local_irq_disable();
08ccf572 74 switch (bcm47xx_bus_type) {
a656ffcb 75#ifdef CONFIG_BCM47XX_SSB
08ccf572
HM
76 case BCM47XX_BUS_TYPE_SSB:
77 ssb_watchdog_timer_set(&bcm47xx_bus.ssb, 0);
78 break;
c1d1c5d4
HM
79#endif
80#ifdef CONFIG_BCM47XX_BCMA
81 case BCM47XX_BUS_TYPE_BCMA:
82 bcma_chipco_watchdog_timer_set(&bcm47xx_bus.bcma.bus.drv_cc, 0);
83 break;
a656ffcb 84#endif
08ccf572 85 }
1c0c13eb
AJ
86 while (1)
87 cpu_relax();
88}
89
a656ffcb 90#ifdef CONFIG_BCM47XX_SSB
f384b3dd 91static int bcm47xx_get_sprom_ssb(struct ssb_bus *bus, struct ssb_sprom *out)
fe6f3642
HM
92{
93 char prefix[10];
94
95 if (bus->bustype == SSB_BUSTYPE_PCI) {
5fe2e071 96 memset(out, 0, sizeof(struct ssb_sprom));
fe6f3642
HM
97 snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
98 bus->host_pci->bus->number + 1,
99 PCI_SLOT(bus->host_pci->devfn));
b8ebbaff 100 bcm47xx_fill_sprom(out, prefix, false);
fe6f3642
HM
101 return 0;
102 } else {
103 printk(KERN_WARNING "bcm47xx: unable to fill SPROM for given bustype.\n");
104 return -EINVAL;
105 }
106}
107
1c0c13eb 108static int bcm47xx_get_invariants(struct ssb_bus *bus,
f384b3dd 109 struct ssb_init_invariants *iv)
1c0c13eb 110{
2aa088d6 111 char buf[20];
25e5fb97
AJ
112
113 /* Fill boardinfo structure */
114 memset(&(iv->boardinfo), 0 , sizeof(struct ssb_boardinfo));
115
a9bba182 116 bcm47xx_fill_ssb_boardinfo(&iv->boardinfo, NULL);
25e5fb97 117
5fe2e071 118 memset(&iv->sprom, 0, sizeof(struct ssb_sprom));
b8ebbaff 119 bcm47xx_fill_sprom(&iv->sprom, NULL, false);
121915c4 120
111bd981 121 if (bcm47xx_nvram_getenv("cardbus", buf, sizeof(buf)) >= 0)
2aa088d6 122 iv->has_cardbus_slot = !!simple_strtoul(buf, NULL, 10);
25e5fb97 123
1c0c13eb
AJ
124 return 0;
125}
126
08ccf572 127static void __init bcm47xx_register_ssb(void)
1c0c13eb
AJ
128{
129 int err;
1690a7f9
HM
130 char buf[100];
131 struct ssb_mipscore *mcore;
1c0c13eb 132
f384b3dd 133 err = ssb_arch_register_fallback_sprom(&bcm47xx_get_sprom_ssb);
fe6f3642
HM
134 if (err)
135 printk(KERN_WARNING "bcm47xx: someone else already registered"
136 " a ssb SPROM callback handler (err %d)\n", err);
137
08ccf572 138 err = ssb_bus_ssbbus_register(&(bcm47xx_bus.ssb), SSB_ENUM_BASE,
1c0c13eb
AJ
139 bcm47xx_get_invariants);
140 if (err)
ab75dc02 141 panic("Failed to initialize SSB bus (err %d)", err);
1c0c13eb 142
08ccf572 143 mcore = &bcm47xx_bus.ssb.mipscore;
111bd981 144 if (bcm47xx_nvram_getenv("kernel_args", buf, sizeof(buf)) >= 0) {
1690a7f9
HM
145 if (strstr(buf, "console=ttyS1")) {
146 struct ssb_serial_port port;
147
148 printk(KERN_DEBUG "Swapping serial ports!\n");
149 /* swap serial ports */
150 memcpy(&port, &mcore->serial_ports[0], sizeof(port));
151 memcpy(&mcore->serial_ports[0], &mcore->serial_ports[1],
152 sizeof(port));
153 memcpy(&mcore->serial_ports[1], &port, sizeof(port));
154 }
155 }
08ccf572 156}
a656ffcb 157#endif
08ccf572 158
c1d1c5d4 159#ifdef CONFIG_BCM47XX_BCMA
f384b3dd
HM
160static int bcm47xx_get_sprom_bcma(struct bcma_bus *bus, struct ssb_sprom *out)
161{
162 char prefix[10];
163 struct bcma_device *core;
164
165 switch (bus->hosttype) {
166 case BCMA_HOSTTYPE_PCI:
5fe2e071 167 memset(out, 0, sizeof(struct ssb_sprom));
f384b3dd
HM
168 snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
169 bus->host_pci->bus->number + 1,
170 PCI_SLOT(bus->host_pci->devfn));
b8ebbaff 171 bcm47xx_fill_sprom(out, prefix, false);
f384b3dd
HM
172 return 0;
173 case BCMA_HOSTTYPE_SOC:
5fe2e071 174 memset(out, 0, sizeof(struct ssb_sprom));
f384b3dd
HM
175 core = bcma_find_core(bus, BCMA_CORE_80211);
176 if (core) {
177 snprintf(prefix, sizeof(prefix), "sb/%u/",
178 core->core_index);
b8ebbaff 179 bcm47xx_fill_sprom(out, prefix, true);
2c376311 180 } else {
b8ebbaff 181 bcm47xx_fill_sprom(out, NULL, false);
f384b3dd
HM
182 }
183 return 0;
184 default:
185 pr_warn("bcm47xx: unable to fill SPROM for given bustype.\n");
186 return -EINVAL;
187 }
188}
189
c1d1c5d4
HM
190static void __init bcm47xx_register_bcma(void)
191{
192 int err;
193
f384b3dd
HM
194 err = bcma_arch_register_fallback_sprom(&bcm47xx_get_sprom_bcma);
195 if (err)
196 pr_warn("bcm47xx: someone else already registered a bcma SPROM callback handler (err %d)\n", err);
197
c1d1c5d4
HM
198 err = bcma_host_soc_register(&bcm47xx_bus.bcma);
199 if (err)
ab75dc02 200 panic("Failed to initialize BCMA bus (err %d)", err);
0a2fcaa7
HM
201
202 bcm47xx_fill_bcma_boardinfo(&bcm47xx_bus.bcma.bus.boardinfo, NULL);
76b573e4
HM
203
204 /* The BCM4706 has a problem with the CPU wait instruction.
205 * When r4k_wait or r4k_wait_irqoff is used will just hang and
206 * not return from a msleep(). Removing the cpu_wait
207 * functionality is a workaround for this problem. The BCM4716
208 * does not have this problem.
209 */
210 if (bcm47xx_bus.bcma.bus.chipinfo.id == BCMA_CHIP_ID_BCM4706)
211 cpu_wait = NULL;
c1d1c5d4
HM
212}
213#endif
214
08ccf572
HM
215void __init plat_mem_setup(void)
216{
217 struct cpuinfo_mips *c = &current_cpu_data;
218
c1d1c5d4
HM
219 if (c->cputype == CPU_74K) {
220 printk(KERN_INFO "bcm47xx: using bcma bus\n");
221#ifdef CONFIG_BCM47XX_BCMA
222 bcm47xx_bus_type = BCM47XX_BUS_TYPE_BCMA;
223 bcm47xx_register_bcma();
dd573285 224 bcm47xx_set_system_type(bcm47xx_bus.bcma.bus.chipinfo.id);
c1d1c5d4
HM
225#endif
226 } else {
227 printk(KERN_INFO "bcm47xx: using ssb bus\n");
a656ffcb 228#ifdef CONFIG_BCM47XX_SSB
c1d1c5d4
HM
229 bcm47xx_bus_type = BCM47XX_BUS_TYPE_SSB;
230 bcm47xx_register_ssb();
dd573285 231 bcm47xx_set_system_type(bcm47xx_bus.ssb.chip_id);
a656ffcb 232#endif
c1d1c5d4 233 }
1690a7f9 234
1c0c13eb
AJ
235 _machine_restart = bcm47xx_machine_restart;
236 _machine_halt = bcm47xx_machine_halt;
237 pm_power_off = bcm47xx_machine_halt;
786c497a 238 bcm47xx_board_detect();
7da4b6f8 239 mips_set_machine_name(bcm47xx_board_get_name());
1c0c13eb 240}
c1d1c5d4
HM
241
242static int __init bcm47xx_register_bus_complete(void)
243{
244 switch (bcm47xx_bus_type) {
245#ifdef CONFIG_BCM47XX_SSB
246 case BCM47XX_BUS_TYPE_SSB:
247 /* Nothing to do */
248 break;
249#endif
250#ifdef CONFIG_BCM47XX_BCMA
251 case BCM47XX_BUS_TYPE_BCMA:
252 bcma_bus_register(&bcm47xx_bus.bcma.bus);
253 break;
254#endif
255 }
256 return 0;
257}
258device_initcall(bcm47xx_register_bus_complete);
This page took 0.411764 seconds and 5 git commands to generate.