河南城建计控个人总结.docVIP

算术平均滤波程序清单： AAFILTER:LD AX,#DATA;初始化 LD DX,#NUMB; CLR BX; CLR CX; LOOP: ADD BX,[AX]+;采样值累加 ADDC CX,00H; DJNZ DX,LOOP; DIV BX,#NUMB;求算术平均值 LD RESULT1，BX;输出结果 RET;返回 中值滤波程序清单： IVFILTER:LD DX,#NUMB;设置排队大循环次数 DEC DX; LOOPG:LD EX,DX;宋小循环次数 LD BX,#DATA LOOPL: LD AX,[BX];[BX][BX]+2? CMP AX,02H [BX]; JLE NEXT; LD CX,02H [BX];[BX][BX]+2则 ST AX,02H [BX];[BX]与[BX]+2交换位置 ST CX,[BX]; NEXT:INC BX;修改地址 INC BX; DJNZ EX,LOOPL;小循环结束？ DJNZ DX,LOOPG;大循环结束？ LD AX,#NUMB;求中间值的地址 SHR AX,#1; ADD BX,AX; LD RESULT,[BX];中间值送结果寄存器 RET 一阶滞后滤波程序清单： FOHFILTER:MUL BX,INPUT,#COER2;求Xk(1-α) MUL DX,OUTPUT1，#COER1;求Yk-1α ADD BX,DX;求Yk=Xk9(1-α)+Yk-1α ADDC CX,EX; SHLL BX,#1;结果形成16位小数 LD OUTPUT1，CX;Yk-1←Yk LD RESULT,CX;结果输出 RET 限幅滤波程序清单： LAFILTER:SUB AX,DATA2，DATA1;求x2-x1 JGE NEXT1; NEG AX; NEXT1：CMP AX,LIMIT;|x2-x1|限幅值？ JGT NEXT2 LD RESULT,DATA2;小于限幅值，当前采样值有效 NEXT2：LD DATA1，DATA2;大于限幅值，舍去 RET 限速滤波程序清单： LSFILTER:SUB AXM,DATA2，DATA1;求|x2-x1| JGE NEXT1 NEG AX NEXT1：SUB BX,DATA3DATA2;求|x3-x2| JLE NEXT2 NEG BX NEXT2：CMP AX,LIMIT;|x2-x1|限幅值？ JLE NEXT3 CMP BX,LIMIT;|x3-x2|限幅值？ JLE NEXT4 ADD AX,DATA2，DATA3;取(x2+x3)/2为输出值 SHR AX,#1 LD RESULT,AX SJMP NEXT0 NEXT3：LD RESULT,DATA2;取x2为滤波输出值 SJMP NEXT0 NEXT4：LD RESULT,DATA3：取x3为滤波输出值 NEXT0： RET 线性插值程序清单： LIPRO:LD CX,#N CLR BX S_LOOP:ADD AX,BX,CX SHR AX,#1 CMP AX,BX JES_OVER SHL AX,#1 ADD DX,AX,#XDATA CMP DATA,[DX] JE DG_YDATA SHT AX,#1 JGT S_UP LD CX,AX SJMP S_LOOP S_UP:LD BX,AX SJMP S_LOOP DG_YDATA:ADD DX,AX,#YDATA LD RESULT,[DX] RET S_OVER:SHL AX,#1 ADD DX,AX,#XDATA SUB DATA,[DX] ADD DX,AX#KDATA MUL BX,DATA,[DX] ADD DX,AX,#YDATA ADD RESULT,BX,[DX] RET 位置式PID控制算法程序清单： PPIDPRO:SUB AX,INPUT,FOODBACK；求E(k)=R(k)-F(k) MUL BX,AX,KPREG;求Pp(k) ADD DX,PIREGL; ADDC EX,PIREGH; ADD GX DX;求Pp(k)+Pi(k) ADDC CX,EX; LD PIREGL,DX;Pi(k-1)←Pi(k) LD PIREGH,EX; SUB DX,AX,EREG;求E(k)-E(k-1) MUL DX,KDREG; 求Pd(k LE REG,AX;E(k)→E(k-1) ADD BX,DX;求P(k)=Pp(k)+Pi(k)+Pd(k) ADDC CX,EX; LD OUTPUT,CX; LD OUTPUT,CX;结果输出 RET OTG 0