积分分离PID控制算法程序.doc

积分分离PID控制算法程序.doc

ID:55781208

大小:43.00 KB

页数:26页

时间:2020-06-07

积分分离PID控制算法程序.doc_第1页
积分分离PID控制算法程序.doc_第2页
积分分离PID控制算法程序.doc_第3页
积分分离PID控制算法程序.doc_第4页
积分分离PID控制算法程序.doc_第5页
资源描述:

《积分分离PID控制算法程序.doc》由会员上传分享,免费在线阅读,更多相关内容在工程资料-天天文库

1、积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分

2、分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离

3、PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离PID控制算法程序2007-01-0515:23积分分离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 00

4、00HE 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 

5、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.001的BCD码浮点数; MOV E+1,#10H; MOV E+2,#00HMOV E,#00H ;阈值为0.3MOV E+1,#30HMOV E+2,#00HMOV 3CH,#01H ;常

6、数1的BCD码浮点数MOV 3DH,#10HMOV 3EH,#00HMOV 40H,#01H ;常数2的BCD码浮点数MOV 41H,#20HMOV 42H,#00HMOV 30H,#01H ;T 2.34的BCD 码浮点数MOV 31H,#23HMOV 32H,#40HMOV 33H,#01H ;Td 3.54的BCD码浮点数MOV 34H,#35HMOV 35H,#40HMOV 36H,#01H ;Ti 1.12的BCD码浮点数MOV 37H,#11HMOV 38H,#20HMOV 39H,#01H

7、 ;Kp 1.25的BCD码浮点数MOV 3AH,#12HMOV 3BH,#50HMOV R0,#E ; 将其转换成二进制浮点操作数LCALL BTOFMOV R0,#RKLCALL BTOFMOV R0,#3CHLCALL BTOFMOV R0,#40HLCALL BTOFMOV R0,#39HLCALL BTOFMOV R0,#36HLCALL BTOF ;将其转换成二进制浮点操作数MOV R0,#33H ;指向BCD码浮点操作数TdLCALL BTOF ;将其转换成二进制浮点操作数MOV R0,#

8、30H ;指向BCD码浮点操作数TLCALL BTOF ;将其转换成二进制浮点操作数MOV R1, #BUFFR0 ;保存30H中的值 即T值LCALL FMOVR0MOV R1, #36H ;计算A值(1+T/Ti+Td/T).KpLCALL FDIVMOV R1,#3CH ;常数1LCALL FADDMOV R0,#33H ;保存33H中的值MOV R1,#BUFFLCALL FMOVR0MOV R1,#BUFFR0LCALL FDIV

当前文档最多预览五页,下载文档查看全文

此文档下载收益归作者所有

当前文档最多预览五页,下载文档查看全文
温馨提示:
1. 部分包含数学公式或PPT动画的文件,查看预览时可能会显示错乱或异常,文件下载后无此问题,请放心下载。
2. 本文档由用户上传,版权归属用户,天天文库负责整理代发布。如果您对本文档版权有争议请及时联系客服。
3. 下载前请仔细阅读文档内容,确认文档内容符合您的需求后进行下载,若出现内容与标题不符可向本站投诉处理。
4. 下载文档时可能由于网络波动等原因无法下载或下载错误,付费完成后未能成功下载的用户请联系客服处理。