2004-02-15 20:46:45 +00:00
|
|
|
/*
|
|
|
|
|
*
|
|
|
|
|
* (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
|
2004-02-21 01:51:12 +00:00
|
|
|
move.l %a2, %a0
|
2004-02-15 20:46:45 +00:00
|
|
|
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 */
|
|
|
|
|
|
|
|
|
|
jmp %a0@
|
|
|
|
|
|
|
|
|
|
/* never comes here... I hope */
|
|
|
|
|
|
|
|
|
|
unlk %fp
|
|
|
|
|
rts
|
2004-02-21 01:51:12 +00:00
|
|
|
.global end_enter_kernel
|
|
|
|
|
end_enter_kernel:
|
