mirror of
https://github.com/rd-stuffs/msm-4.14.git
synced 2025-02-20 11:45:48 +08:00
CRIS v32: Update compressed head.S
- Fixes for NAND and NOR flash booting. - Use assembler macros for common tasks (clocks, general io etc) - Use (EtraxFS or Artpec-3) machine specific include for dram and hardware init.
This commit is contained in:
Jesper Nilsson
parent
5d23ff25b2
commit
247c3c959f
@ -2,13 +2,12 @@
|
|||||||
* Code that sets up the DRAM registers, calls the
|
* Code that sets up the DRAM registers, calls the
|
||||||
* decompressor to unpack the piggybacked kernel, and jumps.
|
* decompressor to unpack the piggybacked kernel, and jumps.
|
||||||
*
|
*
|
||||||
* Copyright (C) 1999 - 2003, Axis Communications AB
|
* Copyright (C) 1999 - 2006, Axis Communications AB
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define ASSEMBLER_MACROS_ONLY
|
#define ASSEMBLER_MACROS_ONLY
|
||||||
#include <asm/arch/hwregs/asm/reg_map_asm.h>
|
#include <hwregs/asm/reg_map_asm.h>
|
||||||
#include <asm/arch/hwregs/asm/gio_defs_asm.h>
|
#include <asm/arch/mach/startup.inc>
|
||||||
#include <asm/arch/hwregs/asm/config_defs_asm.h>
|
|
||||||
|
|
||||||
#define RAM_INIT_MAGIC 0x56902387
|
#define RAM_INIT_MAGIC 0x56902387
|
||||||
#define COMMAND_LINE_MAGIC 0x87109563
|
#define COMMAND_LINE_MAGIC 0x87109563
|
||||||
@ -22,114 +21,49 @@ start:
|
|||||||
di
|
di
|
||||||
|
|
||||||
;; Start clocks for used blocks.
|
;; Start clocks for used blocks.
|
||||||
move.d REG_ADDR(config, regi_config, rw_clk_ctrl), $r1
|
START_CLOCKS
|
||||||
move.d [$r1], $r0
|
|
||||||
or.d REG_STATE(config, rw_clk_ctrl, cpu, yes) | \
|
|
||||||
REG_STATE(config, rw_clk_ctrl, bif, yes) | \
|
|
||||||
REG_STATE(config, rw_clk_ctrl, fix_io, yes), $r0
|
|
||||||
move.d $r0, [$r1]
|
|
||||||
|
|
||||||
;; If booting from NAND flash we first have to copy some
|
;; Initialize the DRAM registers.
|
||||||
;; data from NAND flash to internal RAM to get the code
|
|
||||||
;; that initializes the SDRAM. Lets copy 20 KB. This
|
|
||||||
;; code executes at 0x38010000 if booting from NAND and
|
|
||||||
;; we are guaranted that at least 0x200 bytes are good so
|
|
||||||
;; lets start from there. The first 8192 bytes in the nand
|
|
||||||
;; flash is spliced with zeroes and is thus 16384 bytes.
|
|
||||||
move.d 0x38010200, $r10
|
|
||||||
move.d 0x14200, $r11 ; Start offset in NAND flash 0x10200 + 16384
|
|
||||||
move.d 0x5000, $r12 ; Length of copy
|
|
||||||
|
|
||||||
;; Before this code the tools add a partitiontable so the PC
|
|
||||||
;; has an offset from the linked address.
|
|
||||||
offset1:
|
|
||||||
lapcq ., $r13 ; get PC
|
|
||||||
add.d first_copy_complete-offset1, $r13
|
|
||||||
|
|
||||||
#include "../../lib/nand_init.S"
|
|
||||||
|
|
||||||
first_copy_complete:
|
|
||||||
;; Initialze the DRAM registers.
|
|
||||||
cmp.d RAM_INIT_MAGIC, $r8 ; Already initialized?
|
cmp.d RAM_INIT_MAGIC, $r8 ; Already initialized?
|
||||||
beq dram_init_finished
|
beq dram_init_finished
|
||||||
nop
|
nop
|
||||||
|
|
||||||
#include "../../lib/dram_init.S"
|
#include "../../mach/dram_init.S"
|
||||||
|
|
||||||
dram_init_finished:
|
dram_init_finished:
|
||||||
lapcq ., $r13 ; get PC
|
|
||||||
add.d second_copy_complete-dram_init_finished, $r13
|
|
||||||
|
|
||||||
move.d REG_ADDR(config, regi_config, r_bootsel), $r0
|
|
||||||
move.d [$r0], $r0
|
|
||||||
and.d REG_MASK(config, r_bootsel, boot_mode), $r0
|
|
||||||
cmp.d REG_STATE(config, r_bootsel, boot_mode, nand), $r0
|
|
||||||
bne second_copy_complete ; No NAND boot
|
|
||||||
nop
|
|
||||||
|
|
||||||
;; Copy 2MB from NAND flash to SDRAM (at 2-4MB into the SDRAM)
|
|
||||||
move.d 0x40204000, $r10
|
|
||||||
move.d 0x8000, $r11
|
|
||||||
move.d 0x200000, $r12
|
|
||||||
ba copy_nand_to_ram
|
|
||||||
nop
|
|
||||||
second_copy_complete:
|
|
||||||
|
|
||||||
;; Initiate the PA port.
|
|
||||||
move.d CONFIG_ETRAX_DEF_GIO_PA_OUT, $r0
|
|
||||||
move.d REG_ADDR(gio, regi_gio, rw_pa_dout), $r1
|
|
||||||
move.d $r0, [$r1]
|
|
||||||
|
|
||||||
move.d CONFIG_ETRAX_DEF_GIO_PA_OE, $r0
|
|
||||||
move.d REG_ADDR(gio, regi_gio, rw_pa_oe), $r1
|
|
||||||
move.d $r0, [$r1]
|
|
||||||
|
|
||||||
|
GIO_INIT
|
||||||
;; Setup the stack to a suitably high address.
|
;; Setup the stack to a suitably high address.
|
||||||
;; We assume 8 MB is the minimum DRAM and put
|
;; We assume 8 MB is the minimum DRAM and put
|
||||||
;; the SP at the top for now.
|
;; the SP at the top for now.
|
||||||
|
|
||||||
move.d 0x40800000, $sp
|
move.d 0x40800000, $sp
|
||||||
|
|
||||||
;; Figure out where the compressed piggyback image is
|
;; Figure out where the compressed piggyback image is.
|
||||||
;; in the flash (since we wont try to copy it to DRAM
|
;; It is either in [NOR] flash (we don't want to copy it
|
||||||
;; before unpacking). It is at _edata, but in flash.
|
;; to DRAM before unpacking), or copied to DRAM
|
||||||
|
;; by the [NAND] flash boot loader.
|
||||||
|
;; The piggyback image is at _edata, but relative to where the
|
||||||
|
;; image is actually located in memory, not where it is linked
|
||||||
|
;; (the decompressor is linked at 0x40700000+ and runs there).
|
||||||
;; Use (_edata - herami) as offset to the current PC.
|
;; Use (_edata - herami) as offset to the current PC.
|
||||||
|
|
||||||
move.d REG_ADDR(config, regi_config, r_bootsel), $r0
|
|
||||||
move.d [$r0], $r0
|
|
||||||
and.d REG_MASK(config, r_bootsel, boot_mode), $r0
|
|
||||||
cmp.d REG_STATE(config, r_bootsel, boot_mode, nand), $r0
|
|
||||||
beq hereami2
|
|
||||||
nop
|
|
||||||
hereami:
|
hereami:
|
||||||
lapcq ., $r5 ; get PC
|
lapcq ., $r5 ; get PC
|
||||||
and.d 0x7fffffff, $r5 ; strip any non-cache bit
|
and.d 0x7fffffff, $r5 ; strip any non-cache bit
|
||||||
move.d $r5, $r0 ; save for later - flash address of 'herami'
|
move.d $r5, $r0 ; source address of 'herami'
|
||||||
add.d _edata, $r5
|
add.d _edata, $r5
|
||||||
sub.d hereami, $r5 ; r5 = flash address of '_edata'
|
sub.d hereami, $r5 ; r5 = flash address of '_edata'
|
||||||
move.d hereami, $r1 ; destination
|
move.d hereami, $r1 ; destination
|
||||||
ba 2f
|
|
||||||
nop
|
|
||||||
hereami2:
|
|
||||||
lapcq ., $r5 ; get PC
|
|
||||||
and.d 0x00ffffff, $r5 ; strip any non-cache bit
|
|
||||||
move.d $r5, $r6
|
|
||||||
or.d 0x40200000, $r6
|
|
||||||
move.d $r6, $r0 ; save for later - flash address of 'herami'
|
|
||||||
add.d _edata, $r5
|
|
||||||
sub.d hereami2, $r5 ; r5 = flash address of '_edata'
|
|
||||||
add.d 0x40200000, $r5
|
|
||||||
move.d hereami2, $r1 ; destination
|
|
||||||
2:
|
|
||||||
;; Copy text+data to DRAM
|
;; Copy text+data to DRAM
|
||||||
|
|
||||||
move.d _edata, $r2 ; end destination
|
move.d _edata, $r2 ; end destination
|
||||||
1: move.w [$r0+], $r3
|
1: move.w [$r0+], $r3 ; from herami+ source
|
||||||
move.w $r3, [$r1+]
|
move.w $r3, [$r1+] ; to hereami+ destination (linked address)
|
||||||
cmp.d $r2, $r1
|
cmp.d $r2, $r1 ; finish when destination == _edata
|
||||||
bcs 1b
|
bcs 1b
|
||||||
nop
|
nop
|
||||||
|
|
||||||
move.d input_data, $r0 ; for the decompressor
|
move.d input_data, $r0 ; for the decompressor
|
||||||
move.d $r5, [$r0] ; for the decompressor
|
move.d $r5, [$r0] ; for the decompressor
|
||||||
|
|
||||||
@ -144,16 +78,24 @@ hereami2:
|
|||||||
nop
|
nop
|
||||||
|
|
||||||
;; Save command line magic and address.
|
;; Save command line magic and address.
|
||||||
move.d _cmd_line_magic, $r12
|
move.d _cmd_line_magic, $r0
|
||||||
move.d $r10, [$r12]
|
move.d $r10, [$r0]
|
||||||
move.d _cmd_line_addr, $r12
|
move.d _cmd_line_addr, $r0
|
||||||
move.d $r11, [$r12]
|
move.d $r11, [$r0]
|
||||||
|
|
||||||
|
;; Save boot source indicator
|
||||||
|
move.d _boot_source, $r0
|
||||||
|
move.d $r12, [$r0]
|
||||||
|
|
||||||
;; Do the decompression and save compressed size in _inptr
|
;; Do the decompression and save compressed size in _inptr
|
||||||
|
|
||||||
jsr decompress_kernel
|
jsr decompress_kernel
|
||||||
nop
|
nop
|
||||||
|
|
||||||
|
;; Restore boot source indicator
|
||||||
|
move.d _boot_source, $r12
|
||||||
|
move.d [$r12], $r12
|
||||||
|
|
||||||
;; Restore command line magic and address.
|
;; Restore command line magic and address.
|
||||||
move.d _cmd_line_magic, $r10
|
move.d _cmd_line_magic, $r10
|
||||||
move.d [$r10], $r10
|
move.d [$r10], $r10
|
||||||
@ -166,11 +108,10 @@ hereami2:
|
|||||||
move.d [$r0], $r9 ; flash address of compressed kernel
|
move.d [$r0], $r9 ; flash address of compressed kernel
|
||||||
move.d inptr, $r0
|
move.d inptr, $r0
|
||||||
add.d [$r0], $r9 ; size of compressed kernel
|
add.d [$r0], $r9 ; size of compressed kernel
|
||||||
cmp.d 0x40200000, $r9
|
cmp.d 0x40000000, $r9 ; image in DRAM ?
|
||||||
blo enter_kernel
|
blo enter_kernel ; no, must be [NOR] flash, jump
|
||||||
nop
|
nop ; delay slot
|
||||||
sub.d 0x40200000, $r9
|
and.d 0x001fffff, $r9 ; assume compressed kernel was < 2M
|
||||||
add.d 0x4000, $r9
|
|
||||||
|
|
||||||
enter_kernel:
|
enter_kernel:
|
||||||
;; Enter the decompressed kernel
|
;; Enter the decompressed kernel
|
||||||
@ -186,7 +127,7 @@ _cmd_line_magic:
|
|||||||
.dword 0
|
.dword 0
|
||||||
_cmd_line_addr:
|
_cmd_line_addr:
|
||||||
.dword 0
|
.dword 0
|
||||||
is_nand_boot:
|
_boot_source:
|
||||||
.dword 0
|
.dword 0
|
||||||
|
|
||||||
#include "../../lib/hw_settings.S"
|
#include "../../mach/hw_settings.S"
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user