北方民族大學 郭 蕭 祝 玲 郭 青 葉麗榮
四旋翼飛行器設計方案
北方民族大學 郭 蕭 祝 玲 郭 青 葉麗榮
四旋翼飛行器如今已為眾人所熟知,四旋翼的應用也比較廣泛,本文重點講解一下四旋翼飛行器的具體設計方案,本設計使用到主控芯片Cotex-M4 K60,無線通訊模塊ZigBee,角度傳感器,電機驅動模塊,以及電源管理模塊,無刷電機等組成,具體實現過程為主控芯片通過互補算法,卡爾曼濾波算法等實現角度計算和通過PID、模糊算法等控制計算電機控制輸出,同時實時獲取地面站指令,完成相應動作。
四旋翼飛行器;無線通訊;互補算法;PID
隨著四旋翼飛行器的迅速發展,四旋翼飛行器在日常生活中的使用越來越頻繁,抗險救災,農藥噴灑,崗位執勤等方面愈發凸顯四旋翼飛行器的使用價值。本文目的在于提出一種四旋翼飛行器的設計方案。

圖1 總體設計方案
本設計中使用Cotex-M4 K60作為主控制器,該控制器主要應用于汽車行業,經過多年的測試和使用其穩定性已不言而喻,flash容量高達512KB,富有豐富的內部資源,性能可靠,抗干擾能力強,高達200MHz的鐘頻率,是多任務控制器的不二之選。該控制器其主要任務是實時接收地面站命令,同時實時計算飛行器當前的角度,并實時調整當前電機的轉速,以達到四旋翼飛行器的穩定。無線部分由主從ZigBee無線模塊組成,主ZigBee主要完成地面站命令發送,以及應答信號接收,從ZigBee安裝到四旋翼飛行器上,其主要任務是檢測獲取主機命令然后發送給四旋翼飛行器主控芯片Cotex-M4 K60,主控芯片收到命令之后,做出應答,同時根據當前的狀態完成相應的動作。總體設計方案框圖如圖1所示。

圖2 系統電源
2.1 電源模塊
由于芯片、LCD屏供電需要3.3V,角度等傳感器需要5V電源,故硬件電路設計時做了兩路電源。傳感器使用的電源要求紋波要盡可能地少,本方案中采用了效率較低但紋波較小的芯片LM2940(效率僅有40%左右),而沒有采用效率較高紋波較大的開關電源(效率高達90%),圖2為系統電源部分。
2.2 電機輸出模塊
如圖3所示為系統緩沖門,目的是放置驅動在測試過程中損壞,回流電流過大損壞主控芯片添加的隔離緩沖門電路。

圖3 驅動緩沖門
2.3 無線傳輸模塊
如圖4所示為ZigBee無線傳輸模塊,該模塊載波在2.4GHz頻段,穩定性高,傳輸距離遠,數據傳輸速率可調。

圖4 ZigBee無線傳輸模塊
2.4 LCD屏顯模塊
LCD屏顯模塊主要是用來下位機數據調試使用,便于脫機調試時實時觀察飛行器內部參數,最終成品不含有該模塊。

圖5 LCD屏顯模塊
如圖6為系統軟件控制流程圖,系統初始化完成以后,在不同的1ms時間片中斷里分別執行相應的任務,第一個毫秒內做任務一,其內容為獲取當前飛行器的三軸角度、角速度數字量或者模擬量。然后在第二個毫秒內根據三軸角度值、角速度值進行角度合成和角度矯正。第三個毫秒內主要使計算四個電機的實際輸出轉速。第四個毫秒內完成飛行器的高度、航向獲取,為懸停做準備。第五個毫秒主要進行系統安全檢測,當檢測到異常信號是,系統會在主任務里完成迫降任務。如此循環下去,直至關機系統停止運行。

圖6 系統軟件控制流程圖
該方案設計的四旋翼飛行器已經過測試,達到預期效果,在設計過程中應當注意到的是系統安全及其穩定性的要求,因為四旋翼飛行器的穩定性直接影響人身、財產安全問題。設計和調試系統的時候務必要做好防范措施以及緊急情況處理程序,在初步確認系統成熟以后,出于多方面考慮有一定的必要設計一下雙系統控制,以便使系統更加穩定,使其魯棒性更強。
[1]鄒伯敏.自動控制理論(第三版)[M].北京:機械工業出版社,2007.06.
[2]智能車競賽秘書處.電磁組直立行車參考設計方案(版本 2.0)[Z].2012.03.
Four rotor design
GuoXiao ZhuLing GuoQing YeLirong
(Beifang University of Nationalities, Ningxia Yinchuan City,750021,China)
Constitute a quadrotor has now for all known, the use of four rotor is also widely used, this paper explain the key to the specific design of the four rotor aircraft. The design used to main control chip Cotex-M4 K60, ZigBee wireless communication module, angle sensor, motor drive module and power management module, no brush motor etc., the specific implementation process as the main control chip through the complementary algorithm, Kalman filter algorithm realize the angle calculation and the PID or fuzzy control algorithm in the calculation of the motor output control, and real-time access to the ground station to make, appropriate action.
Four rotor aircraft;wireless communication;complementary algorithm;PID
郭蕭(1993-),男,大學本科,單片機開發與應用工程師,研究方向:單片機。
祝玲(1978-),女,講師,研究方向:微電子。
郭青(1992-),男,大學本科,機械工程師,研究方向:機械工程。
葉麗榮(1993-),女,大學本科,研究方向:單片機。