基于單片機的風洞模型姿態控制系統設計

　　程序入口：傳感器編號存于A中。

　　程序出口：α角度存于51H、β角度存于53H。

　　部分程序如下：

　　MS: CLR EA ;關中斷

　　MOV R2,A ;暫存傳感器編號

　　MOV SCON,#50H ;設置串口方式

　　MOV RCAP2H,#0FFH ;自動裝載值

　　MOV RCAP2L,#0D9H ;

　　MOV TH2,#0FFH

　　MOV TL2,#0D9H

　　MOV T2CON,#34H ;啟動波特率發生器

　　…… …… ;發送采集命令、進制轉換

　　LCALL FCIV ;調浮點數運算

　　…… …… ;進制轉換、存數據

　　SETB EZ ;開中斷

　　RET

　　圖3 角度測量流程圖

　　2.2.2 角度控制程序設計

　　風洞中模型姿態的控制分兩部分，一個是當前姿態的測量，一個是計算步進電機需轉過的角度，角度的控制是在精確地測量當前姿態的基礎上完成的，程序框圖如圖4所示。

　　和角度測量相似，模型姿態需要改變的角度放在累加器中，需要改變的方向放在22H單元中，符號放在23H單元中，通過計算得到驅動模型轉動給定角度所需要的脈沖數，以及該方向電機的控制端口。

　　部分程序如下：

　　DJRUN: JZ AOVER

　　MOV R2,A ; 待轉角度存于A中

　　MOV A,22H ; 模型變化方向