************************************************
* FileName:		ex5.asm                        *
* Description:	步進電機控制實驗               *
* Copyright(C) SanZhi Electronic, Author Zpin  *
************************************************



		.title 	"ex5"
		.global _c_int00
		.mmregs

BJ_ADD		.set 1008h

BJ_DIRECT	.set	60h
BJ_SPEED	.set	61h

		.data
		.byte 0eh,0dh,0bh,07h

		.sect ".vectors"
reset:	B _c_int00		
		NOP
		NOP
		.space 4*127
		
		.text
_c_int00:
		LD #0h,DP
		STM #3000h,SP
		SSBX INTM
		RSBX SXM
		ST #07FFFh,SWWSR
        ST #0h,CLKMD
TST     BITF CLKMD,#1H
        BC TST,TC        
		ST #1087h,CLKMD			;切換到PLL*2模式
		RPT #0FFh               ;等待切換完成
		NOP

		ST #04h,BK				;置循環緩沖區大小
		ST #2000h,AR0			;置循環緩沖區首地址
		
		ST #00h,BJ_DIRECT		;電機旋轉方向
		ST #05h,BJ_SPEED		;電機旋轉速度
		
read	LD #speed0,B			;判斷速度
		ADD BJ_SPEED,2,B,B
		BACC B

speed0	ST #6fh,AR6				;速度0
		B direct

speed1	ST #4fh,AR6				;速度1
		B direct

speed2	ST #2fh,AR6				;速度2
		B direct

speed3	ST #1fh,AR6				;速度3
		B direct

speed4	ST #0ch,AR6				;速度4
		B direct

speed5	ST #07h,AR6				;速度5

direct	BITF BJ_DIRECT,#01h		;判斷方向
		BC start1,TC

start0	CALL delay
		PORTW *AR0+%,BJ_ADD		;正轉
		B read

start1	CALL delay
		PORTW *AR0-%,BJ_ADD		;反轉
		B read


delay	ST #0d00h,AR7			;延時子程序
		BANZ $,*AR7-
		BANZ delay,*AR6-
		RET