55 lines
1.3 KiB
C
55 lines
1.3 KiB
C
#include <MCF5475.h>
|
|
|
|
void startup(void)
|
|
{
|
|
__asm__ __volatile__(
|
|
" .extern _initialize_hardware\n\t"
|
|
|
|
" bra.s warmstart\n\t"
|
|
" jmp ___BOOT_FLASH + 8\n\t" /* that's also our reset vector */
|
|
|
|
/* disable interrupts */
|
|
"warmstart:\n\t"
|
|
" move.w #0x2700,sr\n\t"
|
|
/* output */ :
|
|
/* input */ :
|
|
/* clobber */ : "d0", "memory");
|
|
|
|
/* Initialize MBAR */
|
|
__asm__ __volatile__(
|
|
" MOVE.L #__MBAR,D0\n\t"
|
|
" MOVEC D0,MBAR\n\t"
|
|
" MOVE.L D0,_rt_mbar\n\t"
|
|
/* output */ :
|
|
/* input */ :
|
|
/* clobber */ : "d0", "memory");
|
|
|
|
/* mmu off */
|
|
__asm__ __volatile__(
|
|
" move.l #__MMUBAR+1,d0\n\t"
|
|
" movec d0,MMUBAR\n\t"
|
|
/* output */ :
|
|
/* input */ :
|
|
/* clobber */ : "d0", "memory");
|
|
|
|
MCF_MMU_MMUCR = 0L; /* MMU off */
|
|
|
|
__asm__ __volatile__(
|
|
/* Initialize RAMBARs: locate SRAM and validate it */
|
|
" move.l #__RAMBAR0 + 0x7,d0\n\t" /* supervisor only */
|
|
" movec d0,RAMBAR0\n\t"
|
|
" move.l #__RAMBAR1 + 0x1,d0\n\t"
|
|
" movec d0,RAMBAR1\n\t"
|
|
/* set stack pointer to end of SRAM1 */
|
|
" lea __SUP_SP,a7\n\t"
|
|
/* instruction cache on */
|
|
" move.l #0x000C8100,d0\n\t"
|
|
" movec d0,cacr\n\t"
|
|
" nop\n\t"
|
|
/* initialize any hardware specific issues */
|
|
" bra _initialize_hardware\n\t"
|
|
/* output */ :
|
|
/* input */ :
|
|
/* clobber */ : "d0", "memory");
|
|
}
|