2410init.new.s

来自「深圳市微逻辑电子有限公司 巨果&#8226 Kingmos&reg 系统核心」· S 代码 · 共 142 行

/* 
 *  Copyright (C) 2002 Samsung Electronics SW.LEE  <[e-mail]>
 *  Copyright (c) 2001  Marius Gr鰃er <[e-mail]>
 *  Copyright (c) 2002  Alex Z黳ke <[e-mail]>
 *  Copyright (c) 2002  Gary Jennejohn <[e-mail]>
 * 
 *  ARMBOOT boot startup code 
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 */

.include "memcfg.inc"
.include "option.inc"	
.include "register.inc"

.equ	USER_MODE	,	0x10	@2_10000
.equ	FIQ_MODE	,	0x11	@2_10001
.equ	IRQ_MODE	,	0x12	@2_10010
.equ	SVC_MODE	,	0x13	@2_10011
.equ	ABORT_MODE	,	0x17	@2_10111
.equ	UNDEF_MODE	,	0x1b	@2_11011
.equ	SYS_MODE    ,   0x1f	@2_11111
.equ    MODEMASK    ,   0x1f
.equ    NOINT       ,   0xc0

.equ SysStack, (_STACK_BASEADDRESS-0x2000)	 @;0x33ff4800 ~ 0x33ff6000
.equ SVCStack, (_STACK_BASEADDRESS-0x1000) 	@;4k 0x33ff5800 ~
.equ UndefStack, (_STACK_BASEADDRESS-0xc00) 	@;1k 0x33ff5c00 ~
.equ AbortStack, (_STACK_BASEADDRESS-0x800) 	@;1k 0x33ff5000 ~
.equ IRQStack, (_STACK_BASEADDRESS-0x400)	@;1k 0x33ff7c00 ~
.equ FIQStack, (_STACK_BASEADDRESS-0x0)	@;1k 0x33ff8000 ~ 

.globl  _startup
	.section .start, #alloc, #execinstr
	.type _startup, #function

_startup:

    mov     r1, #SVC_MODE|NOINT 	@ svc mode, no interrupts
    msr     cpsr, r1
	b	   reset				      

	.size	_startup, . - _startup

	.align	
	.text
	
reset:

	ldr	r0,=WTCON       /*watch dog disable  */
	ldr	r1,=0x0         
	str	r1,[r0]

	ldr	r0,=INTMSK
	ldr	r1,=0xffffffff  /*all interrupt disable */
	str	r1,[r0]

	ldr	r0,=INTSUBMSK
	ldr	r1,=0x3ff		/*all sub interrupt disable */
	str	r1,[r0]
	
 	/* Setup clock Divider control register  
	 * you must configure CLKDIVN before LOCKTIME or MPLL UPLL
	 * because default CLKDIVN 1,1,1 set the SDMRAM Timing Conflict
	nop
	 * FCLK:HCLK:PCLK = 1:2:4  in this case
	 */
@	ldr	r0,=CLKDIVN
@	ldr	r1,=0x3		
@	str	r1,[r0]

	/*To reduce PLL lock time, adjust the LOCKTIME register. */
	ldr	r0,=LOCKTIME
	ldr	r1,=0xffffff
	str	r1,[r0]	

/*Configure MPLL */
    ldr     r0,=MPLLCON
@    (0xa1<<12+0x3<<4+0x1)   
    ldr     r1,=((M_MDIV<<12)+(M_PDIV<<4)+M_SDIV)  @Fin=12MHz,Fout=203MHz
    str     r1,[r0]
    
	ldr	r0,=UPLLCON          
	ldr	r1,=((U_MDIV<<12)+(U_PDIV<<4)+U_SDIV)  @Fin=12MHz,UPLLout=48MHz
	str	r1,[r0]
    
	/* MEMORY C0NTROLLER(MC)  SETTING */
	add	r0,pc,#MCDATA - (.+8)
	ldr	r1,=BWSCON		
	add	r2,r0,#52	@  End address of MEMORY CONTROLLER
1:	
	ldr	r3,[r0],#4
	str	r3,[r1],#4
	cmp	r2,r0
	bne	1b

call_main:

    @because the romstart is defined as virtual address as:0x8c200000 ,
    @so we must mask the high half-word
    @memory.con's
    @RAMIMAGE  =:	0x8C200000   0X00900000
    @if you change memory.con's RAMIMAGE ,you must change 0x30200000 too
    @
    
	ldr		r2, =Restart_Address	
	ldr		r1, =0x000fffff
	and		r2,r2,r1
	ldr		r1, =0x30200000          @download address
	add		r1,r1,r2
	cmp        r1, #0                  @ make sure no stall on "mov pc,r1" below

	mov		pc,r1

Restart_Address:
	nop
    mov     fp,#0           /* no previous frame, so fp=0*/
	add	 r0, pc, #OEMAddressTable - (. + 8)            
    bl      _KernelStart		@   _KernelStart should never return
    b .
    
	.align 2
		
MCDATA:
    .word (0+(B1_BWSCON<<4)+(B2_BWSCON<<8)+(B3_BWSCON<<12)+(B4_BWSCON<<16)+(B5_BWSCON<<20)+(B6_BWSCON<<24)+(B7_BWSCON<<28))
    .word ((B0_Tacs<<13)+(B0_Tcos<<11)+(B0_Tacc<<8)+(B0_Tcoh<<6)+(B0_Tah<<4)+(B0_Tacp<<2)+(B0_PMC))   
    .word ((B1_Tacs<<13)+(B1_Tcos<<11)+(B1_Tacc<<8)+(B1_Tcoh<<6)+(B1_Tah<<4)+(B1_Tacp<<2)+(B1_PMC))  
    .word ((B2_Tacs<<13)+(B2_Tcos<<11)+(B2_Tacc<<8)+(B2_Tcoh<<6)+(B2_Tah<<4)+(B2_Tacp<<2)+(B2_PMC))  
    .word ((B3_Tacs<<13)+(B3_Tcos<<11)+(B3_Tacc<<8)+(B3_Tcoh<<6)+(B3_Tah<<4)+(B3_Tacp<<2)+(B3_PMC))  
    .word ((B4_Tacs<<13)+(B4_Tcos<<11)+(B4_Tacc<<8)+(B4_Tcoh<<6)+(B4_Tah<<4)+(B4_Tacp<<2)+(B4_PMC))  
    .word ((B5_Tacs<<13)+(B5_Tcos<<11)+(B5_Tacc<<8)+(B5_Tcoh<<6)+(B5_Tah<<4)+(B5_Tacp<<2)+(B5_PMC))
    .word ((B6_MT<<15)+(B6_Trcd<<2)+(B6_SCAN))    
    .word ((B7_MT<<15)+(B7_Trcd<<2)+(B7_SCAN))    
    .word ((REFEN<<23)+(TREFMD<<22)+(Trp<<20)+(Trc<<18)+(Tchr<<16)+REFCNT)    
    .word 0x32          /* REFRESH Control Register  */ 
    .word 0x30          /* BANKSIZE Register : Burst Mode       */ 
    .word 0x30          /* SDRAM Mode Register       */ 

    .include "table.s"