EMILE/second/enter_kernel.S
2004-02-15 20:46:45 +00:00

59 lines
763 B
ArmAsm

/*
*
* (c) 2004 Laurent Vivier <LaurentVivier@wanadoo.fr>
*
*/
.global enter_kernel
enter_kernel:
link.w %fp,#-8
/* get physical start address of kernel */
move.l 8(%fp), %a0
/* size of image to relocate */
move.l 12(%fp), %d0
/* disable interrupts */
ori.w #0x0700,%sr
/* disable MMU */
lea -8(%fp), %a1
pmove %tc, %a1@
bclr #7, %a1@
pmove %a1@, %tc
clr.l %a1@
pmove %a1@, %tt0
pmove %a1@, %tt1
/* copy kernel to 0x1000 */
move.l %a0, %a1
move.l #0x1000, %a2
move.l %d0, %d1
copy_loop:
move.b (%a1)+, (%a2)+
subq.l #1, %d1
bge.s copy_loop
/* disable and flush caches */
lea 0x0808, %a1
movec %a1, %cacr
/* jump into kernel */
move.l #0x1000, %a0
jmp %a0@
/* never comes here... I hope */
unlk %fp
rts