diff options
Diffstat (limited to 'firmware/target')
-rw-r--r-- | firmware/target/arm/rk27xx/rolo_restart.S | 69 |
1 files changed, 69 insertions, 0 deletions
diff --git a/firmware/target/arm/rk27xx/rolo_restart.S b/firmware/target/arm/rk27xx/rolo_restart.S new file mode 100644 index 0000000000..19e4a1c65a --- /dev/null +++ b/firmware/target/arm/rk27xx/rolo_restart.S | |||
@@ -0,0 +1,69 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * | ||
9 | * Copyright (C) 2008 by Michael Sevakis | ||
10 | * Copyright (C) 2012 by Marcin Bukat | ||
11 | * | ||
12 | * RoLo firmware restart code for rk27xx | ||
13 | * | ||
14 | * This program is free software; you can redistribute it and/or | ||
15 | * modify it under the terms of the GNU General Public License | ||
16 | * as published by the Free Software Foundation; either version 2 | ||
17 | * of the License, or (at your option) any later version. | ||
18 | * | ||
19 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
20 | * KIND, either express or implied. | ||
21 | * | ||
22 | ****************************************************************************/ | ||
23 | #include "config.h" | ||
24 | #include "cpu.h" | ||
25 | |||
26 | /**************************************************************************** | ||
27 | * void rolo_restart(const unsigned char* source, unsigned char* dest, | ||
28 | * int length); | ||
29 | */ | ||
30 | .section .text, "ax", %progbits | ||
31 | .align 2 | ||
32 | .global rolo_restart | ||
33 | rolo_restart: | ||
34 | /* Disable cache */ | ||
35 | ldr r4, =0xefff0000 | ||
36 | ldrh r5, [r4] | ||
37 | strh r5, [r4] | ||
38 | |||
39 | adr r4, restart_copy_start | ||
40 | adr r5, restart_copy_end | ||
41 | ldr r6, =0x18200000 | ||
42 | mov r7, r6 | ||
43 | |||
44 | /* Copy stub to IRAM */ | ||
45 | 1: | ||
46 | ldr r8, [r4], #4 | ||
47 | str r8, [r7], #4 | ||
48 | cmp r5, r4 | ||
49 | bhi 1b | ||
50 | |||
51 | /* Branch to stub */ | ||
52 | bx r6 | ||
53 | |||
54 | restart_copy_start: | ||
55 | /* Trivial copy of firmware to final location | ||
56 | * this version assumes that src and dst are | ||
57 | * word aligned | ||
58 | */ | ||
59 | mov r4, r1 | ||
60 | 1: | ||
61 | subs r2, r2, #4 | ||
62 | ldr r7, [r0], #4 | ||
63 | str r7, [r4], #4 | ||
64 | bge 1b | ||
65 | |||
66 | /* Branch to destination */ | ||
67 | bx r1 | ||
68 | restart_copy_end: | ||
69 | .size rolo_restart,.-rolo_restart | ||