/*===============================================================*\ | Project: RTEMS generic MPC5200 BSP | +-----------------------------------------------------------------+ | Partially based on the code references which are named below. | | Adaptions, modifications, enhancements and any recent parts of | | the code are: | | Copyright (c) 2005 | | Embedded Brains GmbH | | Obere Lagerstr. 30 | | D-82178 Puchheim | | Germany | | rtems@embedded-brains.de | +-----------------------------------------------------------------+ | The license and distribution terms for this file may be | | found in the file LICENSE in this distribution or at | | | | http://www.rtems.com/license/LICENSE. | | | +-----------------------------------------------------------------+ | this file contains the startup assembly code | \*===============================================================*/ /***********************************************************************/ /* */ /* Module: start.S */ /* Date: 07/17/2003 */ /* Purpose: RTEMS MPC5x00 CPU assembly startup */ /* */ /*---------------------------------------------------------------------*/ /* */ /* Description: This file contains the assembler portion of MPC5x00 */ /* startup code */ /* */ /*---------------------------------------------------------------------*/ /* */ /* Code */ /* References: startup code for Motorola PQII ADS board */ /* Module: start.S */ /* Project: RTEMS 4.6.0pre1 / MCF8260ads BSP */ /* Version 1.2 */ /* Date: 04/18/2002 */ /* */ /* Author(s) / Copyright(s): */ /* */ /* Modified for the Motorola PQII ADS board by */ /* Andy Dachs 23-11-00. */ /* Surrey Satellite Technology Limited */ /* */ /* I have a proprietary bootloader programmed into the flash */ /* on the board which initialises the SDRAM prior to calling */ /* this function. */ /* */ /* This file is based on the one by Jay Monkman (jmonkman@fracsa.com)*/ /* which in turn was based on the dlentry.s file for the Papyrus BSP,*/ /* written by: */ /* */ /* Author: Andrew Bray */ /* */ /* COPYRIGHT (c) 1995 by i-cubed ltd. */ /* */ /* To anyone who acknowledges that this file is provided "AS IS" */ /* without any express or implied warranty: */ /* permission to use, copy, modify, and distribute this file */ /* for any purpose is hereby granted without fee, provided that */ /* the above copyright notice and this notice appears in all */ /* copies, and that the name of i-cubed limited not be used in */ /* advertising or publicity pertaining to distribution of the */ /* software without specific, written prior permission. */ /* i-cubed limited makes no representations about the suitability */ /* of this software for any purpose. */ /* */ /*---------------------------------------------------------------------*/ /* */ /* Partially based on the code references which are named above. */ /* Adaptions, modifications, enhancements and any recent parts of */ /* the code are under the right of */ /* */ /* IPR Engineering, Dachauer Straße 38, D-80335 München */ /* Copyright(C) 2003 */ /* */ /*---------------------------------------------------------------------*/ /* */ /* IPR Engineering makes no representation or warranties with */ /* respect to the performance of this computer program, and */ /* specifically disclaims any responsibility for any damages, */ /* special or consequential, connected with the use of this program. */ /* */ /*---------------------------------------------------------------------*/ /* */ /* Version history: 1.0 */ /* */ /***********************************************************************/ #include #include #include /* Some register offsets of MPC5x00 memory map registers */ .set CS0STR, 0x04 .set CS0STP, 0x08 .set CS1STR, 0x0C .set CS1STP, 0x10 .set SDRAMCS0, 0x34 .set SDRAMCS1, 0x38 .set BOOTSTR, 0x4C .set BOOTSTP, 0x50 .set ADREN, 0x54 .set CSSR0, 0x58 /* Critical Interrupt SSR0 (603le only) */ .set CSSR1, 0x59 /* Critical Interrupt SSR1 (603le only) */ .set CFG, 0x20C .set CSBOOTROM, 0x300 .set CSCONTROL, 0x318 .set CS1CONF, 0x304 /* Register offsets of MPC5x00 SDRAM memory controller registers */ .set MOD, 0x100 .set CTRL, 0x104 .set CFG1, 0x108 .set CFG2, 0x10C .set ADRSEL, 0x110 .set SDELAY, 0x190 /* Register offsets of MPC5x00 GPIO registers needed */ .set GPIOPCR, 0xb00 .set GPIOWE, 0xc00 .set GPIOWOD, 0xc04 .set GPIOWDD, 0xc08 .set GPIOWDO, 0xc0c .set GPIOSEN, 0xb04 .set GPIOSDD, 0xb0c .set GPIOSDO, 0xb10 /* Register offsets of MPC5x00 Arbiter registers */ .set ARBCFG, 0x1f40 .set ARBADRTO, 0x1f58 .set ARBDATTO, 0x1f5c .set ARBMPREN, 0x1f64 .set ARBMPRIO, 0x1f68 .set ARBSNOOP, 0x1f70 /* Some bit encodings for MGT5100 registers */ .set ADREN_BOOT_EN, (1 << (31 - 6)) .set ADREN_CS0_EN, (1 << (31 - 15)) .set ADREN_CS1_EN, (1 << (31 - 14)) .set ADREN_WSE, (1 << (31 - 31)) .set CTRL_PRECHARGE_ALL, (1 << (31 - 30)) .set CTRL_REFRESH, (1 << (31 - 29)) .set CTRL_MODE_EN, (1 << (31 - 0)) .set CSCONF_CE, (1<<12) /* Some fixed values for MPC5x00 registers */ .set CSCONTROL_VAL, 0x91000000 /* * The DDR_MODE bit is a read-only status and should be written as 0. * * XLB_CLK = FVCO / 4 * IPB_CLK = XLB_CLK / 2 * PCI_CLK = IPB_CLK */ .set CFG_VAL, 0x00000100 .extern boot_card .section ".vectors", "ax" bl start .rep 63 .long 0x04000400 .endr __vec2: b __vec2 .rep 63 .long 0x04000400 .endr __vec3: b __vec3 .rep 63 .long 0x04000400 .endr __vec4: b __vec4 .rep 63 .long 0x04000400 .endr __vec5: b __vec5 .rep 63 .long 0x04000400 .endr __vec6: b __vec6 .rep 63 .long 0x04000400 .endr __vec7: b __vec7 .rep 63 .long 0x04000400 .endr __vec8: b __vec8 .rep 63 .long 0x04000400 .endr __vec9: b __vec9 .rep 63 .long 0x04000400 .endr __veca: b __veca .rep 63 .long 0x04000400 .endr __vecb: b __vecb .rep 63 .long 0x04000400 .endr __vecc: b __vecc .rep 63 .long 0x04000400 .endr __vecd: b __vecd .rep 63 .long 0x04000400 .endr __vece: b __vece .rep 63 .long 0x04000400 .endr __vecf: b __vecf .rep 63+1024 .long 0x04000400 .endr .section ".entry" PUBLIC_VAR (start) start: /* 1st: initialization work (common for RAM/ROM startup) */ mfmsr r30 SETBITS r30, r29, MSR_ME|MSR_RI CLRBITS r30, r29, MSR_EE mtmsr r30 /* Set RI/ME, Clr EE in MSR */ #ifdef HAS_UBOOT mr r14, r3 #endif /* HAS_UBOOT */ #if defined(NEED_LOW_LEVEL_INIT) /* initialize the MBAR (common RAM/ROM startup) */ LWI r31, MBAR_RESET LWI r29, MBAR rlwinm r30, r29,16,16,31 stw r30, 0(r31) /* Set the MBAR */ #endif LWI r31, MBAR /* set r31 to current MBAR */ /* init GPIOPCR */ lwz r29,GPIOPCR(r31) LWI r30, BSP_GPIOPCR_INITMASK not r30,r30 and r29,r29,r30 LWI r30, BSP_GPIOPCR_INITVAL or r29,r29,r30 stw r29, GPIOPCR(r31) /* further initialization work (common RAM/ROM startup) */ bl TLB_init /* Initialize TLBs */ bl FID_DCache /* Flush, inhibit and disable data cache */ bl IDUL_ICache /* Inhibit, disable and unlock instruction cache */ bl FPU_init /* Initialize FPU */ #if defined(NEED_LOW_LEVEL_INIT) bl SPRG_init /* Initialize special purpose registers */ #endif #if defined(NEED_LOW_LEVEL_INIT) /* detect RAM/ROM startup (common for RAM/ROM startup) */ LWI r20, bsp_rom_start /* set the relocation offset */ LWI r30, CFG_VAL /* get CFG register content */ lwz r30, CFG(r31) /* set CFG register */ lwz r30, ADREN(r31) /* get content of ADREN */ TSTBITS r30, r29, ADREN_BOOT_EN bne skip_ROM_start /* If BOOT_ROM is not enabled, skip further initialization */ /* do some board dependent configuration (unique for ROM startup) */ LWI r30, CSCONTROL_VAL /* get CSCONTROL register content */ stw r30, CSCONTROL(r31) /* enable internal/external bus error and master for CS */ #if defined(MPC5200_BOARD_BRS5L) #define CSBOOTROM_VAL 0x0101D910 #elif defined(MPC5200_BOARD_BRS6L) #define CSBOOTROM_VAL 0x0202D910 #endif #ifdef CSBOOTROM_VAL LWI r30, CSBOOTROM_VAL stw r30, CSBOOTROM(r31) /* Set CSBOOTROM */ #endif /* FIXME: map BOOT ROM into final location with CS0 registers */ LWI r30, bsp_rom_start rlwinm r30, r30,17,15,31 stw r30, CS0STR(r31) /* Set CS0STR */ LWI r30, bsp_rom_end - 1 rlwinm r30, r30,17,15,31 stw r30, CS0STP(r31) /* Set CS0STP */ lwz r30, ADREN(r31) /* get content of ADREN */ SETBITS r30, r29, ADREN_CS0_EN stw r30, ADREN(r31) /* enable CS0 mapping */ isync /* jump to same code in final BOOT ROM location */ LWI r30, reloc_in_CS0 LWI r29, bsp_ram_start sub r30,r30,r29 LWI r29, bsp_rom_start add r30,r30,r29 mtctr r30 bctr reloc_in_CS0: /* disable CSBOOT (or map it to CS0 range) */ lwz r30, ADREN(r31) /* get content of ADREN */ CLRBITS r30, r29, ADREN_BOOT_EN stw r30, ADREN(r31) /* disable BOOT mapping */ /* init SDRAM */ LWI r30, bsp_ram_start ori r30, r30, 0x1a /* size code: bank is 128MByte */ stw r30, SDRAMCS0(r31) /* Set SDRAMCS0 */ LWI r30, bsp_ram_size srawi r30, r30, 1 ori r30, r30, 0x1a /* size code: bank is 128MByte */ stw r30, SDRAMCS1(r31) /* Set SDRAMCS1 */ bl SDRAM_init /* Initialize SDRAM controller */ bl XLB_init /* copy .text section from ROM to RAM location (unique for ROM startup) */ LA r30, bsp_section_text_start /* get start address of text section in RAM */ add r30, r20, r30 /* get start address of text section in ROM (add reloc offset) */ LA r29, bsp_section_text_start /* get start address of text section in RAM */ LA r28, bsp_section_text_size /* get size of RAM image */ bl copy_image /* copy text section from ROM to RAM location */ /* copy .data section from ROM to RAM location (unique for ROM startup) */ LA r30, bsp_section_data_start /* get start address of data section in RAM */ add r30, r20, r30 /* get start address of data section in ROM (add reloc offset) */ LA r29, bsp_section_data_start /* get start address of data section in RAM */ LA r28, bsp_section_data_size /* get size of RAM image */ bl copy_image /* copy initialized data section from ROM to RAM location */ LA r29, remap_rom /* get compile time address of label */ mtlr r29 blrl /* now further execution RAM */ remap_rom: /* remap BOOT ROM to CS0 (common for RAM/ROM startup) */ lwz r30, CSBOOTROM(r31) /* get content of CSBOOTROM */ CLRBITS r30, r29, CSCONF_CE stw r30, CSBOOTROM(r31) /* disable BOOT CS */ lwz r30, ADREN(r31) /* get content of ADREN */ mr r29, r30 /* move content of r30 to r29 */ LWI r30, ADREN_BOOT_EN /* mask ADREN_BOOT_EN */ andc r29,r29,r30 LWI r30, ADREN_CS0_EN /* unmask ADREN_CS0_EN */ or r29,r29,r30 stw r29,ADREN(r31) /* Simultaneous enable CS0 and disable BOOT address space */ lwz r30, CSBOOTROM(r31) /* get content of CSBOOTROM */ SETBITS r30, r29, CSCONF_CE stw r30, CSBOOTROM(r31) /* disable BOOT CS */ skip_ROM_start: /* configure external DPRAM CS1 */ LWI r30, 0xFFFFFB10 stw r30, CS1CONF(r31) /* map external DPRAM (CS1) */ LWI r30, bsp_dpram_start srawi r30, r30, 16 stw r30, CS1STR(r31) LWI r30, bsp_dpram_end srawi r30, r30, 16 stw r30, CS1STP(r31) lwz r30, ADREN(r31) /* get content of ADREN */ LWI r29, ADREN_CS1_EN /* unmask ADREN_CS1_EN */ or r30, r30,r29 stw r30, ADREN(r31) /* enable CS1 */ /* clear entire on chip SRAM (unique for ROM startup) */ lis r30, (MBAR+ONCHIP_SRAM_OFFSET)@h /* get start address of onchip SRAM */ ori r30, r30,(MBAR+ONCHIP_SRAM_OFFSET)@l LWI r29, ONCHIP_SRAM_SIZE /* get size of onchip SRAM */ bl clr_mem /* Clear onchip SRAM */ #else /* defined(NEED_LOW_LEVEL_INIT) */ bl XLB_init #endif /* defined(NEED_LOW_LEVEL_INIT) */ /* clear .bss section (unique for ROM startup) */ LWI r30, bsp_section_bss_start /* get start address of bss section */ LWI r29, bsp_section_bss_size /* get size of bss section */ bl clr_mem /* Clear the bss section */ #ifdef HAS_UBOOT mr r3, r14 bl bsp_uboot_copy_board_info #endif /* HAS_UBOOT */ /* set stack pointer (common for RAM/ROM startup) */ LA r1, bsp_section_text_start addi r1, r1, -0x10 /* Set up stack pointer = beginning of text section - 0x10 */ /* tag TOS with a NULL pointer (termination mark for stack dump) */ li r0, 0 stw r0, 0(r1) bl __eabi /* Set up EABI and SYSV environment */ /* enable dynamic power management(common for RAM/ROM startup) */ bl PPC_HID0_rd /* Get the content of HID0 */ SETBITS r30, r29, HID0_DPM bl PPC_HID0_wr /* Set DPM in HID0 */ /* clear arguments and do further init. in C (common for RAM/ROM startup) */ /* Clear cmdline */ xor r3, r3, r3 bl SYM (boot_card) /* Call the first C routine */ twiddle: b twiddle /* We don't expect to return from boot_card but if we do */ /* wait here for watchdog to kick us into hard reset */ #if defined(NEED_LOW_LEVEL_INIT) SDRAM_init: mflr r12 #if defined(MPC5200_BOARD_BRS5L) /* set GPIO_WKUP7 pin low for 66MHz buffering */ /* or high for 133MHz registered buffering */ LWI r30, 0x80000000 lwz r29, GPIOWE(r31) or r29,r29,r30 /* set bit 0 in r29/GPIOWE */ stw r29,GPIOWE(r31) lwz r29, GPIOWOD(r31) andc r29,r29,r30 /* clear bit 0 in r29/GPIOWOD */ stw r29,GPIOWOD(r31) lwz r29, GPIOWDO(r31) andc r29,r29,r30 /* clear bit 0 in r29/GPIOWDO */ stw r29,GPIOWDO(r31) lwz r29, GPIOWDD(r31) or r29,r29,r30 /* set bit 0 in r29/GPIOWDD */ stw r29,GPIOWDD(r31) /* activate MEM_CS1 output */ lwz r29, GPIOPCR(r31) or r29,r29,r30 /* set bit 0 in r29/GPIOPCR */ stw r29,GPIOPCR(r31) #endif #define SDELAY_VAL 0x00000004 #if defined(MPC5200_BOARD_BRS6L) #define CFG1_VAL 0x73722930 #else /* * Single Read2Read/Write delay=0xC, Single Write2Read/Prec. delay=0x4 * Read CAS latency=0x2, Active2Read delay=0x2, Prec.2active delay=0x2 */ #define CFG1_VAL 0xC4222600 #endif #if defined(MPC5200_BOARD_BRS6L) #define CFG2_VAL 0x47770000 #else /* Refr.2No-Read delay=0x06, Write latency=0x0 */ /* Burst2Read Prec.delay=0x8, Burst Write delay=0x8 */ /* Burst Read2Write delay=0xB, Burst length=0x7, Read Tap=0x4 */ #define CFG2_VAL 0xCCC70004 #endif #if defined(MPC5200_BOARD_BRS5L) /* Mode Set enabled, Clock enabled, Auto refresh enabled, Mem. data drv */ /* Refresh counter=0xFFFF */ #define CTRL_VAL 0xD1470000 #elif defined(MPC5200_BOARD_BRS6L) #define CTRL_VAL 0xF15F0F00 #else /* Mode Set enabled, Clock enabled, Auto refresh enabled, Mem. data drv */ /* Refresh counter=0xFFFF */ #define CTRL_VAL 0xD04F0000 #endif #if defined(MPC5200_BOARD_BRS6L) /* Enable DLL, normal drive strength */ #define EMODE_VAL 0x40010000 #endif #if defined(MPC5200_BOARD_BRS6L) /* Burst length = 8, burst type sequential, CAS latency 2.5, normal operation/reset DLL */ #define MODE_VAL 0x058D0000 #else /* Op.Mode=0x0, Read CAS latency=0x2, Burst length=0x3, Write strobe puls */ #define MODE_VAL 0x008D0000 #endif #if defined(MPC5200_BOARD_BRS6L) /* Burst length = 8, burst type sequential, CAS latency 2.5, normal operation */ #define SECOND_MODE_VAL (MODE_VAL & ~0x04000000) #endif /* SDRAM initialization according to application note AN3221 */ /* SDRAM controller setup */ LWI r3, SDELAY_VAL stw r3, SDELAY(r31) LWI r3, CFG1_VAL stw r3, CFG1(r31) LWI r3, CFG2_VAL stw r3, CFG2(r31) LWI r11, CTRL_VAL stw r11, CTRL(r31) lwz r3, CTRL(r31) /* Perform a PRECHARGE ALL command */ ori r3, r11, CTRL_PRECHARGE_ALL stw r3, CTRL(r31) lwz r3, CTRL(r31) /* Wait at least tRP time */ li r3, 15 bl ndelay #if defined(EMODE_VAL) /* Write EMODE register */ LWI r3, EMODE_VAL stw r3, MOD(r31) /* Wait at least tMRD time */ li r3, 10 bl ndelay #endif /* Write MODE register */ LWI r3, MODE_VAL stw r3, MOD(r31) /* Wait at least tMRD time */ li r3, 10 bl ndelay /* Perform a PRECHARGE ALL command */ ori r3, r11, CTRL_PRECHARGE_ALL stw r3, CTRL(r31) lwz r3, CTRL(r31) /* Wait at least tRP time */ li r3, 15 bl ndelay /* Perform an AUTO REFRESH */ ori r3, r11, CTRL_REFRESH stw r3, CTRL(r31) lwz r3, CTRL(r31) /* Wait at least tRFC time */ li r3, 70 bl ndelay /* Perform an AUTO REFRESH */ ori r3, r11, CTRL_REFRESH stw r3, CTRL(r31) lwz r3, CTRL(r31) /* Wait at least tRFC time */ li r3, 70 bl ndelay #if defined(SECOND_MODE_VAL) /* Write MODE register */ LWI r3, SECOND_MODE_VAL stw r3, MOD(r31) #endif /* Disable MODE register access */ lis r4, CTRL_MODE_EN@h andc r3, r11, r4 stw r3, CTRL(r31) lwz r3, CTRL(r31) mtlr r12 blr copy_image: mr r27, r28 srwi r28, r28, 2 mtctr r28 slwi r28, r28, 2 sub r27, r27, r28 /* maybe some residual bytes */ copy_image_word: lswi r28, r30, 0x04 stswi r28, r29, 0x04 /* do word copy ROM -> RAM */ addi r30, r30, 0x04 /* increment source pointer */ addi r29, r29, 0x04 /* increment destination pointer */ bdnz copy_image_word /* decrement ctr and branch if not 0 */ cmpwi r27, 0x00 /* copy image finished ? */ beq copy_image_end; mtctr r27 /* reload counter for residual bytes */ copy_image_byte: lswi r28, r30, 0x01 stswi r28, r29, 0x01 /* do byte copy ROM -> RAM */ addi r30, r30, 0x01 /* increment source pointer */ addi r29, r29, 0x01 /* increment destination pointer */ bdnz copy_image_byte /* decrement ctr and branch if not 0 */ copy_image_end: blr #endif /* defined(NEED_LOW_LEVEL_INIT) */ FID_DCache: mflr r26 bl PPC_HID0_rd TSTBITS r30, r29, HID0_DCE bne FID_DCache_exit /* If data cache is switched of, skip further actions */ li r29, PPC_D_CACHE /* 16 Kb data cache on 603e */ LWI r28, bsp_section_text_start /* Load base address (begin of RAM) */ FID_DCache_loop_1: lwz r27, 0(r28) /* Load data at address */ addi r28, r28, PPC_CACHE_ALIGNMENT /* increment cache line address */ subi r29, r29, PPC_CACHE_ALIGNMENT /* increment loop counter */ cmpwi r29, 0x0 bne FID_DCache_loop_1 /* Loop until cache size is reached */ li r29, PPC_D_CACHE /* 16 Kb data cache on 603e */ LWI r28, bsp_section_text_start /* Reload base address (begin of RAM) */ xor r27, r27, r27 FID_DCache_loop_2: dcbf r27, r28 /* Flush and invalidate cache */ addi r28, r28, PPC_CACHE_ALIGNMENT /* increment cache line address */ subi r29, r29, PPC_CACHE_ALIGNMENT /* increment loop counter */ cmpwi r29, 0x0 bne FID_DCache_loop_2 /* Loop around until cache size is reached */ bl PPC_HID0_rd /* Read HID0 */ CLRBITS r30, r29, HID0_DCE bl PPC_HID0_wr /* Clear DCE */ FID_DCache_exit: mtlr r26 blr IDUL_ICache: mflr r26 bl PPC_HID0_rd TSTBITS r30, r29, HID0_ICE bne IDUL_ICache_exit /* If instruction cache is switched of, skip further actions */ CLRBITS r30, r29, HID0_ICE bl PPC_HID0_wr /* Disable ICE bit */ SETBITS r30, r29, HID0_ICFI bl PPC_HID0_wr /* Invalidate instruction cache */ CLRBITS r30, r29, HID0_ICFI bl PPC_HID0_wr /* Disable cache invalidate */ CLRBITS r30, r29, HID0_ILOCK bl PPC_HID0_wr /* Disable instruction cache lock */ IDUL_ICache_exit: mtlr r26 blr TLB_init: /* Initialize translation lookaside buffers (TLBs) */ xor r30, r30, r30 xor r29, r29, r29 TLB_init_loop: tlbie r29 tlbsync addi r29, r29, 0x1000 addi r30, r30, 0x01 cmpli 0, 0, r30, 0x0080 bne TLB_init_loop blr FPU_init: mfmsr r30 /* get content of MSR */ SETBITS r30, r29, MSR_FP mtmsr r30 /* enable FPU and FPU exceptions */ sync lfd f0, 0(r29) fmr f1, f0 fmr f2, f0 fmr f3, f0 fmr f4, f0 fmr f5, f0 fmr f6, f0 fmr f7, f0 fmr f8, f0 fmr f9, f0 fmr f10, f0 fmr f11, f0 fmr f12, f0 fmr f13, f0 fmr f14, f0 fmr f15, f0 fmr f16, f0 fmr f17, f0 fmr f18, f0 fmr f19, f0 fmr f20, f0 fmr f21, f0 fmr f22, f0 fmr f23, f0 fmr f24, f0 fmr f25, f0 fmr f26, f0 fmr f27, f0 fmr f28, f0 fmr f29, f0 fmr f30, f0 fmr f31, f0 mtfsfi 0, 0 /* initialize bit positons in FPSCR */ mtfsfi 1, 0 mtfsfi 2, 0 mtfsfi 3, 0 mtfsfi 4, 0 mtfsfi 5, 0 mtfsfi 6, 0 mtfsfi 7, 0 blr SPRG_init: /* initialize registers */ xor r30, r30, r30 mtspr PPC_XER, r30 mtspr PPC_CTR, r30 mtspr DSISR, r30 mtspr PPC_DAR, r30 mtspr PPC_DEC, r30 mtspr SDR1, r30 mtspr SRR0, r30 mtspr SRR1, r30 mtspr CSSR0, r30 mtspr CSSR1, r30 mtspr SPRG0, r30 mtspr SPRG1, r30 mtspr SPRG2, r30 mtspr SPRG3, r30 mtspr SPRG4, r30 mtspr SPRG5, r30 mtspr SPRG6, r30 mtspr SPRG7, r30 mtspr PPC_EAR, r30 mtspr TBWU, r30 mtspr TBWL, r30 mtspr IBAT0U, r30 mtspr IBAT0L, r30 mtspr IBAT1U, r30 mtspr IBAT1L, r30 mtspr IBAT2U, r30 mtspr IBAT2L, r30 mtspr IBAT3U, r30 mtspr IBAT3L, r30 mtspr IBAT4U, r30 mtspr IBAT4L, r30 mtspr IBAT5U, r30 mtspr IBAT5L, r30 mtspr IBAT6U, r30 mtspr IBAT6L, r30 mtspr IBAT7U, r30 mtspr IBAT7L, r30 mtspr DBAT0U, r30 mtspr DBAT0L, r30 mtspr DBAT1U, r30 mtspr DBAT1L, r30 mtspr DBAT2U, r30 mtspr DBAT2L, r30 mtspr DBAT3U, r30 mtspr DBAT3L, r30 mtspr DBAT4U, r30 mtspr DBAT4L, r30 mtspr DBAT5U, r30 mtspr DBAT5L, r30 mtspr DBAT6U, r30 mtspr DBAT6L, r30 mtspr DBAT7U, r30 mtspr DBAT7L, r30 mtspr DMISS, r30 mtspr DCMP, r30 mtspr HASH1, r30 mtspr HASH2, r30 mtspr IMISS, r30 mtspr ICMP, r30 mtspr PPC_RPA, r30 mtsr PPC_SR0, r30 mtsr PPC_SR1, r30 mtsr PPC_SR2, r30 mtsr PPC_SR3, r30 mtsr PPC_SR4, r30 mtsr PPC_SR5, r30 mtsr PPC_SR6, r30 mtsr PPC_SR7, r30 mtsr PPC_SR8, r30 mtsr PPC_SR9, r30 mtsr PPC_SR10, r30 mtsr PPC_SR12, r30 mtsr PPC_SR13, r30 mtsr PPC_SR14, r30 mtsr PPC_SR15, r30 blr PPC_HID0_rd: /* get HID0 content to r30 */ mfspr r30, HID0 blr PPC_HID0_wr: /* put r30 content to HID0 */ mtspr HID0, r30 blr clr_mem: mr r28, r29 srwi r29, r29, 2 mtctr r29 /* set ctr reg */ slwi r29, r29, 2 sub r28, r28, r29 /* maybe some residual bytes */ xor r29, r29, r29 clr_mem_word: stswi r29, r30, 0x04 /* store r29 (word) to r30 memory location */ addi r30, r30, 0x04 /* increment r30 */ bdnz clr_mem_word /* dec counter and loop */ cmpwi r28, 0x00 /* clear mem. finished ? */ beq clr_mem_end; mtctr r28 /* reload counter for residual bytes */ clr_mem_byte: stswi r29, r30, 0x01 /* store r29 (byte) to r30 memory location */ addi r30, r30, 0x01 /* update r30 */ bdnz clr_mem_byte /* dec counter and loop */ clr_mem_end: blr /* return */ XLB_init: /* init arbiter and stuff... */ LWI r30, 0x8000a06e stw r30, ARBCFG(r31) /* Set ARBCFG */ LWI r30, 0x000000ff stw r30, ARBMPREN(r31) /* Set ARBMPREN */ LWI r30, 0x00001234 stw r30, ARBMPRIO(r31) /* Set ARBPRIO */ LWI r30, 0x0000001e stw r30, ARBSNOOP(r31) /* Set ARBSNOOP */ LWI r30, 4096 stw r30, ARBADRTO(r31) /* Set ARBADRTO */ stw r30, ARBDATTO(r31) /* Set ARBDATTO */ blr ndelay: /* * The maximum core frequency is 396MHz. * We have (396MHz * 1024) / 10**9 == 405. */ mulli r3, r3, 405 srwi. r3, r3, 10 beqlr mtctr r3 ndelay_loop: bdnz ndelay_loop blr