基于STM32的四旋翼無人機設計

田昌　鄧文濤　趙娟

摘? ?要：近年來，隨著輕型復合材料廣泛應用以及多旋翼無人機結構的出現，無人機已經不僅應用在軍事領域，其他領域的應用也越來越廣泛。本文主要對多旋翼無人機結構進行研究，設計一種以STM32F103C8T6為核心，MPU6050三軸陀螺儀作姿態傳感器輸出姿態值，以HM-12、HM-13系列藍牙模塊與手機通信的四旋翼無人機。該無人機結構合理、操作靈活、性能良好、使用方便，適合現代生活多方需求。

關鍵詞：嵌入式? STM32F103C8T6? 控制系統

中圖分類號：V249.1? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?文獻標識碼：A? ? ? ? ? ? ? ? ? ? ? ? 文章編號：1674-098X（2019）10（c）-0061-02

隨著科技的進步，無人機的發展十分迅猛，其已在諸多領域有著重要的作用。四旋翼無人機更是其中的一個典型。相比起其他傳統無人機，其操作靈活，地形限制少，攜帶方便，價格低廉的優勢無疑更貼近我們的生活，如無人機航拍，監控，勘測地形等。因此，四旋翼無人機在未來的發展中無疑是極具前景的。

1? 硬件結構與原理

四旋翼無人機主要由四軸飛行器和手機控制APP兩部分組成，其中四軸飛行器則是由四軸核心板，四軸螺旋槳，藍牙無線模塊，電池四部分組成，手機APP則是通過安卓語言開發的簡易程序來與四軸飛行器上的藍牙模塊連接，達到可以控制飛行器的目的。

四旋翼無人機根據四旋翼對稱的結構，其有兩種飛行姿態，一種是根據四旋翼十字對稱的結構，將處于同一水平線的一對機架梁作為x軸另一對梁作為y軸的“+”型飛行姿態，如圖1所示。另一種是將相應兩個梁的對稱軸線作為x軸，另一條對稱軸線作為y軸的“X”型飛行姿態，如圖1所示。

四旋翼飛行器是一種欠驅動系統，其只有四個輸入力，但卻同時輸出六個狀態。實現其飛行的主要便就是調節PWM占空比來調節電機轉速，使旋翼旋轉，產生上升或下降的力。同時調節四個電機的轉速，便可以實現無人機的垂直運動，在通過調節不同的電機的轉速，還可以實現俯仰，滾動，偏航等多種運動，其操作簡單，靈活多變的特性能極大的方便我們的生活。

2? 系統框架設計

四旋翼無人機大致可分為六個部分，STM32F103C8T6單片機為核心，主要負責整個系統的協調工作;慣性測量模塊使用MPU6050來測量四旋翼的姿態;無線通信模塊使用HM-12藍牙模塊來與手機進行通信;電機驅動模塊則使用直流電機負責調控旋翼;電源管理模塊負責穩壓和充放電。手機APP模塊則是與藍牙模塊連，實現用手機操作無人機的效果。其整體框架如圖2所示。

3? 系統軟件設計

基于STM32的四旋翼無人機軟件設計主要包括姿態解算和PID控制兩個部分。姿態解算屬于四旋翼制作的核心部分，如果姿態解算能夠實時的反應出無人機的狀態，那么對于控制來講就相對來說比較容易了。而姿態結算所要做的事情就是地理坐標系與載體坐標系這兩個坐標系之間的正確轉化。姿態解算的核心在于旋轉，一般旋轉有矩陣表示、歐拉角表示、軸角表示和四元數表示4種，在組合旋轉方面，四元數表示最佳，故本文采用四元數保存組合姿態、輔以矩陣來變換向量的方案。在姿態解算中使用四元數來保存飛行器的姿態，包括旋轉和方位。在獲得四元數之后，會將其轉化為歐拉角，然后輸入到姿態控制算法中。總體設計則是通過MPU6050采集到的AD值（即陀螺儀和加速度值），將三個維度的AD值轉化為四元數，再通過四元數轉化為歐拉角pitch、roll、yaw即得到當前飛機的姿態。其中這個四元數是軟解，由STM32F103C8T6主控芯片讀取到AD值，用軟件從AD值算得。

該系統對四旋翼的控制采用PID控制，利用期望姿態（pitch=0，roll=0，yaw=0）與當前姿態的誤差，通過PID的控制作用輸出四路不同的PWM驅動電機讓飛機調整自己的姿態滿足當前姿態與期望姿態的誤差為0的目標。其中，角度作為外環，角速度作為內環，進行姿態雙環PID控制。角度環的輸出值作為角速度環的輸入建立自穩系統。其原理流程如圖3所示。

4? 結語

本系統以STM32F103C8T6為核心，通過MPU6050輸出模塊的姿態值，在使用PID控制來調節PWM的電機速率，通過無線藍牙模塊與手機藍牙相連，直接使用手機APP即可控制無人機。

參考文獻

[1] 徐信，陳聰.基于STM32的無人機飛行器設計[J].信息通信，2018（12）：128-130.

[2] 楊才廣，姚志興，譚永鎮，等.基于STM32的無人機飛行控制系統[J].電子世界，2019（1）：130-131.

[3] 王博.基于STM32的微型無人機飛行控制器研究[D].長春工業大學，2018.

[4] 董明飛，侯恭，康立鵬，等.四旋翼無人機的組成及各部分功能[J].科技創新與應用，2018（21）：85-86.