2004-02-15 20:46:45 +00:00
|
|
|
/*
|
|
|
|
|
*
|
|
|
|
|
* (c) 2004 Laurent Vivier <LaurentVivier@wanadoo.fr>
|
|
|
|
|
*
|
|
|
|
|
*/
|
|
|
|
|
|
2004-03-04 22:50:11 +00:00
|
|
|
.global enter_kernel040
|
|
|
|
|
enter_kernel040:
|
|
|
|
|
link.w %fp,#0
|
2004-02-15 20:46:45 +00:00
|
|
|
|
|
|
|
|
/* get physical start address of kernel */
|
|
|
|
|
|
|
|
|
|
move.l 8(%fp), %a0
|
|
|
|
|
|
|
|
|
|
/* size of image to relocate */
|
|
|
|
|
|
|
|
|
|
move.l 12(%fp), %d0
|
|
|
|
|
|
2004-02-23 23:32:54 +00:00
|
|
|
/* destination addresse */
|
|
|
|
|
|
|
|
|
|
move.l 16(%fp), %a2
|
|
|
|
|
|
2004-02-15 20:46:45 +00:00
|
|
|
/* disable MMU */
|
|
|
|
|
|
2004-03-04 22:50:11 +00:00
|
|
|
moveq.l #0, %d1
|
2004-03-06 01:00:18 +00:00
|
|
|
movec %d1, %tc
|
2004-03-04 22:50:11 +00:00
|
|
|
movec %d1, %itt0
|
|
|
|
|
movec %d1, %dtt0
|
|
|
|
|
movec %d1, %itt1
|
|
|
|
|
movec %d1, %dtt1
|
2004-02-15 20:46:45 +00:00
|
|
|
|
2004-02-23 23:32:54 +00:00
|
|
|
/* copy kernel to destination address */
|
2004-02-15 20:46:45 +00:00
|
|
|
|
2004-02-23 00:21:36 +00:00
|
|
|
move.l %a2, %a1
|
2004-02-15 20:46:45 +00:00
|
|
|
|
|
|
|
|
copy_loop:
|
2004-02-23 00:21:36 +00:00
|
|
|
move.b (%a0)+, (%a2)+
|
|
|
|
|
subq.l #1, %d0
|
2004-02-15 20:46:45 +00:00
|
|
|
bge.s copy_loop
|
|
|
|
|
|
|
|
|
|
/* jump into kernel */
|
|
|
|
|
|
2004-02-23 00:21:36 +00:00
|
|
|
jmp %a1@
|
2004-02-15 20:46:45 +00:00
|
|
|
|
|
|
|
|
/* never comes here... I hope */
|
|
|
|
|
|
|
|
|
|
unlk %fp
|
|
|
|
|
rts
|
2004-03-04 22:50:11 +00:00
|
|
|
.global end_enter_kernel040
|
|
|
|
|
end_enter_kernel040:
|
