42 lines
1.2 KiB
C
42 lines
1.2 KiB
C
#include <MCF5475.h>
|
|
|
|
void startup(void)
|
|
{
|
|
__asm__ __volatile__ ("\n\t"
|
|
".extern _initialize_hardware\n\t"
|
|
"bra.s 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"
|
|
: : : "memory");
|
|
|
|
/* Initialize MBAR */
|
|
__asm__ __volatile__ ("MOVE.L #__MBAR,D0\n\t" : : : "memory");
|
|
__asm__ __volatile__ ("MOVEC D0,MBAR\n\t" : : : "memory");
|
|
__asm__ __volatile__ ("MOVE.L D0,_rt_mbar\n\t" : : : "memory");
|
|
|
|
/* mmu off */
|
|
__asm__ __volatile__ ("move.l #__MMUBAR+1,d0\n\t" : : : "memory");
|
|
__asm__ __volatile__ ("movec d0,MMUBAR" : : : "memory"); /* set mmubar */
|
|
|
|
MCF_MMU_MMUCR = 0L; /* MMU off */
|
|
|
|
__asm__ __volatile__ (
|
|
"|/* 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"
|
|
: : : "memory");
|
|
}
|