/*
 * 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);
}