258d4599fadc5b294322f9d3f11dcea4d3c7bff3
[pandora-kernel.git] / arch / ppc / boot / simple / misc-mv64x60.c
1 /*
2  * arch/ppc/boot/simple/misc-mv64x60.c
3  *
4  * Relocate bridge's register base and call board specific routine.
5  *
6  * Author: Mark A. Greer <source@mvista.com>
7  *
8  * 2005 (c) MontaVista Software, Inc. This file is licensed under
9  * the terms of the GNU General Public License version 2. This program
10  * is licensed "as is" without any warranty of any kind, whether express
11  * or implied.
12  */
13
14 #include <linux/config.h>
15 #include <linux/types.h>
16 #include <asm/io.h>
17 #include <asm/mv64x60_defs.h>
18
19 extern struct bi_record *decompress_kernel(unsigned long load_addr,
20         int num_words, unsigned long cksum);
21
22
23 u32 size_reg[MV64x60_CPU2MEM_WINDOWS] = {
24         MV64x60_CPU2MEM_0_SIZE, MV64x60_CPU2MEM_1_SIZE,
25         MV64x60_CPU2MEM_2_SIZE, MV64x60_CPU2MEM_3_SIZE
26 };
27
28 /* Read mem ctlr to get the amount of mem in system */
29 unsigned long
30 mv64360_get_mem_size(void)
31 {
32         u32     enables, i, v;
33         u32     mem = 0;
34
35         enables = in_le32((void __iomem *)CONFIG_MV64X60_NEW_BASE +
36                 MV64360_CPU_BAR_ENABLE) & 0xf;
37
38         for (i=0; i<MV64x60_CPU2MEM_WINDOWS; i++)
39                 if (!(enables & (1<<i))) {
40                         v = in_le32((void __iomem *)CONFIG_MV64X60_NEW_BASE
41                                 + size_reg[i]) & 0xffff;
42                         v = (v + 1) << 16;
43                         mem += v;
44                 }
45
46         return mem;
47 }
48
49 void
50 mv64x60_move_base(void __iomem *old_base, void __iomem *new_base)
51 {
52         u32     bits, mask, b;
53
54         if (old_base != new_base) {
55 #ifdef CONFIG_GT64260
56                 bits = 12;
57                 mask = 0x07000000;
58 #else /* Must be mv64[34]60 */
59                 bits = 16;
60                 mask = 0x03000000;
61 #endif
62                 b = in_le32(old_base + MV64x60_INTERNAL_SPACE_DECODE);
63                 b &= mask;
64                 b |= ((u32)new_base >> (32 - bits));
65                 out_le32(old_base + MV64x60_INTERNAL_SPACE_DECODE, b);
66
67                 __asm__ __volatile__("sync");
68
69                 /* Wait for change to happen (in accordance with the manual) */
70                 while (in_le32(new_base + MV64x60_INTERNAL_SPACE_DECODE) != b);
71         }
72 }
73
74 void __attribute__ ((weak))
75 mv64x60_board_init(void __iomem *old_base, void __iomem *new_base)
76 {
77 }
78
79 void *
80 load_kernel(unsigned long load_addr, int num_words, unsigned long cksum,
81                 void *ign1, void *ign2)
82 {
83         mv64x60_move_base((void __iomem *)CONFIG_MV64X60_BASE,
84                 (void __iomem *)CONFIG_MV64X60_NEW_BASE);
85         mv64x60_board_init((void __iomem *)CONFIG_MV64X60_BASE,
86                 (void __iomem *)CONFIG_MV64X60_NEW_BASE);
87         return decompress_kernel(load_addr, num_words, cksum);
88 }