en_drivea.asm

这个是关于实现同步电机FOC的控制程序源代码

********************************************************************
; 文件名: en_drive.asm
; 模块名: en_drive, dis_drive
; 初始化程序名: drive_init
;
; 公司: 达盛科技
;
; 功能描述: 设置IO引脚，使能或禁止驱动模块,此程序在系统中未使用，只提
;			供一种控制思路。
; 目标板cup: X2407
;====================================================================
; 更改记录
;--------------------------------------------------------------------
; 2005.08.10	版本：Ver 1.0	
;*****************************************************
; 外围变量定义
;*****************************************************
		.include	"x24x_app.h"
;*****************************************************
; 标号定义
;*****************************************************
		.def	EN_DRIVE		;
		.def	DIS_DRIVE		;
		.def	DRIVE_INIT		;

		.text
;******************************************************
; 主程序代码开始
;******************************************************
DRIVE_INIT

		; IOPB4: strobe_; IOPB6: enable_
		ldp	#OCRA>>7		;
		lacc	OCRA		;
		and	#0afffH			; config IOPB4&6 as IO
		sacl	OCRA		;
		lacc	PBDATDIR	;
		or	#05050h 		; config IOPB4 & IOPB6 as Outputs
		sacl	PBDATDIR	; and output "1" to disable drive
		ret

EN_DRIVE

		ldp	#PBDATDIR>>7
		lacc	PBDATDIR	; Get Port B
		and	#0ffefh 		; IOPB4 low
		sacl	PBDATDIR	;
		or	#00010h 		; IOPB4 high
		sacl	PBDATDIR	;
		and	#0ffbfh 		; IOPB6 low
		sacl	PBDATDIR	;
		ret

DIS_DRIVE

		ldp	#PBDATDIR>>7	;
		lacc	PBDATDIR	; Get Port B
		or	#05050h 		; IOPB4 & IOPB6 Output "1"
		sacl	PBDATDIR	;
		ret