111 lines
1.9 KiB
ArmAsm
111 lines
1.9 KiB
ArmAsm
|
|
||
|
|
.global _start
|
||
|
|
.global _stext
|
||
|
|
|
||
|
|
.global _rambase
|
||
|
|
.global _ramvec
|
||
|
|
.global _ramstart
|
||
|
|
.global _ramend
|
||
|
|
|
||
|
|
#ifdef CONFIG_INIT_LCD
|
||
|
|
.global splash_bits
|
||
|
|
#endif
|
||
|
|
|
||
|
|
.data
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Set up the usable of RAM stuff. Size of RAM is determined then
|
||
|
|
* an initial stack set up at the end.
|
||
|
|
*/
|
||
|
|
.align 4
|
||
|
|
_ramvec:
|
||
|
|
.long 0
|
||
|
|
_rambase:
|
||
|
|
.long 0
|
||
|
|
_ramstart:
|
||
|
|
.long 0
|
||
|
|
_ramend:
|
||
|
|
.long 0
|
||
|
|
|
||
|
|
#define RAMEND (CONFIG_RAMBASE + CONFIG_RAMSIZE)
|
||
|
|
|
||
|
|
#ifdef CONFIG_INIT_LCD
|
||
|
|
splash_bits:
|
||
|
|
#include "bootlogo.rh"
|
||
|
|
#endif
|
||
|
|
|
||
|
|
.text
|
||
|
|
_start:
|
||
|
|
_stext: movew #0x2700,%sr
|
||
|
|
#ifdef CONFIG_INIT_LCD
|
||
|
|
movel #splash_bits, 0xfffffA00 /* LSSA */
|
||
|
|
moveb #0x28, 0xfffffA05 /* LVPW */
|
||
|
|
movew #0x280, 0xFFFFFa08 /* LXMAX */
|
||
|
|
movew #0x1df, 0xFFFFFa0a /* LYMAX */
|
||
|
|
moveb #0, 0xfffffa29 /* LBAR */
|
||
|
|
moveb #0, 0xfffffa25 /* LPXCD */
|
||
|
|
moveb #0x08, 0xFFFFFa20 /* LPICF */
|
||
|
|
moveb #0x01, 0xFFFFFA21 /* -ve pol */
|
||
|
|
moveb #0x81, 0xfffffA27 /* LCKCON */
|
||
|
|
movew #0xff00, 0xfffff412 /* LCD pins */
|
||
|
|
#endif
|
||
|
|
moveal #RAMEND-CONFIG_MEMORY_RESERVE*0x100000 - 0x10, %sp
|
||
|
|
movew #32767, %d0 /* PLL settle wait loop */
|
||
|
|
1: subq #1, %d0
|
||
|
|
bne 1b
|
||
|
|
|
||
|
|
/* Copy data segment from ROM to RAM */
|
||
|
|
moveal #_etext, %a0
|
||
|
|
moveal #_sdata, %a1
|
||
|
|
moveal #_edata, %a2
|
||
|
|
|
||
|
|
/* Copy %a0 to %a1 until %a1 == %a2 */
|
||
|
|
1: movel %a0@+, %a1@+
|
||
|
|
cmpal %a1, %a2
|
||
|
|
bhi 1b
|
||
|
|
|
||
|
|
moveal #_sbss, %a0
|
||
|
|
moveal #_ebss, %a1
|
||
|
|
/* Copy 0 to %a0 until %a0 == %a1 */
|
||
|
|
|
||
|
|
1:
|
||
|
|
clrl %a0@+
|
||
|
|
cmpal %a0, %a1
|
||
|
|
bhi 1b
|
||
|
|
|
||
|
|
movel #_sdata, %d0
|
||
|
|
movel %d0, _rambase
|
||
|
|
movel #_ebss, %d0
|
||
|
|
movel %d0, _ramstart
|
||
|
|
movel #RAMEND-CONFIG_MEMORY_RESERVE*0x100000, %d0
|
||
|
|
movel %d0, _ramend
|
||
|
|
movel #CONFIG_VECTORBASE, %d0
|
||
|
|
movel %d0, _ramvec
|
||
|
|
|
||
|
|
/*
|
||
|
|
* load the current task pointer and stack
|
||
|
|
*/
|
||
|
|
lea init_thread_union, %a0
|
||
|
|
lea 0x2000(%a0), %sp
|
||
|
|
|
||
|
|
1: jsr start_kernel
|
||
|
|
bra 1b
|
||
|
|
_exit:
|
||
|
|
|
||
|
|
jmp _exit
|
||
|
|
|
||
|
|
|
||
|
|
putc:
|
||
|
|
moveb %d7,0xfffff907
|
||
|
|
1:
|
||
|
|
movew 0xfffff906, %d7
|
||
|
|
andw #0x2000, %d7
|
||
|
|
beq 1b
|
||
|
|
rts
|
||
|
|
|
||
|
|
.data
|
||
|
|
env:
|
||
|
|
.long 0
|
||
|
|
.text
|
||
|
|
|