86 lines
2.1 KiB
C
86 lines
2.1 KiB
C
/*
|
|
* 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);
|
|
}
|