127 lines
		
	
	
		
			2.8 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			127 lines
		
	
	
		
			2.8 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| /*
 | |
|  *  arch/cris/boot/compressed/head.S
 | |
|  *
 | |
|  *  Copyright (C) 1999, 2001 Axis Communications AB
 | |
|  *
 | |
|  *  Code that sets up the DRAM registers, calls the
 | |
|  *  decompressor to unpack the piggybacked kernel, and jumps.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #define ASSEMBLER_MACROS_ONLY
 | |
| #include <arch/sv_addr_ag.h>
 | |
| 
 | |
| #define RAM_INIT_MAGIC 0x56902387
 | |
| #define COMMAND_LINE_MAGIC 0x87109563
 | |
| 
 | |
| 	;; Exported symbols
 | |
| 
 | |
| 	.globl	input_data
 | |
| 
 | |
| 
 | |
| 	.text
 | |
| 
 | |
| 	nop
 | |
| 	di
 | |
| 
 | |
| ;; We need to initialze DRAM registers before we start using the DRAM
 | |
| 
 | |
| 	cmp.d	RAM_INIT_MAGIC, $r8	; Already initialized?
 | |
| 	beq	dram_init_finished
 | |
| 	nop
 | |
| 
 | |
| #include "../../arch-v10/lib/dram_init.S"
 | |
| 
 | |
| dram_init_finished:
 | |
| 
 | |
| 	;; Initiate the PA and PB ports
 | |
| 
 | |
| 	move.b   CONFIG_ETRAX_DEF_R_PORT_PA_DATA, $r0
 | |
| 	move.b   $r0, [R_PORT_PA_DATA]
 | |
| 
 | |
| 	move.b   CONFIG_ETRAX_DEF_R_PORT_PA_DIR, $r0
 | |
| 	move.b   $r0, [R_PORT_PA_DIR]
 | |
| 
 | |
| 	move.b   CONFIG_ETRAX_DEF_R_PORT_PB_DATA, $r0
 | |
| 	move.b   $r0, [R_PORT_PB_DATA]
 | |
| 
 | |
| 	move.b   CONFIG_ETRAX_DEF_R_PORT_PB_DIR, $r0
 | |
| 	move.b   $r0, [R_PORT_PB_DIR]
 | |
| 
 | |
| 	;; Setup the stack to a suitably high address.
 | |
| 	;; We assume 8 MB is the minimum DRAM in an eLinux
 | |
| 	;; product and put the sp at the top for now.
 | |
| 
 | |
| 	move.d	0x40800000, $sp
 | |
| 
 | |
| 	;; Figure out where the compressed piggyback image is
 | |
| 	;; in the flash (since we wont try to copy it to DRAM
 | |
| 	;; before unpacking). It is at _edata, but in flash.
 | |
| 	;; Use (_edata - basse) as offset to the current PC.
 | |
| 
 | |
| basse:	move.d	$pc, $r5
 | |
| 	and.d	0x7fffffff, $r5	; strip any non-cache bit
 | |
| 	subq	2, $r5		; compensate for the move.d $pc instr
 | |
| 	move.d	$r5, $r0		; save for later - flash address of 'basse'
 | |
| 	add.d	_edata, $r5
 | |
| 	sub.d	basse, $r5	; $r5 = flash address of '_edata'
 | |
| 
 | |
| 	;; Copy text+data to DRAM
 | |
| 
 | |
| 	move.d	basse, $r1	; destination
 | |
| 	move.d	_edata, $r2	; end destination
 | |
| 1:	move.w	[$r0+], $r3
 | |
| 	move.w	$r3, [$r1+]
 | |
| 	cmp.d	$r2, $r1
 | |
| 	bcs	1b
 | |
| 	nop
 | |
| 
 | |
| 	move.d	$r5, [input_data] ; for the decompressor
 | |
| 
 | |
| 
 | |
| 	;; Clear the decompressors BSS (between _edata and _end)
 | |
| 
 | |
| 	moveq	0, $r0
 | |
| 	move.d	_edata, $r1
 | |
| 	move.d	_end, $r2
 | |
| 1:	move.w	$r0, [$r1+]
 | |
| 	cmp.d	$r2, $r1
 | |
| 	bcs	1b
 | |
| 	nop
 | |
| 
 | |
| 	;;  Save command line magic and address.
 | |
| 	move.d	_cmd_line_magic, $r12
 | |
| 	move.d  $r10, [$r12]
 | |
| 	move.d	_cmd_line_addr, $r12
 | |
| 	move.d  $r11, [$r12]
 | |
| 
 | |
| 	;; Do the decompression and save compressed size in inptr
 | |
| 
 | |
| 	jsr	decompress_kernel
 | |
| 
 | |
| 	;; Put start address of root partition in $r9 so the kernel can use it
 | |
| 	;; when mounting from flash
 | |
| 
 | |
| 	move.d	[input_data], $r9	; flash address of compressed kernel
 | |
| 	add.d	[inptr], $r9		; size of compressed kernel
 | |
| 
 | |
| 	;; Restore command line magic and address.
 | |
| 	move.d  _cmd_line_magic, $r10
 | |
| 	move.d  [$r10], $r10
 | |
| 	move.d  _cmd_line_addr, $r11
 | |
| 	move.d  [$r11], $r11
 | |
| 
 | |
| 	;; Enter the decompressed kernel
 | |
| 	move.d	RAM_INIT_MAGIC, $r8	; Tell kernel that DRAM is initialized
 | |
| 	jump	0x40004000	; kernel is linked to this address
 | |
| 
 | |
| 	.data
 | |
| 
 | |
| input_data:
 | |
| 	.dword	0		; used by the decompressor
 | |
| _cmd_line_magic:
 | |
| 	.dword 0
 | |
| _cmd_line_addr:
 | |
| 	.dword 0
 | |
| #include "../../arch-v10/lib/hw_settings.S"
 |