基于ARM11+CPLD的小型無(wú)人機(jī)飛行控制器設(shè)計(jì)
加入技術(shù)交流群
載體坐標(biāo)系中的矢量
在參考坐標(biāo)系
的表示可通過(guò)式(1)計(jì)算出:
(4)
是由其在載體坐標(biāo)系的對(duì)應(yīng)各軸的角速率分量
構(gòu)成,由姿態(tài)傳感器ADIS16365測(cè)得。本文采用四階龍格庫(kù)塔法解(3)式。
的求解,構(gòu)建了姿態(tài)矩陣
,再根據(jù)(8),(9),(10)求解俯仰角
、橫滾角
、偏航角
,即獲得機(jī)體的姿態(tài)。
基于姿態(tài)數(shù)據(jù)及各軸角速率,PID控制器的輸出由(11)式計(jì)算[6][7]:
K為采樣序號(hào)、
為第k次控制輸出值、
為第k次采樣輸入偏差、
為前次采樣輸入偏差、
積分系數(shù)、
微分系數(shù),
為比例系數(shù)。4 系統(tǒng)測(cè)試
基于上述設(shè)計(jì)方案研制的飛行控制器主板如圖7所示,安裝于測(cè)試飛機(jī)如圖9所示。
本文在某校園區(qū)進(jìn)行多次飛行測(cè)試,飛行的航線如圖9所示,航線由16個(gè)航點(diǎn)構(gòu)成,航點(diǎn)高度都為300米,航線總長(zhǎng)度為8.57公里。無(wú)飛機(jī)的實(shí)際飛行航跡如圖9中藍(lán)色線條所示,本次測(cè)試從進(jìn)入航線開(kāi)始到航線結(jié)束共自主飛行了18分鐘,姿態(tài)穩(wěn)定,最大偏航距≤15米。
試飛測(cè)試的任務(wù)載荷為航拍相機(jī),CPLD每4秒輸出一拍照脈沖,航拍圖片如12所示。
5 結(jié)束語(yǔ)
本文闡述基于ARM11+CPLD飛行控制器的構(gòu)建, ARM11的高速處理能力,使得系統(tǒng)的實(shí)時(shí)性高,系統(tǒng)飛行更加穩(wěn)定,且接口豐富,利于功能擴(kuò)展;CPLD在飛控系統(tǒng)中一方面起到擴(kuò)充MCU IO口的作用,另一方面提高了系統(tǒng)的實(shí)時(shí)性。在此飛控主板上,本文實(shí)現(xiàn)了導(dǎo)航、姿態(tài)、任務(wù)等功能模塊,飛行測(cè)試結(jié)果理想。
參考文獻(xiàn):
[1] 徐田來(lái),崔平遠(yuǎn),崔祜濤.基于置信度加權(quán)的組合導(dǎo)航數(shù)據(jù)融合算法[J].航空學(xué)報(bào),2007,28(6):1389-1394.
[2] Ick-Ho Whang,Won-Sang Ra.Simple Altitude Estimator using Air-Data and GPS Measurements[C].Proceedings of the 17th World Congress of the International Federation of Automatic ControlSeoul,Korea,ION,2008:4060-4065.
[3] 陳龍勝,姜長(zhǎng)生.基于干擾觀測(cè)器的無(wú)人機(jī)著陸飛行逆控制器設(shè)計(jì)[J].電光與控制,2009,16(9):52-56.
[4] SAMSUNG Company.S3C6410 HW Design Guide V1.0 [EB/OL].[2011-08-10]. http://www.samsung.com
[5] Analog Devices.ADIS16365 MANUAL [EB/OL]. [2011-08-10].http://www.analog.com
[6] Bryson.A.E.Jr.,Control of Spacecraft and Aircraft[M].Princeton,NJ:Princeton University Press,1994.
[7]ROBERT C.NELSON 顧均曉(譯).飛行穩(wěn)定性和自動(dòng)控制[M].北京:國(guó)防工業(yè)出版社,2007.
[8] 韓守謙,裴海龍,王清陽(yáng).基于Xenomai的實(shí)時(shí)嵌入式Linux操作系統(tǒng)的構(gòu)建[J].計(jì)算機(jī)工程與設(shè)計(jì),2011,(1):96-98
[9] 俞永昌.設(shè)備驅(qū)動(dòng)開(kāi)發(fā)技術(shù)及應(yīng)用[M].北京:人民郵電出版社,2010.
pid控制器相關(guān)文章:pid控制器原理
評(píng)論