*********************************************************
*畢業(yè)設(shè)計(jì)						*
*FILENAME:initdsp.asm					*
*This file initiates main registers of c5409		*
*copyright reserved by 彭洪  2-6-2005			*
*							*
*********************************************************
	.include "initdsp.inc"
	.global  _initdsp
	.mmregs
	.sect ".text" ;此段放入.text段中
	
	
_initdsp:
	ssbx intm               ;close all interrupt
	stm  #0000h,ifr         ;clear all interrupt_flag
	stm  #K_IMR_AD_OFF,imr  ;載入中斷設(shè)置（關(guān)閉AD）	
	stm  #K_SWWSR,swwsr     ;初始化swwsr
	stm  #K_ST0,st0         ;初始化st0
	stm  #K_ST1,st1         ;初始化st1
	stm  #K_PMST,pmst       ;初始化pmst,中斷向量表放在2780h
	stm  #K_TCR,tcr         ;初始化定時器控制寄存器
	;stm  #3800h,sp
*********************************************************
*添加的測試部分                                         *
*********************************************************
TEST_XF:
	stm #0,brc
	rptb bbb-1
	rsbx xf
	ld   #3,a
Softloop3b:
	sub  #1,a
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	bc   Softloop3b,ANEQ
	ssbx xf
	ld   #3,a
Softloop3a:
	sub  #1,a
	nop
	nop
	nop
	nop
	nop	
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	nop
	bc   Softloop3a,ANEQ
	nop
bbb:
	rsbx intm               ;開中斷
	ret