#include #include <74xx_7xx.h> #include "version.h" #include #include #include #include #include "../../Marvell/include/mv_gen_reg.h" #ifdef CONFIG_ECC /* Galileo specific asm code for initializing ECC */ .globl board_relocate_rom board_relocate_rom: mflr r7 /* update the location of the GT registers */ lis r11, CONFIG_SYS_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_ecc board_init_ecc: mflr r7 /* NOTE: r10 still contains the location we've been relocated to * which happens to be TOP_OF_RAM - CONFIG_SYS_MONITOR_LEN */ /* now that we're running from ram, init the rest of main memory * for ECC use */ lis r8, CONFIG_SYS_MONITOR_LEN@h ori r8, r8, CONFIG_SYS_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, r8 about_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_COUNT 1: 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 CONFIG_SYS_BOARD_ASM_INIT /* NOTE: trashes r3-r7 */ .globl board_asm_init board_asm_init: /* just move the GT registers to where they belong */ lis r3, CONFIG_SYS_DFL_GT_REGS@h ori r3, r3, CONFIG_SYS_DFL_GT_REGS@l lis r4, CONFIG_SYS_GT_REGS@h ori r4, r4, CONFIG_SYS_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, CONFIG_SYS_INT_SRAM_BASE@h ori r3, r3, CONFIG_SYS_INT_SRAM_BASE@l rlwinm r3, r3, 16, 16, 31 lis r4, CONFIG_SYS_GT_REGS@h ori r4, r4, CONFIG_SYS_GT_REGS@l li r5, INTEGRATED_SRAM_BASE_ADDR stwbrx r3, r5, r4 2: lwbrx r6, r5, r4 cmp cr0, r3, r6 bne 2b /* done! */ blr #endif /* For use of the debug LEDs */ .global led_on0_relocated led_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_relocated led_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_on0 led_on0: xor r18, r18, r18 lis r18, 0x1c80 ori r18, r18, 0x8000 /* stw r18, 0x0(r18) */ sync blr .global led_off0 led_off0: xor r18, r18, r18 lis r18, 0x1c81 ori r18, r18, 0x4000 /* stw r18, 0x0(r18) */ sync blr .global led_on1 led_on1: xor r18, r18, r18 lis r18, 0x1c80 ori r18, r18, 0xc000 /* stw r18, 0x0(r18) */ sync blr .global led_off1 led_off1: xor r18, r18, r18 lis r18, 0x1c81 ori r18, r18, 0x8000 /* stw r18, 0x0(r18) */ sync blr .global led_on2 led_on2: xor r18, r18, r18 lis r18, 0x1c81 ori r18, r18, 0x0000 /* stw r18, 0x0(r18) */ sync blr .global led_off2 led_off2: xor r18, r18, r18 lis r18, 0x1c81 ori r18, r18, 0xc000 /* stw r18, 0x0(r18) */ sync blr