37 lines
972 B
C
37 lines
972 B
C
#include <MCF5475.h>
|
|
|
|
void _startup(void)
|
|
{
|
|
asm("\n\t"
|
|
".extern _initialize_hardware\n\t"
|
|
"bra warmstart\n\t"
|
|
"jmp ___BOOT_FLASH + 8 | ist zugleich reset vector\n\t"
|
|
"| disable interrupts\n\t"
|
|
"warmstart:\n\t"
|
|
"| disable interrupts\n\t"
|
|
"move.w #0x2700,sr\n\t"
|
|
"|// Initialize MBAR\n\t"
|
|
"MOVE.L #___MBAR,D0\n\t"
|
|
"MOVEC D0,MBAR\n\t"
|
|
"MOVE.L D0,_rt_mbar\n\t"
|
|
"| mmu off\n\t"
|
|
"move.l #___MMUBAR+1,d0\n\t"
|
|
"movec d0,MMUBAR | mmubar setzen\n\t"
|
|
"clr.l d0\n\t"
|
|
"move.l d0,MCF_MMU_MMUCR\n\t | mmu off"
|
|
"|/* Initialize RAMBARs: locate SRAM and validate it */\n\t"
|
|
"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"
|
|
"| STACKPOINTER AUF ENDE SRAM1\n\t"
|
|
"lea ___SUP_SP,a7\n\t"
|
|
"| instruction cache on\n\t"
|
|
"move.l #0x000C8100,d0\n\t"
|
|
"movec d0,cacr\n\t"
|
|
"nop\n\t"
|
|
"| initialize any hardware specific issues\n\t"
|
|
"bra _initialize_hardware\n\t"
|
|
);
|
|
}
|