45
ACALL CPL1
ACALL DSUB ;求E(K)-E(K-1) MOV R5,33H
MOV R4,34H ;取Kp参数 MOV R0,#46H
ACALL MULT1 MOV R5,49H MOV R4,48H MOV R3,4DH MOV R2,4CH
ACALL DSUM ; MOV 4AH,R7
MOV 4BH,R6 MOV R5,39H
MOV R4,3AH ; MOV R3,3DH
MOV R2,3EH ACALL DSUM MOV A，R7 MOV R5，A MOV A，R6 MOV R4，A MOV R3,3BH
MOV R2,3CH ; ACALL CPL1
ACALL DSUM MOV A，R7 MOV R5，A MOV A，R6 MOV R4，A MOV R3，3BH MOV R2，3CH 求Kp*[E(K)-E(K-1)] 求Kp*[E(K)-E(K-1)]+KI*E(K) 保存上式之和 取E(K) 取E(K-2) 计算E(K)+E(K-2) 取E(k-1) 求出E(K)+E(K-2)-2*E(K-1) ; ; ; ; ;
46
ACALL CPL1 ACALL DSUM MOV R5,37H
MOV R4,38H ;取Kd参数 MOV R0,#46H
ACALL MULT1 MOV R5,49H
MOV R4,48H ; MOV R3,4AH
MOV R2,4BH ; ACALL DSUM ; MOV A,R7 MOV R3，A
MOV A,R6 ; MOV R2，A MOV R5,2FH
MOV R4,30H ; ACALL DSUM ; MOV 2FH,R7
MOV 30H,R6 ; MOV 29H，2FH MOV 3DH,3BH
MOV 3EH,3CH ; MOV 3BH,39H
MOV 3CH,3AH ; MOV A，31H ; CJNE A，2AH，AA2 AA3: CLR 20H ; AA1: RET AA2: JNC AA3 SETB 20H MOV R3,39H
;求出Pd=Kd*[E(K)+E(K-2)-2*E(K-1)] 取Pd 取Kp*[E(K)-E(K-1)]+KI*E(K) 计算Pd+PI 取Pd+PI 取P(k-1)
求P(K)=Pd+Pp+P(K-1) 存P(k)到P(k-1) 存E(K-1)到E(K-2) 存E(K)到E(k-1) 取设定值
;比较设定值与实测值 清电炉标志
47
MOV R2,3AH LCALL CPL1 MOV A,R3 MOV R7,A MOV A,R2 MOV R6,A MOV R5,42H MOV R4,43H MOV R0,#5AH
ACALL MULI1 ;计算P`=K*E(K),且结果防在51H,50H单元中 MOV 28H,5BH ;取8位有效值，放到28H单元中 AJMP AA1
**********************************************************
DSUM: MOV A,R4 ;［双字节加法子程序］：(R5R4)+(R3R2)-->(R7R6) ADD A,R2 MOV R6,A MOV A,R5 ADDC A,R3 MOV R7,A RET
**********************************************************
CPL1: MOV A,R2 ;［双字节求补子程序］：(R3R2)求补 CPL A ADD A,#01H MOV R2,A MOV A,R3 CPL A ADDC A,#00H MOV R3,A RET
**********************************************************
MULT1: MOV A,R7 ;［双字节有符号数乘法］：被乘数(R7R6),乘数(R5R4) RLC A
48
MOV 5CH,C ;被乘数符号C1-->5CH位 JNC POS1 ;为正数则转 MOV A,R6 ;为负数则求补 CPL A ADD A,#01H MOV R6,A MOV A,R7 CPL A ADDC A,#00H MOV R7,A
POS1: MOV A,R5 ; RLC A ; MOV 5DH,C
JNC POS2 ; MOV A,R4 CPL A ADD A,#01H MOV R4,A MOV A,R5 CPL A ADDC A,#00H MOV R5,A
POS2: ACALL MULT MOV C，5CH ANL C,5DH
JC TPL MOV C,5CH ORL C,5DH
JNC TPL ; DEC R0 MOV A,@R0 CPL A ADD A,#01H
取乘数
乘数符号C2-->5DH位 为整数则转 调双字节无符号数乘法子程序 负负相乘则转 正正相乘则转 ; ;
