基于步進電機的自動平衡系統(tǒng)-資料下載頁
2024-08-29 17:40本頁面
【導(dǎo)讀】蹤單擺的角度來控制步進電機轉(zhuǎn)的角度，實現(xiàn)平木板與地面保持水平的功能。的電路結(jié)構(gòu)簡單，可靠性能高。實驗測試結(jié)果滿足要求，本文著重介紹了該系統(tǒng)的硬件。設(shè)計方法及測試結(jié)果分析。
【正文】 A， @R0 ；是結(jié)束標志轉(zhuǎn)移 JZ TPL LOOP1： DJNZ R4， LOOP ；步數(shù)不為 0，轉(zhuǎn)移 POP A RER TPL： MOV A， R0 ；恢復(fù)控制字首址 CLR C SUBB A， 06H MOV R0， A AJMP LOOP1 DLY： MOV R2， M DLY1： MOV A， M1 LOOP： DEC A JNZ LOOP DJNZ R2， DLY1 RET 主程序： ORC 0000H SJMP START ORG 000BH LJMP INT0 ORG 0030H START： MOV DPTR， addr16 。T0 初值地址指針 MOV R3， 1BH ；賦頻率階梯記數(shù)器值 MOV R2， 1AH ；賦階梯步長計數(shù)器值 CLR C ORL C， 73H JC ROTE MOV R0， 20H ；正轉(zhuǎn)控制字首址 AJMP PH ROTE： MOV R0， 27H ；反轉(zhuǎn)控制字首址 PH： MOV TMOD， 01H ； T0 方式 1 定時 大學(xué)本科畢業(yè)設(shè)計（論文） 25 MOV TL0， 00H ；置 T0 初值 MOV TH0， 00H SETB TR0 ；啟動 T0 SETB ET0 ；允許 T0 中斷 LOOP： MOV A， R3 ；等待中斷 JNZ LOOP CLR EA ； CUP 關(guān)中斷 SJMP $ ；結(jié)束 中斷服務(wù)程序： INT0： PUSH A ；保護現(xiàn)場 MOV A， @R0 MOV P1, A INC R0 MOV A, 00H ORL A, @R0 JZ TPL ；是結(jié)束標志，轉(zhuǎn) RR: DEC R2 ；步長計數(shù)器減 1 MOV A, 00H ORL A, R2 JZ THL ；階梯步長計數(shù)器為 0，轉(zhuǎn) PRL: CLR C CLR C, 71H JNC ROTEL ；是降頻，轉(zhuǎn)移 MOV A, 00H MOVC A, @A+DPTR MOV TL0,A ；升頻 T0 賦初值低 8 位 MOV A, 01H MOVC A, @A+DPTR MOV TH0,A ；升頻 T0 賦初值高 8 位 AJMP ROTEL: MOV A, 80H MOVC A, @A+DPTR MOV TL0,A ；降頻 T0 賦初值低 8 位 MOV A, 81H MOVC A, @A+DPTR MOV TH0,A ；降頻 T0 賦初值高 8 位 : POP A ；恢復(fù)現(xiàn)場 RETI ；中斷返回 THL: DJNZ R3,AT ；頻率階梯減 1 不為 0，轉(zhuǎn) AJMP AT: MOV R2,1AH ；階梯步長賦值 INC DPTR INC DPTR ； TO 初值指針更新 AJMP PRL 大學(xué)本科畢業(yè)設(shè)計（論文） 26 TPL: CLR C MOV A, R0 SUBB A, 06H MOV R0, A AJMP RR END
畢業(yè)設(shè)計相關(guān)推薦
鄂ICP備17016276號-1