| /* |
| * 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/config.h> |
| #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); |
| } |