增量式 PID 控制算法程序 (A51)
点击数：2146 发布日期：2006-9-22 17:12:00
【收藏】 【评论】 【打印】 【编程爱好者论坛】 【关闭】
;********增量式 PID 控制算法程序***********
;T、TD、TI、KP 依次从 30H，33H，36H，39H 开始。
;A，B，C 的值依次存在 BLOCK1，BLOCK2，BLOCK3 的地址里
; 这里 R(k)给的是定值
;
ORG 0000H
BLOCK1 EQU 43H ;A,B ,C
BLOCK2 EQU 46H
BLOCK3 EQU 49H
UK EQU 4CH ;存结果 UK
RK EQU 50H
EK EQU 53H ;存放偏差值 E(k)的始址
EK1 EQU 56H ;存放 E(k-1)的始址
EK2 EQU 59H ;存放 E(k-2)的始址
CK EQU 5CH ;采样数据始址
BUFF EQU 60H ;暂存区
BUFF1 EQU 63H
BUFF2 EQU 66H
REC EQU 69H
TEST:
MOV RK,#01H ;常数 Rk 的 BCD 码浮点数
MOV RK+1,#12H ;1.25
MOV RK+2,#50H
MOV 3CH,#01H ;常数 1 的 BCD 码浮点数
MOV 3DH,#10H
MOV 3EH,#00H
MOV 40H,#01H ;常数 2 的 BCD 码浮点数
MOV 41H,#20H
MOV 42H,#00H
MOV 30H,#01H ;T 的 BCD 码浮点数
MOV 31H,#23H ;2.34
MOV 32H,#40H
MOV 33H,#01H ;Td 的 BCD 码浮点数
MOV 34H,#35H ;3.54
MOV 35H,#40H
MOV 36H,#01H ;Ti 的 BCD 码浮点数
评论0