chương 6 giải thuật và chương trình

PHUC HOI THONG SOACALL CHUONG TRINH PHIM DO VA HIEN THI NHIET MODE?. DIEU KHIEN PID DIEU KHIEN ON_OFF HIEN THI NHIET DO DO END YN Y N... 2.Giải Thuật Bàn Phím... 3.Giải Thuật TaÊng GỉamS

PHUC HOI THONG SO

ACALL CHUONG TRINH PHIM

DO VA HIEN THI NHIET

MODE?

DIEU KHIEN PID DIEU KHIEN ON_OFF

HIEN THI NHIET DO DO

END

YN

Y

N

2.Giải Thuật Bàn Phím

3.Giải Thuật TaÊng Gỉam

START

TANG

LUU THONG SOHIEN THITANG THONG SO

GIAM

GIAM THONG SO

LUU THONG SOHIEN THI

3.Giải Thuật Điều Khiển On_Off

4.Giải Thuật Điều Khiển PID

STARTTINH EnHKP=KP*EnTAM=KI*TsTAM=TAM/10INTG=INTG+(En+E n+1)

INTG=INTG/100KHI=INTG*TAM

KHD=KD*(En-En-1)/Ts

Un=KHI+KHD+KP

En-1:=En

THOAT

LCALL DKPID

MODE2: LCALL ON_OFF

NETX: LCALL HTNHIET

MOV TH0,HIGH(-196)MOV TL0,LOW(-196)MOV TH1,HIGH(-50000)MOV TL1,LOW(-50000)MOV TH2,HIGH(-50000)MOV TL2,LOW(-50000)MOV KE,#0

MOV PPHAP,#0

MOV BDK,#0MOV TDAT1,#1MOV TDAT,#00MOV TS,#20MOV KP,#3MOV KP1,#0MOV KI,#4MOV KI1,#0MOV KD1,#1MOV KD,#00SETB TR2SETB TR1SETB TR0RET

MOVX A,@DPTR

MOV TDO1,#00RET

ANL A,#0FHORL A,#00HMOV DPTR,#4000H

MOVX @DPTR,A

ANL A,#0FHORL A,#10HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#20HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#30HMOV DPTR,#4000HMOVX @DPTR,AMOV DPTR,#4000HMOV A,#41H

MOVX @DPTR,AMOV DPTR,#4000HMOV A,#5AH

MOVX @DPTR,ALAPTDO: LCALL QUETPHIM

DJNZ DEM,LAPTDORET

;***************************************

;chuong trinh dieu khien ON_OFF

;***************************************ON_OFF: CLR TR0

MOV R5,TDOMOV R4,TDO1LCALL SOSANH

SJMP THOATLONHON: MOV R7,TDAT

MOV R6,TDAT1MOV R5,OFF

LCALL IADDMOV R5,TDOMOV R4,TDO1LCALL SOSANH1

;Ra :Un 8bit

;tính sai số với En+1 bit cao En bit thấp

;****************************************************DKPID: MOV R6,#TDAT1 ;R6 chua bit cao nhiet do dat

MOV R7,#TDAT ;R7 chua bit thap nhiet do datMOV R4,#TDO1 ;R4 chua bit cao nhiet do doMOV R5,#TDO ;R5 chua bit thap nhiet do doLCALL ISUB

MOV En1,R6 ; bit cao sai soMOV En,R7 ; bit thap sai so

MOV R6,En1LCALL IMULSJMP OUTP

MOV R7,#0MOV R4,En1MOV R5,EnLCALL ISUBMOV R4,KP1MOV R5,KPLCALL IMULMOV A,R6MOV R4,AMOV A,R7MOV R5,AMOV R6,#0MOV R7,#0LCALL ISUBOUTP: MOV KHP,R7

MOV KHP1,R6

;************************************************

;Tính khaâu D :KHD=(D/Ts)*([En1_En]-[En11_En1])

;************************************************

KHAUD: MOV A,KD ; chuyen bit thap KD vao A

MOV R1,KD1 ; chuyen bit cao KD vao R1MOV B,Ts ;tinh bieu thuc D/Ts

LCALL DIV16_8MOV TAM,A ; TAM la bien trung gian de tinh toanMOV TAM1,R1 ;TAM= D/Ts

MOV R7,EnMOV R6,En1MOV R4,En11MOV R5,En1LCALL ISUB ; tinh sai soMOV SAISO,R7 ; lua gia tri sai soMOV SAISO1,R6

MOV A,R6

JB ACC.7,AMDMOV R4,TAM1MOV R5,TAMLCALL IMULSJMP OUTDAMD: MOV R4,SAISO1

MOV R5,SAISOMOV R6,#0MOV R7,#0LCALL ISUBMOV R4,TAM1MOV R5,TAMLCALL IMULMOV A,R7MOV R5,AMOV A,R6MOV R4,AMOV R6,#0MOV R7,#0LCALL ISUBOUTD: MOV KHD,R7

MOV R6,KI1MOV R4,#0MOV R5,TsLCALL IMULMOV TAM,R7 ;tinh tongMOV TAM1,R6

MOV R7,EnMOV R6,En1MOV R5,En11MOV R4,En111LCALL IADDMOV TONG,R7MOV TONG1,R6MOV R5,INTGMOV R4,INTG1LCALL IADDMOV INTG,R7 ;INTG=INTG+TONGMOV INTG1,R6

MOV A,R6

JB ACC.7,AMIMOV A,R6 ;INTG>0MOV R1,A

MOV A,R7MOV B,#10LCALL DIV16_8MOV R7,AMOV A,R1MOV R6,AMOV R5,TAMMOV R4,TAM1LCALL IMULMOV A,R6MOV R1,AMOV A,R7MOV B,#10LCALL DIV16_8MOV B,#10LCALL DIV16_8MOV KHI,AMOV KHI1,R1SJMP OUTIAMI: MOV A,R7 ;INTG<0

MOV R5,AMOV A,R6

MOV R4,AMOV R7,#0MOV R6,#0LCALL ISUBMOV A,R6MOV R1,AMOV A,R7MOV B,#10LCALL DIV16_8MOV R7,AMOV A,R1MOV R6,AMOV R5,TAMMOV R4,TAM1LCALL IMULMOV A,R6MOV R1,AMOV A,R7MOV B,#10LCALL DIV16_8MOV B,#10LCALL DIV16_8MOV R5,AMOV A,R1MOV R4,AMOV R7,#0MOV R6,#0LCALL ISUBMOV KHI,R7MOV KHI1,R6OUTI: NOP

;*************************************

;TÍNH PID=KHP+KHD+KHI

;*************************************PID: MOV R7,KHP

MOV R6,KHP1MOV R5,KHD

MOV R4,KHD1LCALL

MOV R5,KHIMOV R4,KHI1LCALL IADDMOV PID,R7MOV PID1,R6MOV A,R6

JB ACC.7,AMPIDCJNE A,#0,LON8BITMOV Un,PID ;0<PID<255SJMP OUTPID

LON8BIT: MOV Un,#255

SJMP OUTPIDAMPID: MOV Un,#0

OUTPID: MOV En1,En

MOV En11,En1SETB TR0SETB TR1RET

MOV A,R7SUBB A,R5MOV R7,AMOV A,R6SUBB A,R4MOV R6,ARET

;***********************************

;Chöông trình nhaân hai soá nguyeân 16bit

; R6R7=R6R7 x R4R5

;***********************************IMUL: MOV A,R7

MOV R3,AMOV B,R5MUL ABMOV R7,AMOV A,R5XCH A,BXCH A,R6MUL ABADD A,R6MOV R6,AMOV A,R4MOV B,R3MUL ABADD A,R6MOV R6,ARET

SETB ENTER

JB ENTER,TANGTDLCALL HIENTHITDLCALL HIENTHITD

LCALL HIENTHIKPLCALL HIENTHIKP

SETB ENTER

JB ENTER,TANGKDLCALL HIENTHIKDLCALL HIENTHIKD

*******************************************

;CHUONG TRINH CON HIEN THI TDAT

*******************************************HIENTHITD: MOV DEM,#150

ANL A,#0FHORL A,#10HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#20HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#30HMOV DPTR,#4000HMOVX @DPTR,AMOV DPTR,#4000HMOV A,#41H

MOVX @DPTR,A

MOV DPTR,#4000HMOV A,#5AH

MOVX @DPTR,A

DJNZ DEM,LAPTDRET

******************************************

;CHUONG TRINH CON HIEN THI KI

******************************************HIENTHIKI: MOV DEM,#150

ANL A,#0FHORL A,#10HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#20HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#30HMOV DPTR,#4000HMOVX @DPTR,AMOV DPTR,#4000HMOV A,#42H

MOVX @DPTR,AMOV DPTR,#4000HMOV A,#5AH

MOVX @DPTR,A

DJNZ DEM,LAPKIRET

*************************************

;CHUONG TRINH CON HIEN THI KP

*************************************HIENTHIKP: MOV DEM,#150

ANL A,#0FHORL A,#10HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#20HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#30HMOV DPTR,#4000HMOVX @DPTR,AMOV DPTR,#4000H

MOV A,#43HMOVX @DPTR,AMOV DPTR,#4000HMOV A,#5AH

MOVX @DPTR,A

DJNZ DEM,LAPKPRET

**************************************

;CHUONG TRINH CON HIEN THI KD

**************************************HIENTHIKD: MOV DEM,#150

ANL A,#0FHORL A,#10HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#20HMOV DPTR,#4000HMOVX @DPTR,A

ANL A,#0FHORL A,#30HMOV DPTR,#4000HMOVX @DPTR,A

MOV DPTR,#4000HMOV A,#44H

MOVX @DPTR,AMOV DPTR,#4000HMOV A,#5AH

MOVX @DPTR,A

DJNZ DEM,LAPKDRET

LCALL READ ;phuc hoiMOV KP1,DMEROM ;he so KpMOV KP,DMEROM1

LCALL READ;phuc hoiMOV KI1,DMEROM ;he so KiMOV KI,DMEROM1

LCALL READ;phuc hoiMOV KD1,DMEROM ;he so KdMOV KD,DMEROM1

DJNZ TIM0,TONMOV TIM0,TsDJNZ UPT0,TON

SETB TR1DJNZ X20,KNGATMOV X20,#20DJNZ TIM1,KNGATMOV TIM1,TSSETB 7FHMOV UT0,Un

SETB CONTROLSETB TR0

KNGAT: RETI