基于單片機(jī)的風(fēng)洞模型姿態(tài)控制系統(tǒng)設(shè)計(jì)
加入技術(shù)交流群
程序入口：傳感器編號(hào)存于A中。
程序出口：α角度存于51H、β角度存于53H。
部分程序如下：
MS: CLR EA ;關(guān)中斷
MOV R2,A ;暫存?zhèn)鞲衅骶幪?hào)
MOV SCON,#50H ;設(shè)置串口方式
MOV RCAP2H,#0FFH ;自動(dòng)裝載值
MOV RCAP2L,#0D9H ;
MOV TH2,#0FFH
MOV TL2,#0D9H
MOV T2CON,#34H ;啟動(dòng)波特率發(fā)生器
…… …… ;發(fā)送采集命令、進(jìn)制轉(zhuǎn)換
LCALL FCIV ;調(diào)浮點(diǎn)數(shù)運(yùn)算
…… …… ;進(jìn)制轉(zhuǎn)換、存數(shù)據(jù)
SETB EZ ;開(kāi)中斷
RET
圖3 角度測(cè)量流程圖
2.2.2 角度控制程序設(shè)計(jì)
風(fēng)洞中模型姿態(tài)的控制分兩部分，一個(gè)是當(dāng)前姿態(tài)的測(cè)量，一個(gè)是計(jì)算步進(jìn)電機(jī)需轉(zhuǎn)過(guò)的角度，角度的控制是在精確地測(cè)量當(dāng)前姿態(tài)的基礎(chǔ)上完成的，程序框圖如圖4所示。
和角度測(cè)量相似，模型姿態(tài)需要改變的角度放在累加器中，需要改變的方向放在22H單元中，符號(hào)放在23H單元中，通過(guò)計(jì)算得到驅(qū)動(dòng)模型轉(zhuǎn)動(dòng)給定角度所需要的脈沖數(shù)，以及該方向電機(jī)的控制端口。
部分程序如下：
DJRUN: JZ AOVER
MOV R2,A ; 待轉(zhuǎn)角度存于A中
MOV A,22H ; 模型變化方向
評(píng)論