| /* | |
| * Relocate bridge's register base and call board specific routine. | |
| * | |
| * Author: Mark A. Greer <source@mvista.com> | |
| * | |
| * 2005 (c) MontaVista Software, Inc. This file is licensed under | |
| * the terms of the GNU General Public License version 2. This program | |
| * is licensed "as is" without any warranty of any kind, whether express | |
| * or implied. | |
| */ | |
| #include <linux/types.h> | |
| #include <asm/io.h> | |
| #include <asm/mv64x60_defs.h> | |
| extern struct bi_record *decompress_kernel(unsigned long load_addr, | |
| int num_words, unsigned long cksum); | |
| u32 size_reg[MV64x60_CPU2MEM_WINDOWS] = { | |
| MV64x60_CPU2MEM_0_SIZE, MV64x60_CPU2MEM_1_SIZE, | |
| MV64x60_CPU2MEM_2_SIZE, MV64x60_CPU2MEM_3_SIZE | |
| }; | |
| /* Read mem ctlr to get the amount of mem in system */ | |
| unsigned long | |
| mv64360_get_mem_size(void) | |
| { | |
| u32 enables, i, v; | |
| u32 mem = 0; | |
| enables = in_le32((void __iomem *)CONFIG_MV64X60_NEW_BASE + | |
| MV64360_CPU_BAR_ENABLE) & 0xf; | |
| for (i=0; i<MV64x60_CPU2MEM_WINDOWS; i++) | |
| if (!(enables & (1<<i))) { | |
| v = in_le32((void __iomem *)CONFIG_MV64X60_NEW_BASE | |
| + size_reg[i]) & 0xffff; | |
| v = (v + 1) << 16; | |
| mem += v; | |
| } | |
| return mem; | |
| } | |
| void | |
| mv64x60_move_base(void __iomem *old_base, void __iomem *new_base) | |
| { | |
| u32 bits, mask, b; | |
| if (old_base != new_base) { | |
| #ifdef CONFIG_GT64260 | |
| bits = 12; | |
| mask = 0x07000000; | |
| #else /* Must be mv64[34]60 */ | |
| bits = 16; | |
| mask = 0x03000000; | |
| #endif | |
| b = in_le32(old_base + MV64x60_INTERNAL_SPACE_DECODE); | |
| b &= mask; | |
| b |= ((u32)new_base >> (32 - bits)); | |
| out_le32(old_base + MV64x60_INTERNAL_SPACE_DECODE, b); | |
| __asm__ __volatile__("sync"); | |
| /* Wait for change to happen (in accordance with the manual) */ | |
| while (in_le32(new_base + MV64x60_INTERNAL_SPACE_DECODE) != b); | |
| } | |
| } | |
| void __attribute__ ((weak)) | |
| mv64x60_board_init(void __iomem *old_base, void __iomem *new_base) | |
| { | |
| } | |
| void * | |
| load_kernel(unsigned long load_addr, int num_words, unsigned long cksum, | |
| void *ign1, void *ign2) | |
| { | |
| mv64x60_move_base((void __iomem *)CONFIG_MV64X60_BASE, | |
| (void __iomem *)CONFIG_MV64X60_NEW_BASE); | |
| mv64x60_board_init((void __iomem *)CONFIG_MV64X60_BASE, | |
| (void __iomem *)CONFIG_MV64X60_NEW_BASE); | |
| return decompress_kernel(load_addr, num_words, cksum); | |
| } |