117 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			117 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
/*
 | 
						|
 * DRAM/SDRAM initialization - alter with care
 | 
						|
 * This file is intended to be included from other assembler files
 | 
						|
 *
 | 
						|
 * Note: This file may not modify r8 or r9 because they are used to
 | 
						|
 * carry information from the decompresser to the kernel
 | 
						|
 *
 | 
						|
 * Copyright (C) 2000-2007 Axis Communications AB
 | 
						|
 *
 | 
						|
 * Authors:  Mikael Starvik <starvik@axis.com>
 | 
						|
 */
 | 
						|
 | 
						|
/* Just to be certain the config file is included, we include it here
 | 
						|
 * explicitely instead of depending on it being included in the file that
 | 
						|
 * uses this code.
 | 
						|
 */
 | 
						|
 | 
						|
#include <hwregs/asm/reg_map_asm.h>
 | 
						|
#include <hwregs/asm/bif_core_defs_asm.h>
 | 
						|
 | 
						|
	;; WARNING! The registers r8 and r9 are used as parameters carrying
 | 
						|
	;; information from the decompressor (if the kernel was compressed).
 | 
						|
	;; They should not be used in the code below.
 | 
						|
 | 
						|
	; Refer to BIF MDS for a description of SDRAM initialization
 | 
						|
 | 
						|
	; Bank configuration
 | 
						|
	move.d   REG_ADDR(bif_core, regi_bif_core, rw_sdram_cfg_grp0), $r0
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_GRP0_CONFIG, $r1
 | 
						|
	move.d   $r1, [$r0]
 | 
						|
	move.d   REG_ADDR(bif_core, regi_bif_core, rw_sdram_cfg_grp1), $r0
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_GRP1_CONFIG, $r1
 | 
						|
	move.d   $r1, [$r0]
 | 
						|
 | 
						|
	; Calculate value of mrs_data
 | 
						|
	; CAS latency = 2 && bus_width = 32 => 0x40
 | 
						|
	; CAS latency = 3 && bus_width = 32 => 0x60
 | 
						|
	; CAS latency = 2 && bus_width = 16 => 0x20
 | 
						|
	; CAS latency = 3 && bus_width = 16 => 0x30
 | 
						|
 | 
						|
	; Check if value is already supplied in kernel config
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_COMMAND, $r2
 | 
						|
	bne	 _set_timing
 | 
						|
	nop
 | 
						|
 | 
						|
	move.d   0x40, $r4       ; Assume 32 bits and CAS latency = 2
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_TIMING, $r1
 | 
						|
	and.d    0x07, $r1       ; Get CAS latency
 | 
						|
	cmpq	 2, $r1		 ; CL = 2 ?
 | 
						|
	beq	 _bw_check
 | 
						|
	nop
 | 
						|
	move.d   0x60, $r4
 | 
						|
 | 
						|
_bw_check:
 | 
						|
	; Assume that group 0 width is equal to group 1. This assumption
 | 
						|
	; is wrong for a group 1 only hardware (such as the grand old
 | 
						|
	; StorPoint+).
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_GRP0_CONFIG, $r1
 | 
						|
	and.d    0x200, $r1	; DRAM width is bit 9
 | 
						|
	beq      _set_timing
 | 
						|
	lslq	 2, $r4		;  mrs_data starts at bit 2
 | 
						|
	lsrq     1, $r4		;  16 bits. Shift down value.
 | 
						|
 | 
						|
	; Set timing parameters (refresh off to avoid Guinness TR 83)
 | 
						|
_set_timing:
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_TIMING, $r1
 | 
						|
	and.d    ~(3 << reg_bif_core_rw_sdram_timing___ref___lsb), $r1
 | 
						|
	move.d   REG_ADDR(bif_core, regi_bif_core, rw_sdram_timing), $r0
 | 
						|
	move.d   $r1, [$r0]
 | 
						|
 | 
						|
	; Issue NOP command
 | 
						|
	move.d REG_ADDR(bif_core, regi_bif_core, rw_sdram_cmd), $r5
 | 
						|
	moveq regk_bif_core_nop, $r1
 | 
						|
	move.d $r1, [$r5]
 | 
						|
 | 
						|
	; Wait 200us
 | 
						|
	move.d   10000, $r2
 | 
						|
1:	bne      1b
 | 
						|
	subq     1, $r2
 | 
						|
 | 
						|
	; Issue initialization command sequence
 | 
						|
	lapc     _sdram_commands_start, $r2
 | 
						|
	lapc     _sdram_commands_end,  $r3
 | 
						|
1:	clear.d  $r6
 | 
						|
	move.b   [$r2+], $r6	; Load command
 | 
						|
	or.d     $r4, $r6	; Add calculated mrs
 | 
						|
	move.d   $r6, [$r5]	; Write rw_sdram_cmd
 | 
						|
	; Wait 80 ns between each command
 | 
						|
	move.d	 4000, $r7
 | 
						|
2:	bne	 2b
 | 
						|
	subq	 1, $r7
 | 
						|
	cmp.d    $r2, $r3	; Last command?
 | 
						|
	bne      1b
 | 
						|
	nop
 | 
						|
 | 
						|
	; Start refresh
 | 
						|
	move.d   CONFIG_ETRAX_SDRAM_TIMING, $r1
 | 
						|
	move.d   REG_ADDR(bif_core, regi_bif_core, rw_sdram_timing), $r0
 | 
						|
	move.d   $r1, [$r0]
 | 
						|
 | 
						|
	; Initialization finished
 | 
						|
	ba       _sdram_commands_end
 | 
						|
	nop
 | 
						|
 | 
						|
_sdram_commands_start:
 | 
						|
	.byte   regk_bif_core_pre ; Precharge
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_ref ; refresh
 | 
						|
	.byte   regk_bif_core_mrs ; mrs
 | 
						|
_sdram_commands_end:
 |