基于STM32 的四旋翼無人機實驗教學平臺

李位星，王大東，葛聲揚，潘 峰

（北京理工大學 自動化學院，北京 100081）

近幾年，以一流人才培養、一流本科教育、一流專業建設為目標的新工科建設在各高校積極推進。高校作為人才培養的重要基地，需要為國家科技創新發展不斷培養優秀的具備創新思維和實踐能力的新時代人才。當前，高校對學生創新與實踐能力的培養還主要依靠培養計劃中的實驗教學環節來完成，已不能滿足實際需求?？萍几傎愒絹碓轿髮W生對自身創新實踐能力提升的關注，但競賽只能滿足少數學生的需求。因此提升實驗教學環節的含金量，加強在實驗教學中對學生綜合應用理論知識解決實際問題能力的培養，是高校實驗教學改革的核心任務。

為滿足學生對創新實踐能力提升的需求，培養學生綜合應用多門理論課程知識解決實際工程問題的能力。本文以四旋翼無人機為載體，設計了一種四旋翼無人機實驗教學平臺。四旋翼無人機雖然結構簡單，但涉及電子技術、自動控制、計算機等多學科的知識，國內也有不少教學儀器廠商開發了基于四旋翼無人機的教學設備，但只能為學生開設定制好的實驗課程，產品開源性較差，不利于學生的自主創新設計。因此，本平臺設計了以STM32 單片機為核心的飛行控制器，完成了四旋翼無人機硬件和軟件的設計，并以此為基礎開發了無人機綜合實驗項目。學生在該平臺上可以完成無人機姿態解算和飛行控制的理論學習與驗證、無人機組裝與調試、無人機任務應用系統設計與實現等多個環節的實驗實踐學習[1-10]。

1 四旋翼無人機實驗教學平臺設計

為滿足自動化、電子及機電等相關專業的綜合性實踐實驗課程的開設要求，四旋翼無人機實驗教學平臺采用模塊化的結構，也便于平臺設備的維修與功能擴展。該平臺的硬件整體結構如圖1 所示。

圖1 四旋翼無人機實驗教學平臺硬件結構

該實驗平臺主要包括三部分：飛控子系統、懸停子系統和導航子系統。飛控子系統以STM32F407 單片機為核心，使用ICM20602 姿態傳感器實現無人機的飛行控制功能；懸停子系統由激光和光流傳感器組成，完成無人機定點懸停功能；導航子系統由視覺里程計和機載計算機組成，為無人機提供定位信息和飛行路徑規劃。根據四旋翼無人機系統的交互數據，實驗平臺的系統框圖如圖2 所示。

圖2 四旋翼無人機系統框圖

2 四旋翼無人機飛行控制系統設計

2.1 飛行控制器硬件系統設計

飛行控制器硬件系統框圖如圖3 所示。STM32F407芯片作為中央處理單元，主頻高達168 MHz，片內封裝了512 kB 的Flash 和192 kB 的SRAM，自帶DSP指令和浮點處理單元有利于提高無人機姿態數據的解算速度，支持UART、I2C、SPI、USB 等常見的接口。姿態傳感器芯片ICM20602 相比傳統的MPU6050，具有輸出數據穩定、精度高、抗干擾能力強等優點，內部包含了3 軸陀螺儀、3 軸加速度計和溫度傳感器，可以通過SPI 由主控芯片快速讀取姿態數據并進行解算。此外，硬件電路還集成了氣壓計，也是通過SPI由主控芯片讀取高度數據。Flash 儲存芯片W25Q32 用于記錄無人機在飛行過程中的實時數據。硬件電路板還預留了USB、UART、SWD 等接口，用來實現無人機與上位機、機載計算機、外接激光和光流傳感器的通信，同時設計了LED 指示燈實時顯示無人機狀態。為了實現無人機的控制，系統設計了16 路PWM 輸入輸出接口，其中8 路用于輸入接收到的遙控器信號，可支持PPM 和PWM 遙控器信號；另外8 路用于輸出旋翼無人機電機驅動信號。

圖3 飛行控制器硬件原理框圖

2.2 飛行控制器控制算法設計

無人機的飛行控制主要包括姿態、高度和位置控制，其中姿態控制是核心[11]。為實現四旋翼無人機的穩定飛行控制，設計了三個雙閉環串級PID 控制器分別實現四旋翼無人機的姿態、高度和位置的控制，其中姿態控制框圖如圖4 所示，高度和位置控制框圖與姿態控制類似。姿態雙閉環控制中內環實現角速度控制，外環實現角度的期望誤差控制[12]，系統中的PID控器制均采用了離散增量PID 算法，公式為：

式中，n是采樣序號，n=0,1,…；U(n) 是第n次采樣時的輸出；e(n) 和e(n-1) 分別是第n和(n-1) 次采樣時的輸入誤差；Kp、Ki、Kd分別是比例、積分、微分系數；Ti是積分時間常數；Td是微分時間常數；T是采樣周期。

圖4 四旋翼無人機姿態雙閉環控制框圖

2.3 軟件系統設計

為方便學生在實驗項目中實現軟件算法，提高軟件系統功能的可擴展性和易維護性，該平臺的軟件系統采用了模塊化的設計思想，主要包括底層軟件子系統和ROS 應用軟件子系統，如圖5 所示。

圖5 實驗平臺軟件總體框圖

底層軟件子系統在飛行控制器中實現，主要包括硬件驅動、傳感器驅動和飛行控制應用三個模塊。其中，硬件驅動模塊完成STM32 芯片底層設備的驅動功能，傳感器驅動模塊完成姿態傳感器、激光和光流傳感器等的讀取任務，飛行控制應用模塊完成數據處理、狀態監測任務及姿態和位置控制算法。ROS 應用軟件子系統主要在機載工控機中實現，主要包括傳感器數據采集程序和ROS 應用層軟件。其中，傳感器數據采集程序完成攝像頭、激光雷達和視覺里程計等傳感器的數據讀取任務，ROS 應用層軟件完成數據的濾波、融合及任務實現的控制策略等。

飛行控制器與機載計算機之間采用串口通信，分為串口讀和串口寫兩部分。其中，串口讀Read() 傳輸的是飛控的反饋數據（見表1），包括無人機的姿態、高度等信息，為無人機導航系統的數據融合、控制策略等任務提供實時反饋信息；串口寫Write() 傳輸的是導航系統的命令信號（見表2），包括導航系統向無人機發送的期望位置、控制量等信息，實現對飛行控制系統的外部控制信號的發送，以此完成設計的飛行任務。

表1 串口反饋數據

表2 串口命令信號

3 實驗教學項目設計與實施

以培養學生創新能力為理念，培養學生發現問題、解決問題及團隊協作能力為導向，加強學生對四旋翼無人機組成及飛行控制原理的掌握為教學目標，本文設計了四旋翼無人機的組裝、操控和參數調試等基本實驗內容，并在此基礎上設計了無人機自主循線飛行綜合性實驗項目。

3.1 四旋翼無人機組裝與參數調試實驗

親手完成一架四旋翼無人機的組裝是掌握無人機硬件模塊組成及各模塊功能的最直接方式，根據實驗教程完成四旋翼無人機的組裝、調試、線路焊接和遙控器對碼等任務也是完成后續項目的基礎。在實驗課程開展過程中，一般4～5 人一個小組，逐步學習飛行原理、認識硬件模塊到完成無人機組裝。組裝完成后的無人機如圖6 所示。組裝完成后，由助教配合檢查接線是否正確及電機、漿葉安裝方向是否匹配等。確認無誤后進行上電測試，若LED 指示信號正常，表示安裝過程正確，隨后即可進行參數調試；否則就要進行故障檢查和排除工作。無人機參數調試是指利用上位機軟件來完成對控制器參數的調整。默認的PID 控制器參數一般可以滿足無人機的穩定飛行，但是由于重心位置、飛行控制器安裝位置等因素的影響，每架無人機的飛行性能會有所不同，因此需要微調姿態內環PID 參數。因為實驗平臺所配置的四旋翼無人機部件的重量和大小相同，所以外環控制器的PID 參數一般可以使用默認參數。

圖6 組裝完成的無人機實物圖

3.2 四旋翼無人機操控實驗

完成無人機的控制器參數調試后，各小組同學即可進行四旋翼無人機的操控實踐和訓練。實驗平臺配置了天地飛ET07 型遙控器，最大支持10 通道，其中雙遙控共4 個通道控制無人機的俯仰、橫滾、航偏和油門，實現無人機的前、后、上、下飛行。SA 通道定義為自動起飛和一鍵降落控制；SB 通道定義為飛行模式切換，包括不定高、定高兩種；SC 通道定義為不定點、定點兩種位置模式。其中定高模式利用氣壓計或激光傳感器的反饋數據實現，定點模式由光流傳感器的反饋數據完成，自動飛行模式主要利用攝像頭或視覺里程計的反饋數據完成。

3.3 四旋翼無人機自主循線飛行實驗

在完成基本實驗任務的基礎上，為加深學生對無人機應用功能的設計、程序實現及任務調試的理解，開發了基于ROS 平臺的四旋翼無人機自主循線飛行綜合實驗。該實驗涉及到圖像處理、數據濾波與融合、ROS 程序開發等方面的知識。循線飛行實驗中，利用光流、激光、姿態傳感器進行數據融合得到無人機相對于地面的飛行速度，然后反饋到位置控制器，實現無人機懸停功能。機載計算機獲取地面標識線的圖像，利用數字圖像處理技術得到無人機相對于圖像坐標系的坐標偏差值和航向角度值，如圖7 所示，這些坐標值通過串口通信反饋給飛行控制器，從而實現無人機的位置控制，重復執行該過程即可實現無人機沿著地面標識線飛行。

圖7 無人機循線示意圖

4 結語

基于STM32 的四旋翼無人機綜合實驗教學平臺融合了自動化、電子信息、計算機等多門專業課知識。學生在此平臺上可以將課堂中所學專業知識運用到實踐中，在鞏固理論知識的同時，提高了動手實踐、創新意識和系統綜合設計能力。兩年來，利用該實驗教學平臺面向我校工科專業開設了“四旋翼無人機綜合實驗項目”開放課程，深受學生的歡迎，每學期的選課人數都超過限定人數。該實驗課程帶領學生進入了無人機應用開發的大門，培養了他們的科研興趣，收獲了無人機相關的知識和開發經驗。選修課程的部分學生先后參加了IMAV、中航工業杯、國際機器人挑戰賽等無人機相關的比賽，均取得了良好的成績。未來，將進一步對該綜合實驗教學平臺的功能進行開發，豐富綜合實驗任務設計，不斷滿足學生對四旋翼無人機相關技術學習的需求，提升選課學生的實踐創新能力，在一流人才培養的過程中，建設實踐實驗教學課程體系中的“金課”。