pid控制算法程序(存儲版)
【正文】 被除數(shù)右規(guī)一次SJMP DIV3DIV4: CLR A 。階碼檢驗LJMP RLN 。 (7) 標(biāo)號：FZER 功能：浮點數(shù)判零。按整數(shù)的位數(shù)初始化階碼MOV A,R0 。在位1FH中，F(xiàn)0=1 時為整數(shù)，CY=1時為一字節(jié)整數(shù)一字節(jié)小數(shù)，否則為純小數(shù)。階碼大于８，按雙字節(jié)整數(shù)轉(zhuǎn)換LCALL FTD8SETB F0 。右規(guī)一次SJMP FTD8。INC R0MOV A,R0MOV R7,ADEC R0MOV A,R0MOV R6,ADEC R0ORL A,R7JNZ BTF0MOV R0,41H。MOV ,CMOV R0,AJNC BTF1ADD A,19 。至少兩個字節(jié)。準(zhǔn)備查表得到十進(jìn)制階碼對應(yīng)的浮點數(shù)。取出數(shù)符。十的－１９次冪。和待轉(zhuǎn)換浮點數(shù)比較。尾數(shù)為０?１０００。FTB3: PUSH B 。LCALL RR1 。MOV R6,ALCALL HB2 。MOV ,CMOV R0,ARETHB2: MOV A,R4 。DB 4FH,90H,1DH 。DB 69H,0D6H,0C0H 。DB 4,0A0H,00H 。DB 1EH,0EEH,6BH 。DB 39H,31H,0A3H 。DB 32H,0E3H,60H 。DB 18H,98H,97H 。DB 7DH,0CCH,0CDH 。DB 63H,89H,70H 。DB 48H,0B8H,78H 。INC R0MOV A,R7MOV R0,ADEC R0MOV A,R6MOV R0,ADEC R0MOV A,R5MOV C,1DH 。LCALL HB2 。JZ FTB5 。冪加一。冪加一。查表，找到一個比待轉(zhuǎn)換浮點數(shù)大的整數(shù)冪。絕對值小于１Ｅ－６時的查表起點。將階碼對應(yīng)的浮點數(shù)和尾數(shù)對應(yīng)的浮點數(shù)相乘。 ******加80H，也可以CLR AADDC A,R4MOV R4,ACLR AADDC A,R3MOV R3,AJNC BTF4MOV R3,80H 。準(zhǔn)備將BCD碼尾數(shù)轉(zhuǎn)換成十六進(jìn)制浮點數(shù)。MOV C, 。影響資源：PSW、A、B、R2～R位1DH～1FH 堆棧需求：６字節(jié)BTOF: INC R0 。按規(guī)定的整數(shù)位數(shù)進(jìn)行右規(guī)***階碼是擴(kuò)展后的值CJNE A,B,FTD9MOV A,R3 。階碼大于１６，溢出RETFTD1: SETB CMOV A,R2SUBB A,8 。 (8) 標(biāo)號：FMOV 功能：浮點數(shù)傳送?；謴?fù)R0R1R2MOV R2,APOP ACCMOV R1,APOP ACCMOV R0,AMOV A,R2 。回傳結(jié)果DIV3: CLR C 。影響資源：PSW、A、B、R2～R位1EH、1FH 堆棧需求： ５字節(jié)FDIV: INC R0MOV A,R0INC R0ORL A,R0DEC R0DEC R0JNZ DIV1MOV R0,41H。階碼溢出判斷JB ,MUL4JNB ,MUL6MOV R2,3FH 。將結(jié)果傳回到[R0]中MUL0: LCALL MVR1 。第一操作數(shù)右規(guī)一次RRC A 。繼續(xù)判斷RLN2: CLR OV 。結(jié)果規(guī)格化AS6: CPL 1FH 。尾數(shù)為零否？JNZ EQ 。尾數(shù)縮小一半RRC AMOV R6,AMOV A,R7RRC AMOV R7,AINC R5 。第二操作數(shù)為零，不必運算MOV A,R3 。將[R1]傳送到第二工作區(qū)中的子程序MOV C, 。將[R0]傳送到第一工作區(qū)中的子程序MOV C, 。取結(jié)果的階碼MOV C,1FH 。將第二操作數(shù)的有效符號存入位1EH中XRL A,R0 。出口信息：OV=0時，差仍在[R0]中，OV=1時，溢出。出口信息：OV=0時，和仍在[R0]中，OV=1時，溢出?；謴?fù)A 釋放BUFFLCALL FMOVMOV R0,UK 。保存BLCALL FMOVR0MOV R1,EK1LCALL FMULMOV R1,BUFF1LCALL FMOVR0MOV R1,BUFF 。將EK1，EK2設(shè)初值0LCALL FCLRMOV R0,EK2LCALL FCLRMOV REC,03H 。30H里存的是T/Ti+1LCALL FADDMOV R1,39HLCALL FMULMOV R1 ,BLOCK1 。指向BCD碼浮點操作數(shù)TdLCALL BTOF 。Ti的BCD碼浮點數(shù)MOV 37H,11H 。常數(shù)Rk的BCD碼浮點數(shù)MOV RK+1,12H 。ORG 0000HBLOCK1 EQU 43H 。********增量式PID控制算法程序***********。存放偏差值E(k)的始址EK1 EQU 56H 。常數(shù)2的BCD碼浮點數(shù)MOV 41H,20HMOV 42H,00HMOV 30H,01H 。MOV 3BH,50HMOV R0,RK 。將其轉(zhuǎn)換成二進(jìn)制浮點操作數(shù)MOV R1, BUFF1 。33H恢復(fù)原值MOV R0,33HLCALL FMOVMOV R0,40H 。MOV CK+2,12HMOV R0,CKLCALL BTOFMOV R0,RK 。保存CLCALL FMOVR0MOV R1,EK2LCALL FMULMOV R1,BUFF2LCALL FMOVR0MOV R1,BUFF 。等待采樣時刻DJNZ REC,NEXT1SJMP $NEXT1: LJMP LOOPDELAY: MOV R7,02HDELAY1: MOV R6,0FFHDELAY2: DJNZ R6,DELAY2DJNZ R7,DELAY1RET。通過左規(guī)完成格式化LJMP MOV0 。設(shè)立加法標(biāo)志SJMP AS 。設(shè)立減法標(biāo)志AS: LCALL MVR1 。將[R0]傳送到第一工作區(qū)中LCALL AS1 。不考慮數(shù)符CLR OV 。存放在R2中INC R0MOV A,R0 。存放在R5中INC R
環(huán)評公示相關(guān)推薦
鄂ICP備17016276號-1