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