#include <config.h>#include <74xx_7xx.h>#include "version.h"#include <ppc_asm.tmpl>#include <ppc_defs.h>#include <asm/cache.h>#include <asm/mmu.h>#include "../../Marvell/include/mv_gen_reg.h"#ifdef CONFIG_ECC	/* Galileo specific asm code for initializing ECC */	.globl board_relocate_romboard_relocate_rom:	mflr	r7	/* update the location of the GT registers */	lis	r11, CFG_GT_REGS@h	/* if we're using ECC, we must use the DMA engine to copy ourselves */	bl	start_idma_transfer_0	bl	wait_for_idma_0	bl	stop_idma_engine_0	mtlr	r7	blr	.globl board_init_eccboard_init_ecc:	mflr	r7	/* NOTE: r10 still contains the location we've been relocated to	 * which happens to be TOP_OF_RAM - CFG_MONITOR_LEN */	/* now that we're running from ram, init the rest of main memory	 * for ECC use */	lis	r8, CFG_MONITOR_LEN@h	ori	r8, r8, CFG_MONITOR_LEN@l	divw	r3, r10, r8	/* set up the counter, and init the starting address */	mtctr	r3	li	r12, 0	/* bytes per transfer */	mr	r5, r8about_to_init_ecc:1:	mr	r3, r12	mr	r4, r12	bl	start_idma_transfer_0	bl	wait_for_idma_0	bl	stop_idma_engine_0	add	r12, r12, r8	bdnz	1b	mtlr	r7	blr	/* r3:	dest addr	 * r4:	source addr	 * r5:	byte count	 * r11: gt regbase	 * trashes:	 r6, r5	 */start_idma_transfer_0:	/* set the byte count, including the OWN bit */	mr	r6, r11	ori	r6, r6, CHANNEL0_DMA_BYTE_COUNT	stwbrx	r5, 0, (r6)	/* set the source address */	mr	r6, r11	ori	r6, r6, CHANNEL0_DMA_SOURCE_ADDRESS	stwbrx	r4, 0, (r6)	/* set the dest address */	mr	r6, r11	ori	r6, r6, CHANNEL0_DMA_DESTINATION_ADDRESS	stwbrx	r3, 0, (r6)	/* set the next record pointer */	li	r5, 0	mr	r6, r11	ori	r6, r6, CHANNEL0NEXT_RECORD_POINTER	stwbrx	r5, 0, (r6)	/* set the low control register */	/* bit 9 is NON chained mode, bit 31 is new style descriptors.	   bit 12 is channel enable */	ori	r5, r5, (1 << 12) | (1 << 12) | (1 << 11)	/* 15 shifted by 16 (oris) == bit 31 */	oris	r5, r5, (1 << 15)	mr	r6, r11	ori	r6, r6, CHANNEL0CONTROL	stwbrx	r5, 0, (r6)	blr	/* this waits for the bytecount to return to zero, indicating	 * that the trasfer is complete */wait_for_idma_0:	mr	r5, r11	lis	r6, 0xff	ori	r6, r6, 0xffff	ori	r5, r5, CHANNEL0_DMA_BYTE_COUNT1:	lwbrx	r4, 0, (r5)	and.	r4, r4, r6	bne	1b	blr	/* this turns off channel 0 of the idma engine */stop_idma_engine_0:	/* shut off the DMA engine */	li	r5, 0	mr	r6, r11	ori	r6, r6, CHANNEL0CONTROL	stwbrx	r5, 0, (r6)	blr#endif#ifdef CFG_BOARD_ASM_INIT	/* NOTE: trashes r3-r7 */	.globl board_asm_initboard_asm_init:	/* just move the GT registers to where they belong */	lis	r3, CFG_DFL_GT_REGS@h	ori	r3, r3, CFG_DFL_GT_REGS@l	lis	r4, CFG_GT_REGS@h	ori	r4, r4, CFG_GT_REGS@l	li	r5, INTERNAL_SPACE_DECODE	/* test to see if we've already moved */	lwbrx	r6, r5, r4	andi.	r6, r6, 0xffff	/* check loading of R7 is: 0x0F80 should: 0xf800: DONE *//*	rlwinm	r7, r4, 8, 16, 31	rlwinm	r7, r4, 12, 16, 31	*/ /* original */	rlwinm	r7, r4, 16, 16, 31	/* -----------------------------------------------------*/	cmp	cr0, r7, r6	beqlr	/* nope, have to move the registers */	lwbrx	r6, r5, r3	andis.	r6, r6, 0xffff	or	r6, r6, r7	stwbrx	r6, r5, r3	/* now, poll for the change */1:	lwbrx	r7, r5, r4	cmp	cr0, r7, r6	bne	1b	lis	r3, CFG_INT_SRAM_BASE@h	ori	r3, r3, CFG_INT_SRAM_BASE@l	rlwinm  r3, r3, 16, 16, 31	lis	r4, CFG_GT_REGS@h	ori	r4, r4, CFG_GT_REGS@l	li	r5, INTEGRATED_SRAM_BASE_ADDR	stwbrx  r3, r5, r42:	lwbrx	r6, r5, r4	cmp	cr0, r3, r6	bne	2b	/* done! */	blr#endif/* For use of the debug LEDs */	.global led_on0_relocatedled_on0_relocated:	xor	r21, r21, r21	xor	r18, r18, r18	lis	r18, 0xFC80	ori	r18, r18, 0x8000/*	stw	r21, 0x0(r18)   */	sync	blr	.global led_off0_relocatedled_off0_relocated:	xor	r21, r21, r21	xor	r18, r18, r18	lis	r18, 0xFC81	ori	r18, r18, 0x4000/*	stw	r21, 0x0(r18)   */	sync	blr	.global led_on0led_on0:	xor	r18, r18, r18	lis	r18, 0x1c80	ori	r18, r18, 0x8000/*	stw	r18, 0x0(r18)  */	sync	blr	.global led_off0led_off0:	xor	r18, r18, r18	lis	r18, 0x1c81	ori	r18, r18, 0x4000/*	stw	r18, 0x0(r18)  */	sync	blr	.global led_on1led_on1:	xor	r18, r18, r18	lis	r18, 0x1c80	ori	r18, r18, 0xc000/*	stw	r18, 0x0(r18)  */	sync	blr	.global led_off1led_off1:	xor	r18, r18, r18	lis	r18, 0x1c81	ori	r18, r18, 0x8000/*	stw	r18, 0x0(r18)  */	sync	blr	.global led_on2led_on2:	xor	r18, r18, r18	lis	r18, 0x1c81	ori	r18, r18, 0x0000/*	stw	r18, 0x0(r18)  */	sync	blr	.global led_off2led_off2:	xor	r18, r18, r18	lis	r18, 0x1c81	ori	r18, r18, 0xc000/*	stw	r18, 0x0(r18)  */	sync	blr