[MIPS] Alchemy: fix off by two error in __fixup_bigphys_addr()
[linux-2.6/zen-sources.git] / arch / mips / au1000 / common / setup.c
blobd885e3848ec6c0842057341e2322cf53fcd29438
1 /*
2 * Copyright 2000 MontaVista Software Inc.
3 * Author: MontaVista Software, Inc.
4 * ppopov@mvista.com or source@mvista.com
6 * Updates to 2.6, Pete Popov, Embedded Alley Solutions, Inc.
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.
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.
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.
28 #include <linux/init.h>
29 #include <linux/sched.h>
30 #include <linux/ioport.h>
31 #include <linux/mm.h>
32 #include <linux/delay.h>
33 #include <linux/interrupt.h>
34 #include <linux/module.h>
35 #include <linux/pm.h>
37 #include <asm/cpu.h>
38 #include <asm/bootinfo.h>
39 #include <asm/irq.h>
40 #include <asm/mipsregs.h>
41 #include <asm/reboot.h>
42 #include <asm/pgtable.h>
43 #include <asm/time.h>
45 #include <au1000.h>
46 #include <prom.h>
48 extern void __init board_setup(void);
49 extern void au1000_restart(char *);
50 extern void au1000_halt(void);
51 extern void au1000_power_off(void);
52 extern void au1x_time_init(void);
53 extern void au1x_timer_setup(struct irqaction *irq);
54 extern void set_cpuspec(void);
56 void __init plat_mem_setup(void)
58 struct cpu_spec *sp;
59 char *argptr;
60 unsigned long prid, cpupll, bclk = 1;
62 set_cpuspec();
63 sp = cur_cpu_spec[0];
65 board_setup(); /* board specific setup */
67 prid = read_c0_prid();
68 cpupll = (au_readl(0xB1900060) & 0x3F) * 12;
69 printk("(PRId %08lx) @ %ldMHZ\n", prid, cpupll);
71 bclk = sp->cpu_bclk;
72 if (bclk)
74 /* Enable BCLK switching */
75 bclk = au_readl(0xB190003C);
76 au_writel(bclk | 0x60, 0xB190003C);
77 printk("BCLK switching enabled!\n");
80 if (sp->cpu_od) {
81 /* Various early Au1000 Errata corrected by this */
82 set_c0_config(1<<19); /* Set Config[OD] */
84 else {
85 /* Clear to obtain best system bus performance */
86 clear_c0_config(1<<19); /* Clear Config[OD] */
89 argptr = prom_getcmdline();
91 #ifdef CONFIG_SERIAL_8250_CONSOLE
92 if ((argptr = strstr(argptr, "console=")) == NULL) {
93 argptr = prom_getcmdline();
94 strcat(argptr, " console=ttyS0,115200");
96 #endif
98 #ifdef CONFIG_FB_AU1100
99 if ((argptr = strstr(argptr, "video=")) == NULL) {
100 argptr = prom_getcmdline();
101 /* default panel */
102 /*strcat(argptr, " video=au1100fb:panel:Sharp_320x240_16");*/
104 #endif
107 #if defined(CONFIG_SOUND_AU1X00) && !defined(CONFIG_SOC_AU1000)
108 /* au1000 does not support vra, au1500 and au1100 do */
109 strcat(argptr, " au1000_audio=vra");
110 argptr = prom_getcmdline();
111 #endif
112 _machine_restart = au1000_restart;
113 _machine_halt = au1000_halt;
114 pm_power_off = au1000_power_off;
116 /* IO/MEM resources. */
117 set_io_port_base(0);
118 ioport_resource.start = IOPORT_RESOURCE_START;
119 ioport_resource.end = IOPORT_RESOURCE_END;
120 iomem_resource.start = IOMEM_RESOURCE_START;
121 iomem_resource.end = IOMEM_RESOURCE_END;
123 while (au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_E0S);
124 au_writel(SYS_CNTRL_E0 | SYS_CNTRL_EN0, SYS_COUNTER_CNTRL);
125 au_sync();
126 while (au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_T0S);
127 au_writel(0, SYS_TOYTRIM);
130 #if defined(CONFIG_64BIT_PHYS_ADDR)
131 /* This routine should be valid for all Au1x based boards */
132 phys_t __fixup_bigphys_addr(phys_t phys_addr, phys_t size)
134 /* Don't fixup 36 bit addresses */
135 if ((phys_addr >> 32) != 0)
136 return phys_addr;
138 #ifdef CONFIG_PCI
140 u32 start = (u32)Au1500_PCI_MEM_START;
141 u32 end = (u32)Au1500_PCI_MEM_END;
143 /* Check for PCI memory window */
144 if (phys_addr >= start && (phys_addr + size - 1) <= end)
145 return (phys_t)
146 ((phys_addr - start) + Au1500_PCI_MEM_START);
148 #endif
150 /* All Au1x SOCs have a pcmcia controller */
151 /* We setup our 32 bit pseudo addresses to be equal to the
152 * 36 bit addr >> 4, to make it easier to check the address
153 * and fix it.
154 * The Au1x socket 0 phys attribute address is 0xF 4000 0000.
155 * The pseudo address we use is 0xF400 0000. Any address over
156 * 0xF400 0000 is a pcmcia pseudo address.
158 if ((phys_addr >= 0xF4000000) && (phys_addr < 0xFFFFFFFF)) {
159 return (phys_t)(phys_addr << 4);
162 /* default nop */
163 return phys_addr;
165 EXPORT_SYMBOL(__fixup_bigphys_addr);
166 #endif