MLLP2:
MOV R2,BCPCHH
MOV R3,BCPCHL
MOV R4,#0 ;求kp*e(t)
MOV R5,#0
MOV R6,#0
MOV R7,BLXS
CALL MULD
MOV BLCSL,R5 ;结果送到比例常数存储
MOV BLCSH,R4
MOV R3,PCWFL
MOV R2,PCWFH
MOV R4,#0
MOV R5,#0
MOV R6,#0
MOV R7,WFXS
CALL MULD ;求kd*(e(t)-e(t-1))
MOV WFCSL,R5
MOV WFCSH,R4 ;结果送到微分常数存储
JB BLPCFH,FOOL2 ;比例相为负,不计算结果,直接赋pouth=#00 poutl=#200,退出中断
JB WFPCFH,AOOL2 ;微分项为负转走
CLR C
MOV A,BLCSL
ADD A,WFCSL ;KP>0,KD>0
MOV ZSJCSL,A ;将结果存入总时间常数中 kp*e(t)+kd*(e(t)-e(t-1))
MOV A,BLCSH
上一页 [1] [2] [3] [4] [5] [6] [7] 下一页
本文关键字:程序 51单片机,单片机-工控设备 - 51单片机