mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-04 05:50:17 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			580 lines
		
	
	
		
			14 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			580 lines
		
	
	
		
			14 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
/*
 | 
						|
 * U-boot - start.S Startup file of u-boot for BF537
 | 
						|
 *
 | 
						|
 * Copyright (c) 2005-2007 Analog Devices Inc.
 | 
						|
 *
 | 
						|
 * This file is based on head.S
 | 
						|
 * Copyright (c) 2003  Metrowerks/Motorola
 | 
						|
 * Copyright (C) 1998  D. Jeff Dionne <jeff@ryeham.ee.ryerson.ca>,
 | 
						|
 *                     Kenneth Albanowski <kjahds@kjahds.com>,
 | 
						|
 *                     The Silver Hammer Group, Ltd.
 | 
						|
 * (c) 1995, Dionne & Associates
 | 
						|
 * (c) 1995, DKG Display Tech.
 | 
						|
 *
 | 
						|
 * See file CREDITS for list of people who contributed to this
 | 
						|
 * project.
 | 
						|
 *
 | 
						|
 * 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.
 | 
						|
 *
 | 
						|
 * This program is distributed in the hope that it will be useful,
 | 
						|
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
						|
 * GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 * You should have received a copy of the GNU General Public License
 | 
						|
 * along with this program; if not, write to the Free Software
 | 
						|
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
 | 
						|
 * MA 02110-1301 USA
 | 
						|
 */
 | 
						|
 | 
						|
/*
 | 
						|
 * Note: A change in this file subsequently requires a change in
 | 
						|
 *       board/$(board_name)/config.mk for a valid u-boot.bin
 | 
						|
 */
 | 
						|
 | 
						|
#define ASSEMBLY
 | 
						|
 | 
						|
#include <linux/config.h>
 | 
						|
#include <config.h>
 | 
						|
#include <asm/blackfin.h>
 | 
						|
 | 
						|
.global _stext;
 | 
						|
.global __bss_start;
 | 
						|
.global start;
 | 
						|
.global _start;
 | 
						|
.global _rambase;
 | 
						|
.global _ramstart;
 | 
						|
.global _ramend;
 | 
						|
.global _bf533_data_dest;
 | 
						|
.global _bf533_data_size;
 | 
						|
.global edata;
 | 
						|
.global _initialize;
 | 
						|
.global _exit;
 | 
						|
.global flashdataend;
 | 
						|
.global init_sdram;
 | 
						|
.global _icache_enable;
 | 
						|
.global _dcache_enable;
 | 
						|
#if defined(CONFIG_BF537)&&defined(CONFIG_POST)
 | 
						|
.global _memory_post_test;
 | 
						|
.global _post_flag;
 | 
						|
#endif
 | 
						|
 | 
						|
#if (BFIN_BOOT_MODE == BF537_UART_BOOT)
 | 
						|
#if (CONFIG_CCLK_DIV == 1)
 | 
						|
#define CONFIG_CCLK_ACT_DIV   CCLK_DIV1
 | 
						|
#endif
 | 
						|
#if (CONFIG_CCLK_DIV == 2)
 | 
						|
#define CONFIG_CCLK_ACT_DIV   CCLK_DIV2
 | 
						|
#endif
 | 
						|
#if (CONFIG_CCLK_DIV == 4)
 | 
						|
#define CONFIG_CCLK_ACT_DIV   CCLK_DIV4
 | 
						|
#endif
 | 
						|
#if (CONFIG_CCLK_DIV == 8)
 | 
						|
#define CONFIG_CCLK_ACT_DIV   CCLK_DIV8
 | 
						|
#endif
 | 
						|
#ifndef CONFIG_CCLK_ACT_DIV
 | 
						|
#define CONFIG_CCLK_ACT_DIV   CONFIG_CCLK_DIV_not_defined_properly
 | 
						|
#endif
 | 
						|
#endif
 | 
						|
 | 
						|
.text
 | 
						|
_start:
 | 
						|
start:
 | 
						|
_stext:
 | 
						|
 | 
						|
	R0 = 0x32;
 | 
						|
	SYSCFG = R0;
 | 
						|
	SSYNC;
 | 
						|
 | 
						|
	/* As per HW reference manual DAG registers,
 | 
						|
	 * DATA and Address resgister shall be zero'd
 | 
						|
	 * in initialization, after a reset state
 | 
						|
	 */
 | 
						|
	r1 = 0;	/* Data registers zero'd */
 | 
						|
	r2 = 0;
 | 
						|
	r3 = 0;
 | 
						|
	r4 = 0;
 | 
						|
	r5 = 0;
 | 
						|
	r6 = 0;
 | 
						|
	r7 = 0;
 | 
						|
 | 
						|
	p0 = 0; /* Address registers zero'd */
 | 
						|
	p1 = 0;
 | 
						|
	p2 = 0;
 | 
						|
	p3 = 0;
 | 
						|
	p4 = 0;
 | 
						|
	p5 = 0;
 | 
						|
 | 
						|
	i0 = 0; /* DAG Registers zero'd */
 | 
						|
	i1 = 0;
 | 
						|
	i2 = 0;
 | 
						|
	i3 = 0;
 | 
						|
	m0 = 0;
 | 
						|
	m1 = 0;
 | 
						|
	m3 = 0;
 | 
						|
	m3 = 0;
 | 
						|
	l0 = 0;
 | 
						|
	l1 = 0;
 | 
						|
	l2 = 0;
 | 
						|
	l3 = 0;
 | 
						|
	b0 = 0;
 | 
						|
	b1 = 0;
 | 
						|
	b2 = 0;
 | 
						|
	b3 = 0;
 | 
						|
 | 
						|
	/* Set loop counters to zero, to make sure that
 | 
						|
	 * hw loops are disabled.
 | 
						|
	 */
 | 
						|
	r0  = 0;
 | 
						|
	lc0 = r0;
 | 
						|
	lc1 = r0;
 | 
						|
 | 
						|
	SSYNC;
 | 
						|
 | 
						|
	/* Check soft reset status */
 | 
						|
	p0.h = SWRST >> 16;
 | 
						|
	p0.l = SWRST & 0xFFFF;
 | 
						|
	r0.l = w[p0];
 | 
						|
 | 
						|
	cc = bittst(r0, 15);
 | 
						|
	if !cc jump no_soft_reset;
 | 
						|
 | 
						|
	/* Clear Soft reset */
 | 
						|
	r0 = 0x0000;
 | 
						|
	w[p0] = r0;
 | 
						|
	ssync;
 | 
						|
 | 
						|
no_soft_reset:
 | 
						|
	nop;
 | 
						|
 | 
						|
	/* Clear EVT registers */
 | 
						|
	p0.h = (EVT_EMULATION_ADDR >> 16);
 | 
						|
	p0.l = (EVT_EMULATION_ADDR & 0xFFFF);
 | 
						|
	p0 += 8;
 | 
						|
	p1 = 14;
 | 
						|
	r1 = 0;
 | 
						|
	LSETUP(4,4) lc0 = p1;
 | 
						|
	[ p0 ++ ] = r1;
 | 
						|
 | 
						|
#if (BFIN_BOOT_MODE != BF537_SPI_MASTER_BOOT)
 | 
						|
	p0.h = hi(SIC_IWR);
 | 
						|
	p0.l = lo(SIC_IWR);
 | 
						|
	r0.l = 0x1;
 | 
						|
	w[p0] = r0.l;
 | 
						|
	SSYNC;
 | 
						|
#endif
 | 
						|
 | 
						|
#if (BFIN_BOOT_MODE == BF537_UART_BOOT)
 | 
						|
 | 
						|
	p0.h = hi(SIC_IWR);
 | 
						|
	p0.l = lo(SIC_IWR);
 | 
						|
	r0.l = 0x1;
 | 
						|
	w[p0] = r0.l;
 | 
						|
	SSYNC;
 | 
						|
 | 
						|
	/*
 | 
						|
	* PLL_LOCKCNT - how many SCLK Cycles to delay while PLL becomes stable
 | 
						|
	*/
 | 
						|
	p0.h = hi(PLL_LOCKCNT);
 | 
						|
	p0.l = lo(PLL_LOCKCNT);
 | 
						|
	r0 = 0x300(Z);
 | 
						|
	w[p0] = r0.l;
 | 
						|
	ssync;
 | 
						|
 | 
						|
	/*
 | 
						|
	* Put SDRAM in self-refresh, incase anything is running
 | 
						|
	*/
 | 
						|
	P2.H = hi(EBIU_SDGCTL);
 | 
						|
	P2.L = lo(EBIU_SDGCTL);
 | 
						|
	R0 = [P2];
 | 
						|
	BITSET (R0, 24);
 | 
						|
	[P2] = R0;
 | 
						|
	SSYNC;
 | 
						|
 | 
						|
	/*
 | 
						|
	*  Set PLL_CTL with the value that we calculate in R0
 | 
						|
	*   - [14:09] = MSEL[5:0] : CLKIN / VCO multiplication factors
 | 
						|
	*   - [8]     = BYPASS    : BYPASS the PLL, run CLKIN into CCLK/SCLK
 | 
						|
	*   - [7]     = output delay (add 200ps of delay to mem signals)
 | 
						|
	*   - [6]     = input delay (add 200ps of input delay to mem signals)
 | 
						|
	*   - [5]     = PDWN      : 1=All Clocks off
 | 
						|
	*   - [3]     = STOPCK    : 1=Core Clock off
 | 
						|
	*   - [1]     = PLL_OFF   : 1=Disable Power to PLL
 | 
						|
	*   - [0]     = DF	  : 1=Pass CLKIN/2 to PLL / 0=Pass CLKIN to PLL
 | 
						|
	*   all other bits set to zero
 | 
						|
	*/
 | 
						|
 | 
						|
	r0 = CONFIG_VCO_MULT & 63;      /* Load the VCO multiplier         */
 | 
						|
	r0 = r0 << 9;                   /* Shift it over,                  */
 | 
						|
	r1 = CONFIG_CLKIN_HALF;        /* Do we need to divide CLKIN by 2?*/
 | 
						|
	r0 = r1 | r0;
 | 
						|
	r1 = CONFIG_PLL_BYPASS;         /* Bypass the PLL?                 */
 | 
						|
	r1 = r1 << 8;                   /* Shift it over                   */
 | 
						|
	r0 = r1 | r0;                   /* add them all together           */
 | 
						|
 | 
						|
	p0.h = hi(PLL_CTL);
 | 
						|
	p0.l = lo(PLL_CTL);             /* Load the address                */
 | 
						|
	cli r2;                         /* Disable interrupts              */
 | 
						|
		ssync;
 | 
						|
	w[p0] = r0.l;                   /* Set the value                   */
 | 
						|
	idle;                           /* Wait for the PLL to stablize    */
 | 
						|
	sti r2;                         /* Enable interrupts               */
 | 
						|
 | 
						|
check_again:
 | 
						|
	p0.h = hi(PLL_STAT);
 | 
						|
	p0.l = lo(PLL_STAT);
 | 
						|
	R0 = W[P0](Z);
 | 
						|
	CC = BITTST(R0,5);
 | 
						|
	if ! CC jump check_again;
 | 
						|
 | 
						|
	/* Configure SCLK & CCLK Dividers */
 | 
						|
	r0 = (CONFIG_CCLK_ACT_DIV | CONFIG_SCLK_DIV);
 | 
						|
	p0.h = hi(PLL_DIV);
 | 
						|
	p0.l = lo(PLL_DIV);
 | 
						|
	w[p0] = r0.l;
 | 
						|
	ssync;
 | 
						|
#endif
 | 
						|
 | 
						|
	/*
 | 
						|
	 * We now are running at speed, time to set the Async mem bank wait states
 | 
						|
	 * This will speed up execution, since we are normally running from FLASH.
 | 
						|
	 * we need to read MAC address from FLASH
 | 
						|
	 */
 | 
						|
	p2.h = (EBIU_AMBCTL1 >> 16);
 | 
						|
	p2.l = (EBIU_AMBCTL1 & 0xFFFF);
 | 
						|
	r0.h = (AMBCTL1VAL >> 16);
 | 
						|
	r0.l = (AMBCTL1VAL & 0xFFFF);
 | 
						|
	[p2] = r0;
 | 
						|
	ssync;
 | 
						|
 | 
						|
	p2.h = (EBIU_AMBCTL0 >> 16);
 | 
						|
	p2.l = (EBIU_AMBCTL0 & 0xFFFF);
 | 
						|
	r0.h = (AMBCTL0VAL >> 16);
 | 
						|
	r0.l = (AMBCTL0VAL & 0xFFFF);
 | 
						|
	[p2] = r0;
 | 
						|
	ssync;
 | 
						|
 | 
						|
	p2.h = (EBIU_AMGCTL >> 16);
 | 
						|
	p2.l = (EBIU_AMGCTL & 0xffff);
 | 
						|
	r0 = AMGCTLVAL;
 | 
						|
	w[p2] = r0;
 | 
						|
	ssync;
 | 
						|
 | 
						|
#if ((BFIN_BOOT_MODE != BF537_SPI_MASTER_BOOT) && (BFIN_BOOT_MODE != BF537_UART_BOOT))
 | 
						|
	sp.l = (0xffb01000 & 0xFFFF);
 | 
						|
	sp.h = (0xffb01000 >> 16);
 | 
						|
 | 
						|
	call init_sdram;
 | 
						|
#endif
 | 
						|
 | 
						|
 | 
						|
#if defined(CONFIG_BF537)&&defined(CONFIG_POST)
 | 
						|
	/* DMA POST code to Hi of L1 SRAM */
 | 
						|
postcopy:
 | 
						|
	/* P1 Points to the beginning of SYSTEM MMR Space */
 | 
						|
	P1.H = hi(SYSMMR_BASE);
 | 
						|
	P1.L = lo(SYSMMR_BASE);
 | 
						|
 | 
						|
	R0.H = _text_l1;
 | 
						|
	R0.L = _text_l1;
 | 
						|
	R1.H = _etext_l1;
 | 
						|
	R1.L = _etext_l1;
 | 
						|
	R2 = R1 - R0;           /* Count */
 | 
						|
	R0.H = _etext;
 | 
						|
	R0.L = _etext;
 | 
						|
	R1.H = (CFG_MONITOR_BASE >> 16);
 | 
						|
	R1.L = (CFG_MONITOR_BASE & 0xFFFF);
 | 
						|
	R0 = R0 - R1;
 | 
						|
	R1.H = (CFG_FLASH_BASE >> 16);
 | 
						|
	R1.L = (CFG_FLASH_BASE & 0xFFFF);
 | 
						|
	R0 = R0 + R1;		/* Source Address */
 | 
						|
	R1.H = hi(L1_ISRAM);    /* Destination Address (high) */
 | 
						|
	R1.L = lo(L1_ISRAM);    /* Destination Address (low) */
 | 
						|
	R3.L = DMAEN;           /* Source DMAConfig Value (8-bit words) */
 | 
						|
	/* Destination DMAConfig Value (8-bit words) */
 | 
						|
	R4.L = (DI_EN | WNR | DMAEN);
 | 
						|
 | 
						|
	R6 = 0x1 (Z);
 | 
						|
	W[P1+OFFSET_(MDMA_S0_X_MODIFY)] = R6;   /* Source Modify = 1 */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_X_MODIFY)] = R6;   /* Destination Modify = 1 */
 | 
						|
 | 
						|
	[P1+OFFSET_(MDMA_S0_START_ADDR)] = R0;  /* Set Source Base Address */
 | 
						|
	W[P1+OFFSET_(MDMA_S0_X_COUNT)] = R2;    /* Set Source Count */
 | 
						|
	/* Set Source  DMAConfig = DMA Enable,
 | 
						|
	Memory Read,  8-Bit Transfers, 1-D DMA, Flow - Stop */
 | 
						|
	W[P1+OFFSET_(MDMA_S0_CONFIG)] = R3;
 | 
						|
 | 
						|
	[P1+OFFSET_(MDMA_D0_START_ADDR)] = R1;  /* Set Destination Base Address */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_X_COUNT)] = R2;    /* Set Destination Count */
 | 
						|
	/* Set Destination DMAConfig = DMA Enable,
 | 
						|
	Memory Write, 8-Bit Transfers, 1-D DMA, Flow - Stop, IOC */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_CONFIG)] = R4;
 | 
						|
 | 
						|
POST_DMA_DONE:
 | 
						|
	p0.h = hi(MDMA_D0_IRQ_STATUS);
 | 
						|
	p0.l = lo(MDMA_D0_IRQ_STATUS);
 | 
						|
	R0 = W[P0](Z);
 | 
						|
	CC = BITTST(R0, 0);
 | 
						|
	if ! CC jump POST_DMA_DONE
 | 
						|
 | 
						|
	R0 = 0x1;
 | 
						|
	W[P1+OFFSET_(MDMA_D0_IRQ_STATUS)] = R0; /* Write 1 to clear DMA interrupt */
 | 
						|
 | 
						|
	/* DMA POST data to Hi of L1 SRAM */
 | 
						|
	R0.H = _rodata_l1;
 | 
						|
	R0.L = _rodata_l1;
 | 
						|
	R1.H = _erodata_l1;
 | 
						|
	R1.L = _erodata_l1;
 | 
						|
	R2 = R1 - R0;           /* Count */
 | 
						|
	R0.H = _erodata;
 | 
						|
	R0.L = _erodata;
 | 
						|
	R1.H = (CFG_MONITOR_BASE >> 16);
 | 
						|
	R1.L = (CFG_MONITOR_BASE & 0xFFFF);
 | 
						|
	R0 = R0 - R1;
 | 
						|
	R1.H = (CFG_FLASH_BASE >> 16);
 | 
						|
	R1.L = (CFG_FLASH_BASE & 0xFFFF);
 | 
						|
	R0 = R0 + R1;           /* Source Address */
 | 
						|
	R1.H = hi(DATA_BANKB_SRAM);    /* Destination Address (high) */
 | 
						|
	R1.L = lo(DATA_BANKB_SRAM);    /* Destination Address (low) */
 | 
						|
	R3.L = DMAEN;           /* Source DMAConfig Value (8-bit words) */
 | 
						|
	R4.L = (DI_EN | WNR | DMAEN);   /* Destination DMAConfig Value (8-bit words) */
 | 
						|
 | 
						|
	R6 = 0x1 (Z);
 | 
						|
	W[P1+OFFSET_(MDMA_S0_X_MODIFY)] = R6;   /* Source Modify = 1 */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_X_MODIFY)] = R6;   /* Destination Modify = 1 */
 | 
						|
 | 
						|
	[P1+OFFSET_(MDMA_S0_START_ADDR)] = R0;  /* Set Source Base Address */
 | 
						|
	W[P1+OFFSET_(MDMA_S0_X_COUNT)] = R2;    /* Set Source Count */
 | 
						|
	/* Set Source  DMAConfig = DMA Enable,
 | 
						|
	Memory Read,  8-Bit Transfers, 1-D DMA, Flow - Stop */
 | 
						|
	W[P1+OFFSET_(MDMA_S0_CONFIG)] = R3;
 | 
						|
 | 
						|
	[P1+OFFSET_(MDMA_D0_START_ADDR)] = R1;  /* Set Destination Base Address */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_X_COUNT)] = R2;    /* Set Destination Count */
 | 
						|
	/* Set Destination DMAConfig = DMA Enable,
 | 
						|
	Memory Write, 8-Bit Transfers, 1-D DMA, Flow - Stop, IOC */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_CONFIG)] = R4;
 | 
						|
 | 
						|
POST_DATA_DMA_DONE:
 | 
						|
	p0.h = hi(MDMA_D0_IRQ_STATUS);
 | 
						|
	p0.l = lo(MDMA_D0_IRQ_STATUS);
 | 
						|
	R0 = W[P0](Z);
 | 
						|
	CC = BITTST(R0, 0);
 | 
						|
	if ! CC jump POST_DATA_DMA_DONE
 | 
						|
 | 
						|
	R0 = 0x1;
 | 
						|
	W[P1+OFFSET_(MDMA_D0_IRQ_STATUS)] = R0; /* Write 1 to clear DMA interrupt */
 | 
						|
 | 
						|
	p0.l = _memory_post_test;
 | 
						|
	p0.h = _memory_post_test;
 | 
						|
	r0 = 0x0;
 | 
						|
	call (p0);
 | 
						|
	r7 = r0;				/* save return value */
 | 
						|
 | 
						|
	call init_sdram;
 | 
						|
#endif
 | 
						|
 | 
						|
	/* relocate into to RAM */
 | 
						|
	call get_pc;
 | 
						|
offset:
 | 
						|
	r2.l = offset;
 | 
						|
	r2.h = offset;
 | 
						|
	r3.l = start;
 | 
						|
	r3.h = start;
 | 
						|
	r1 = r2 - r3;
 | 
						|
 | 
						|
	r0 = r0 - r1;
 | 
						|
	p1 = r0;
 | 
						|
 | 
						|
	p2.l = (CFG_MONITOR_BASE & 0xffff);
 | 
						|
	p2.h = (CFG_MONITOR_BASE >> 16);
 | 
						|
 | 
						|
	p3 = 0x04;
 | 
						|
	p4.l = ((CFG_MONITOR_BASE + CFG_MONITOR_LEN) & 0xffff);
 | 
						|
	p4.h = ((CFG_MONITOR_BASE + CFG_MONITOR_LEN) >> 16);
 | 
						|
loop1:
 | 
						|
	r1 = [p1 ++ p3];
 | 
						|
	[p2 ++ p3] = r1;
 | 
						|
	cc=p2==p4;
 | 
						|
	if !cc jump loop1;
 | 
						|
	/*
 | 
						|
	 * configure STACK
 | 
						|
	 */
 | 
						|
	r0.h = (CONFIG_STACKBASE >> 16);
 | 
						|
	r0.l = (CONFIG_STACKBASE & 0xFFFF);
 | 
						|
	sp = r0;
 | 
						|
	fp = sp;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * This next section keeps the processor in supervisor mode
 | 
						|
	 * during kernel boot.  Switches to user mode at end of boot.
 | 
						|
	 * See page 3-9 of Hardware Reference manual for documentation.
 | 
						|
	 */
 | 
						|
 | 
						|
	/* To keep ourselves in the supervisor mode */
 | 
						|
	p0.l = (EVT_IVG15_ADDR & 0xFFFF);
 | 
						|
	p0.h = (EVT_IVG15_ADDR >> 16);
 | 
						|
 | 
						|
	p1.l = _real_start;
 | 
						|
	p1.h = _real_start;
 | 
						|
	[p0] = p1;
 | 
						|
 | 
						|
	p0.l = (IMASK & 0xFFFF);
 | 
						|
	p0.h = (IMASK >> 16);
 | 
						|
	r0.l = LO(IVG15_POS);
 | 
						|
	r0.h = HI(IVG15_POS);
 | 
						|
	[p0] = r0;
 | 
						|
	raise 15;
 | 
						|
	p0.l = WAIT_HERE;
 | 
						|
	p0.h = WAIT_HERE;
 | 
						|
	reti = p0;
 | 
						|
	rti;
 | 
						|
 | 
						|
WAIT_HERE:
 | 
						|
	jump WAIT_HERE;
 | 
						|
 | 
						|
.global _real_start;
 | 
						|
_real_start:
 | 
						|
	[ -- sp ] = reti;
 | 
						|
 | 
						|
#ifdef CONFIG_BF537
 | 
						|
/* Initialise General-Purpose I/O Modules on BF537
 | 
						|
 * Rev 0.0 Anomaly 05000212 - PORTx_FER,
 | 
						|
 * PORT_MUX Registers Do Not accept "writes" correctly
 | 
						|
 */
 | 
						|
	p0.h = hi(PORTF_FER);
 | 
						|
	p0.l = lo(PORTF_FER);
 | 
						|
	R0.L = W[P0]; /* Read */
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	ssync;
 | 
						|
	R0 = 0x000F(Z);
 | 
						|
	W[P0] = R0.L; /* Write */
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	ssync;
 | 
						|
	W[P0] = R0.L; /* Enable peripheral function of PORTF for UART0 and UART1 */
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	ssync;
 | 
						|
 | 
						|
	p0.h = hi(PORTH_FER);
 | 
						|
	p0.l = lo(PORTH_FER);
 | 
						|
	R0.L = W[P0]; /* Read */
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	ssync;
 | 
						|
	R0 = 0xFFFF(Z);
 | 
						|
	W[P0] = R0.L; /* Write */
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	ssync;
 | 
						|
	W[P0] = R0.L; /* Enable peripheral function of PORTH for MAC */
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	nop;
 | 
						|
	ssync;
 | 
						|
 | 
						|
#endif
 | 
						|
 | 
						|
	/* DMA reset code to Hi of L1 SRAM */
 | 
						|
copy:
 | 
						|
	P1.H = hi(SYSMMR_BASE);	/* P1 Points to the beginning of SYSTEM MMR Space */
 | 
						|
	P1.L = lo(SYSMMR_BASE);
 | 
						|
 | 
						|
	R0.H = reset_start;	/* Source Address (high) */
 | 
						|
	R0.L = reset_start;	/* Source Address (low) */
 | 
						|
	R1.H = reset_end;
 | 
						|
	R1.L = reset_end;
 | 
						|
	R2 = R1 - R0;		/* Count */
 | 
						|
	R1.H = hi(L1_ISRAM);	/* Destination Address (high) */
 | 
						|
	R1.L = lo(L1_ISRAM);	/* Destination Address (low) */
 | 
						|
	R3.L = DMAEN;		/* Source DMAConfig Value (8-bit words) */
 | 
						|
	R4.L = (DI_EN | WNR | DMAEN);	/* Destination DMAConfig Value (8-bit words) */
 | 
						|
 | 
						|
DMA:
 | 
						|
	R6 = 0x1 (Z);
 | 
						|
	W[P1+OFFSET_(MDMA_S0_X_MODIFY)] = R6;	/* Source Modify = 1 */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_X_MODIFY)] = R6;	/* Destination Modify = 1 */
 | 
						|
 | 
						|
	[P1+OFFSET_(MDMA_S0_START_ADDR)] = R0;	/* Set Source Base Address */
 | 
						|
	W[P1+OFFSET_(MDMA_S0_X_COUNT)] = R2;	/* Set Source Count */
 | 
						|
	/* Set Source  DMAConfig = DMA Enable,
 | 
						|
	Memory Read,  8-Bit Transfers, 1-D DMA, Flow - Stop */
 | 
						|
	W[P1+OFFSET_(MDMA_S0_CONFIG)] = R3;
 | 
						|
 | 
						|
	[P1+OFFSET_(MDMA_D0_START_ADDR)] = R1;	/* Set Destination Base Address */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_X_COUNT)] = R2;	/* Set Destination Count */
 | 
						|
	/* Set Destination DMAConfig = DMA Enable,
 | 
						|
	Memory Write, 8-Bit Transfers, 1-D DMA, Flow - Stop, IOC */
 | 
						|
	W[P1+OFFSET_(MDMA_D0_CONFIG)] = R4;
 | 
						|
 | 
						|
WAIT_DMA_DONE:
 | 
						|
	p0.h = hi(MDMA_D0_IRQ_STATUS);
 | 
						|
	p0.l = lo(MDMA_D0_IRQ_STATUS);
 | 
						|
	R0 = W[P0](Z);
 | 
						|
	CC = BITTST(R0, 0);
 | 
						|
	if ! CC jump WAIT_DMA_DONE
 | 
						|
 | 
						|
	R0 = 0x1;
 | 
						|
	W[P1+OFFSET_(MDMA_D0_IRQ_STATUS)] = R0;	/* Write 1 to clear DMA interrupt */
 | 
						|
 | 
						|
	/* Initialize BSS Section with 0 s */
 | 
						|
	p1.l = __bss_start;
 | 
						|
	p1.h = __bss_start;
 | 
						|
	p2.l = _end;
 | 
						|
	p2.h = _end;
 | 
						|
	r1 = p1;
 | 
						|
	r2 = p2;
 | 
						|
	r3 = r2 - r1;
 | 
						|
	r3 = r3 >> 2;
 | 
						|
	p3 = r3;
 | 
						|
	lsetup (_clear_bss, _clear_bss_end ) lc1 = p3;
 | 
						|
	CC = p2<=p1;
 | 
						|
	if CC jump _clear_bss_skip;
 | 
						|
	r0 = 0;
 | 
						|
_clear_bss:
 | 
						|
_clear_bss_end:
 | 
						|
	[p1++] = r0;
 | 
						|
_clear_bss_skip:
 | 
						|
 | 
						|
#if defined(CONFIG_BF537)&&defined(CONFIG_POST)
 | 
						|
	p0.l = _post_flag;
 | 
						|
	p0.h = _post_flag;
 | 
						|
	r0   = r7;
 | 
						|
	[p0] = r0;
 | 
						|
#endif
 | 
						|
 | 
						|
	p0.l = _start1;
 | 
						|
	p0.h = _start1;
 | 
						|
	jump (p0);
 | 
						|
 | 
						|
reset_start:
 | 
						|
	p0.h = WDOG_CNT >> 16;
 | 
						|
	p0.l = WDOG_CNT & 0xffff;
 | 
						|
	r0 = 0x0010;
 | 
						|
	w[p0] = r0;
 | 
						|
	p0.h = WDOG_CTL >> 16;
 | 
						|
	p0.l = WDOG_CTL & 0xffff;
 | 
						|
	r0 = 0x0000;
 | 
						|
	w[p0] = r0;
 | 
						|
reset_wait:
 | 
						|
	jump reset_wait;
 | 
						|
 | 
						|
reset_end:
 | 
						|
	nop;
 | 
						|
 | 
						|
_exit:
 | 
						|
	jump.s	_exit;
 | 
						|
get_pc:
 | 
						|
	r0 = rets;
 | 
						|
	rts;
 |