1 /* $Id: kimagerescue.S,v 1.1 2001/12/17 13:59:27 bjornw Exp $
3 * Rescue code to be prepended on a kimage and copied to the
5 * This is called from the rescue code, it will copy received data to
6 * 4004000 and after a timeout jump to it.
9 #define ASSEMBLER_MACROS_ONLY
10 #include <asm/sv_addr_ag.h>
12 #define CODE_START 0x40004000
13 #define CODE_LENGTH 784
14 #define TIMEOUT_VALUE 1000
17 #ifdef CONFIG_ETRAX_RESCUE_SER0
18 #define SERXOFF R_SERIAL0_XOFF
19 #define SERBAUD R_SERIAL0_BAUD
20 #define SERRECC R_SERIAL0_REC_CTRL
21 #define SERRDAT R_SERIAL0_REC_DATA
22 #define SERSTAT R_SERIAL0_STATUS
24 #ifdef CONFIG_ETRAX_RESCUE_SER1
25 #define SERXOFF R_SERIAL1_XOFF
26 #define SERBAUD R_SERIAL1_BAUD
27 #define SERRECC R_SERIAL1_REC_CTRL
28 #define SERRDAT R_SERIAL1_REC_DATA
29 #define SERSTAT R_SERIAL1_STATUS
31 #ifdef CONFIG_ETRAX_RESCUE_SER2
32 #define SERXOFF R_SERIAL2_XOFF
33 #define SERBAUD R_SERIAL2_BAUD
34 #define SERRECC R_SERIAL2_REC_CTRL
35 #define SERRDAT R_SERIAL2_REC_DATA
36 #define SERSTAT R_SERIAL2_STATUS
38 #ifdef CONFIG_ETRAX_RESCUE_SER3
39 #define SERXOFF R_SERIAL3_XOFF
40 #define SERBAUD R_SERIAL3_BAUD
41 #define SERRECC R_SERIAL3_REC_CTRL
42 #define SERRDAT R_SERIAL3_REC_DATA
43 #define SERSTAT R_SERIAL3_STATUS
47 ;; This is the entry point of the rescue code
48 ;; 0x80000000 if loaded in flash (as it should be)
49 ;; since etrax actually starts at address 2 when booting from flash, we
50 ;; put a nop (2 bytes) here first so we dont accidentally skip the di
54 #ifndef CONFIG_SVINTO_SIM
55 ;; setup port PA and PB default initial directions and data
56 ;; (so we can flash LEDs, and so that DTR and others are set)
58 move.b CONFIG_ETRAX_DEF_R_PORT_PA_DIR, $r0
59 move.b $r0, [R_PORT_PA_DIR]
60 move.b CONFIG_ETRAX_DEF_R_PORT_PA_DATA, $r0
61 move.b $r0, [R_PORT_PA_DATA]
63 move.b CONFIG_ETRAX_DEF_R_PORT_PB_DIR, $r0
64 move.b $r0, [R_PORT_PB_DIR]
65 move.b CONFIG_ETRAX_DEF_R_PORT_PB_DATA, $r0
66 move.b $r0, [R_PORT_PB_DATA]
68 ;; We need to setup the bus registers before we start using the DRAM
69 #include "../../lib/dram_init.S"
72 ;; Setup the stack to a suitably high address.
73 ;; We assume 8 MB is the minimum DRAM in an eLinux
74 ;; product and put the sp at the top for now.
76 move.d 0x40800000, $sp
78 ;; setup the serial port at 115200 baud
84 move.b $r0, [SERBAUD] ; 115.2kbaud for both transmit and receive
86 move.b 0x40, $r0 ; rec enable
90 moveq 0, $r1 ; "timer" to clock out a LED red flash
91 move.d CODE_START, $r3 ; destination counter
92 move.d CODE_LENGTH, $r4 ; length
93 move.d TIMEOUT_VALUE, $r5 ; "timeout" until jump
97 subq 1, $r5 ; decrease timeout
98 beq jump_start ; timed out
100 #ifndef CONFIG_ETRAX_NO_LEDS
101 #ifdef CONFIG_ETRAX_PA_LEDS
102 move.b CONFIG_ETRAX_DEF_R_PORT_PA_DATA, $r2
104 #ifdef CONFIG_ETRAX_PB_LEDS
105 move.b CONFIG_ETRAX_DEF_R_PORT_PB_DATA, $r2
107 move.d (1 << CONFIG_ETRAX_LED1R) | (1 << CONFIG_ETRAX_LED2R), $r0
111 or.d $r0, $r2 ; set bit
114 1: not $r0 ; clear bit
117 #ifdef CONFIG_ETRAX_PA_LEDS
118 move.b $r2, [R_PORT_PA_DATA]
120 #ifdef CONFIG_ETRAX_PB_LEDS
121 move.b $r2, [R_PORT_PB_DATA]
125 ;; check if we got something on the serial port
127 move.b [SERSTAT], $r0
128 btstq 0, $r0 ; data_avail
132 ;; got something - copy the byte and loop
134 move.b [SERRDAT], $r0
136 move.d TIMEOUT_VALUE, $r5 ; reset "timeout"
137 subq 1, $r4 ; decrease length
141 ;; jump into downloaded code