amplitude.asm

来自「变频器程序」· 汇编 代码 · 共 37 行

            .def    _amplitute 

;>>>> 	 unsigned int amplitute(unsigned int a,unsigned int b)
******************************************************
* FUNCTION DEF : _amplitute
******************************************************
_amplitute:

LF43	.set	0

	POPD	*+
	SAR	AR0,*+
	SAR	AR1,*
	LARK	AR0,2
	LAR	AR0,*0+,AR2

	 LARK	AR2,-3+LF43
	 MAR	*0+
     LT      *-              ; TREG=a in scaled Q15 format 
     MPY     *	             ; Convert b from scaled Q15 to radians
                             ; P= a*b(Q30) 
     PAC                     ; ACC=a*b(Q30)
     SACH    *,1 			; Store ACC in Q15 format
     LACC    *

EPI0_43:
	.line	7
	MAR	* ,AR1
	SBRK	3
	LAR	AR0,*-
	PSHD	*
	RET