资源描述:
《积分分离pid控制算法程序》由会员上传分享,免费在线阅读,更多相关内容在行业资料-天天文库。
1、积分分离PID控制算法程序2007-01-0515:23;**********P10,积分分离PID控制算法程序 ********;T、TD、TI、KP依次从30H,33H,36H,39H开始。;A,B,C,A',的值依次存在BLOCK1,BLOCK2,BLOCK3 BLOCK4 的地址里;这里B'与C值相同; 这里R(k)给的是定值ORG 0000HE EQU 20H ; 一阈值GK EQU 23H ;G(k)GK1 EQU 26H ;G(k-1)FK EQU 29H ;F(k)FK1 EQU 2CH ;F(k-1)BLOCK1 EQU 50H ;ABLOCK2 EQU 53H
2、;BBLOCK3 EQU 56H ;CBLOCK4 EQU 5AH ;A'UK EQU 5DH ;存放结果BUFF EQU 43H ;暂存区BUFF1 EQU 46HBUFF2 EQU 49HBUFFR0 EQU 4CHREC EQU 63H ;采样次数RK EQU 66H ;R(k)CK EQU 69H ;采样数据始址EK EQU 6CH ;存放偏差值E(k)的始址EK1 EQU 70H ;存放E(k-1)的始址TEST: MOV RK,#01H ;常数Rk 1.25的BCD码浮点数MOV RK+1,#12HMOV RK+2,#50H; MOV E,#7EH ;设定一阈值0.00
3、1的BCD码浮点数; MOV E+1,#10H; MOV E+2,#00HMOV E,#00H ;阈值为0.3MOV E+1,#30HMOV E+2,#00HMOV 3CH,#01H ;常数1的BCD码浮点数MOV 3DH,#10HMOV 3EH,#00HMOV 40H,#积分分离PID控制算法程序2007-01-0515:23;**********P10,积分分离PID控制算法程序 ********;T、TD、TI、KP依次从30H,33H,36H,39H开始。;A,B,C,A',的值依次存在BLOCK1,BLOCK2,BLOCK3 BLOCK4 的地址里;这里B'与C值相同;
4、这里R(k)给的是定值ORG 0000HE EQU 20H ; 一阈值GK EQU 23H ;G(k)GK1 EQU 26H ;G(k-1)FK EQU 29H ;F(k)FK1 EQU 2CH ;F(k-1)BLOCK1 EQU 50H ;ABLOCK2 EQU 53H ;BBLOCK3 EQU 56H ;CBLOCK4 EQU 5AH ;A'UK EQU 5DH ;存放结果BUFF EQU 43H ;暂存区BUFF1 EQU 46HBUFF2 EQU 49HBUFFR0 EQU 4CHREC EQU 63H ;采样次数RK EQU 66H ;R(k)CK EQU 69H ;采样
5、数据始址EK EQU 6CH ;存放偏差值E(k)的始址EK1 EQU 70H ;存放E(k-1)的始址TEST: MOV RK,#01H ;常数Rk 1.25的BCD码浮点数MOV RK+1,#12HMOV RK+2,#50H; MOV E,#7EH ;设定一阈值0.001的BCD码浮点数; MOV E+1,#10H; MOV E+2,#00HMOV E,#00H ;阈值为0.3MOV E+1,#30HMOV E+2,#00HMOV 3CH,#01H ;常数1的BCD码浮点数MOV 3DH,#10HMOV 3EH,#00HMOV 40H,#积分分离PID控制算法程序2007-01
6、-0515:23;**********P10,积分分离PID控制算法程序 ********;T、TD、TI、KP依次从30H,33H,36H,39H开始。;A,B,C,A',的值依次存在BLOCK1,BLOCK2,BLOCK3 BLOCK4 的地址里;这里B'与C值相同; 这里R(k)给的是定值ORG 0000HE EQU 20H ; 一阈值GK EQU 23H ;G(k)GK1 EQU 26H ;G(k-1)FK EQU 29H ;F(k)FK1 EQU 2CH ;F(k-1)BLOCK1 EQU 50H ;ABLOCK2 EQU 53H ;BBLOCK3 EQU 56H ;CB
7、LOCK4 EQU 5AH ;A'UK EQU 5DH ;存放结果BUFF EQU 43H ;暂存区BUFF1 EQU 46HBUFF2 EQU 49HBUFFR0 EQU 4CHREC EQU 63H ;采样次数RK EQU 66H ;R(k)CK EQU 69H ;采样数据始址EK EQU 6CH ;存放偏差值E(k)的始址EK1 EQU 70H ;存放E(k-1)的始址TEST: MOV RK,#01H ;常数Rk 1.25的BCD码浮点数MOV RK+1,#1