固定翼飛機豎直飛行控制系統(tǒng)的設計
引言
本文引用地址:http://2s4d.com/article/86409.htm固定翼飛機水平飛行是最常見的飛行狀態(tài),讓其做大仰角飛行則動作不能一直保持,如讓其垂直于地面飛行能保持的時間則更短。本項目要實現(xiàn)的是一個可以讓飛機垂直于地面飛行并可以穩(wěn)定在固定高度的控制系統(tǒng)。利用在機身加入的三軸向加速度傳感器來檢測垂直于地面飛行的飛機的姿態(tài)。當檢測到飛機前后搖擺時,控制水平尾翼使飛機保持前后方向的穩(wěn)定性;當檢測到飛機左右搖擺時,控制垂直尾翼使飛機保持左右方向的穩(wěn)定性;當檢測到飛機上下竄動時,控制油門的大?。绰菪龢霓D(zhuǎn)速)來保持飛機飛行高度的穩(wěn)定性。當這些控制都很精準到位時,固定翼飛機也可以像直升機一樣穩(wěn)穩(wěn)地懸停在空中了。利用本文設計的控制系統(tǒng)可以讓飛機在做垂直飛行減速的同時順時針或逆時針轉(zhuǎn)90°(投影面積很?。?,這樣就可以減小暴露給后面飛機的投影面積,減小被擊中的幾率。
設計概述
為了讓飛機能豎直飛行,控制電路需要有以下功能:
判斷飛機是否要豎直飛行 對于真飛機,它可能只是一個可防止誤觸發(fā)的撥動開關(guān);在本項目的實驗品遙控飛機里,它就是某一個通道的脈寬信號。當脈寬大于某一設定值時,控制電路就知道它該上場了。
判斷自身姿態(tài) 這是本控制電路的核心部分之一,在控制飛機保持豎直飛行之前必須先判斷自身的姿態(tài)。本項目用MMA7260QT傳感器檢測飛機的姿態(tài)。
控制 這是本項目設計制作過程中最耗時的部分,但其原理很容易理解:姿態(tài)電路已經(jīng)了解了飛機的姿態(tài),控制電路只要做相應動作就可以了。飛機前傾它就讓飛機向前移動一些,后傾就向后移動一些。還有一個需要控制的量——高度,飛機在做此動作時高度是要保持穩(wěn)定的,機身上沖時要減小油門,下降時要加大油門。要完成如此控制,要用兩片MC9S08QG8。為了達到上述功能,本項目應有如圖1所示的電路框圖。
選用兩片MC9S08QG8是因為在本項目里有兩處對時間要求比較嚴格的地方:一是讀從遙控器送出的脈寬;二是把經(jīng)過運算的脈寬精確地發(fā)送出去,兩處都要10μS以內(nèi)的誤差,如用一片來做即使用中斷也會有沖突。本項目里兩片MC9S08QG8工作的大體分配是:一片作為主控,用于讀取遙控器送來的由接收機收到的脈寬(高實時性)、讀取飛機姿態(tài)(低實時性)、控制運算(PID運算)和數(shù)據(jù)發(fā)送(把需要對飛機如何控制的數(shù)據(jù),也就是PID運算的結(jié)果送給另一片MCU);另外一片作為輔助,只要把讀到的數(shù)據(jù)實時發(fā)給飛機的執(zhí)行機構(gòu)就可以了。
硬件描述
硬件電路如圖2所示。
·傳感器MMA7260QT輸出的三個軸的數(shù)據(jù)分別送入主控MCU的三個A/D輸入端ADP0、ADP1和ADP2,電源接一個電阻和電感可防止電源對傳感器的干擾。
·整個電路的電源由J1從接收機引入,通過78FC33變?yōu)?.3V后給MCU和傳感器供電,J2、J3、J4分別是左右、油門和前后控制。
·主控MCU的第二路TPM的捕捉輸入端TPMCH1接接收機的信號輸出端。本遙控系統(tǒng)是9通道的,也就是可同時控制9個機構(gòu),這種9通道的信號見圖3。它是由間隔為20ms的一個個脈沖串組成,每個脈沖串有9個脈沖,連續(xù)兩個脈沖的上升沿的間隔就是遙控器送出的有效控制信號,此間隔最小1ms、最大2ms。TPM捕捉到9個脈沖的寬度后,就可以根據(jù)需要直接送給舵機或經(jīng)PID運算后再送給舵機了。至于如何識別某一脈沖是上一個脈沖串的結(jié)尾還是下一個脈沖串的開頭,這里涉及到一個同步脈沖的概念,屬于軟件內(nèi)容,在此先不作解釋。
·主控MCU的串行輸出端接輔助MCU的串行輸入端。主控MCU想如何控制飛機動作,只要通過串口把數(shù)據(jù)發(fā)送給輔助MCU就可以了,發(fā)送格式如表1所示,共8個字符,其中0xAA、0x55為引導位……
·三個LED,D1是電源指示燈,D3用于指示“我是控制電路,我已經(jīng)開始控制飛機豎直飛行了”,D2是“出錯了,小心出問題,快切換回由你控制吧。”
·輔助MCU有兩個工作:一是讀主控MCU送來的串行數(shù)據(jù),找到引導字符后,把前后左右上下(油門)的數(shù)據(jù)送入相應的數(shù)組貯存;二是每20ms把相應的數(shù)組里的數(shù)據(jù)以脈沖形式發(fā)送出去。脈沖最小1ms、最大2ms。這個信號送入飛機的執(zhí)行機構(gòu)——舵機后對應的輸出規(guī)律見圖4。1ms的脈沖使舵機搖臂在最左邊的位置,1.5ms的脈沖使舵機搖臂位于中位,2ms的脈沖使舵機搖臂在最右邊的位置。舵機的搖臂連接飛機的各執(zhí)行機構(gòu),搖臂搖動時飛機的執(zhí)行機構(gòu)(如尾翼等)也跟著擺動。
評論