四旋翼飛行器嵌入式陀螺儀數(shù)據(jù)采集設計

摘 要

本文以創(chuàng)新開發(fā)套件的小型四旋翼飛行器為實際對象，通過對陀螺傳感器L3G4200D采集原始數(shù)據(jù)以及整合三軸加速度計LIS3DH的一段經(jīng)過測試的配置信息，用于配合運行控制算法和處理從慣性導航系統(tǒng)傳輸過來的姿態(tài)信息。通過多次調(diào)試控制算法，進行多次飛行試驗，該芯片配置數(shù)據(jù)可以有效滿足穩(wěn)定飛行數(shù)據(jù)采集的功能。

【關鍵詞】四旋翼飛行器 STM32F103 陀螺傳感器L3G4200D 加速度計LIS3DH

1 引言

四旋翼飛行器是一種能夠實現(xiàn)垂直的起降，并在空中可以隨時通過調(diào)整飛行姿態(tài)來改變飛行方位的飛行器。四旋翼飛行器利用旋翼轉向在前后與左右的反相，來抵消反扭力矩，從而保持機體的平衡。在現(xiàn)實應用中，由于小型多旋翼飛行器具有其它飛行器所無法比擬的優(yōu)勢，因此其在現(xiàn)代社會諸多領域得到廣泛應用，包括攝影航拍、電網(wǎng)線路巡檢、環(huán)境保護監(jiān)測、農(nóng)林施肥作業(yè)等。

目前四旋翼飛行器主要分為遙控器進行的遙控型和自主控制的自主飛控型兩種。針對四旋翼飛行器控制技術的主要集中在兩大熱點研究領域：一個是基于慣性導航的自主控制系統(tǒng)，另外一個是基于視覺飛行的自主控制系統(tǒng)。

2 嵌入式陀螺儀數(shù)據(jù)采集的實現(xiàn)

為了實現(xiàn)四旋翼飛行器在空中自主、持續(xù)飛行，同時可以保證飛行過程中的姿態(tài)穩(wěn)定和平穩(wěn)飛行。本文采用一套自主開發(fā)基于STM32F103主控的飛行控制系統(tǒng)對陀螺傳感器L3G4200D采集原始數(shù)據(jù)部分進行設計，整套控制系統(tǒng)主要分為姿態(tài)控制系統(tǒng)、加速度控制系統(tǒng)和高度控制系統(tǒng)，控制系統(tǒng)均搭載在硬件平臺上。

2.1 飛控硬件平臺總體設計

四旋翼飛行器的硬件平臺主要分為兩大部分，第一部分是慣導平臺的電路設計，它是采集飛行器機體的運動狀態(tài)信息的作為控制系統(tǒng)控制的重要的信息依據(jù)。慣導平臺的反饋精度直接影響到控制系統(tǒng)的控制精度。第二部分是主控芯片的電路設計。慣導平臺本文選取陀螺傳感器L3G4200D，它是一種低功率的三軸陀螺傳感器，采用專門微細加工工藝制造，通過IC接口技術構成一個CMOS型的專門電路并留有數(shù)字接口（I2C/SPI），可以更好地跟傳感器元件匹配。陀螺傳感L3G4200D器硬件電路圖如圖1所示。硬件電路設計的重點在于芯片的輸入電壓及SPI總線的供電電壓均為3.3V和陀螺傳感器與姿態(tài)處理芯片的SPI通信。加速度計選取的是LIS3DH，是一款低功率的三軸加速度計。主控芯片和姿態(tài)處理芯片釆用的是STM32F103，進行飛行控制和姿態(tài)信息的處理。姿態(tài)控制系統(tǒng)采用基于神經(jīng)網(wǎng)絡的PID控制飛行器的姿態(tài)角，整個系統(tǒng)采用改進型負反饋結構。

2.2 飛行器系統(tǒng)的軟件設計

本文的四旋翼飛行器的軟件系統(tǒng)主要完成飛控主板和PC端無線遙控部分的程序設計，軟件程序是在集成編譯環(huán)境Keil MDK-ARM下由C語言編程實現(xiàn)。飛控主板程序設計流程圖如圖2所示，主要操作包括首先開機對無線模塊、L3G4200D、LIS3DH以及PWM電機等進行初始化，再對整個系統(tǒng)的慣性測量單元IMU進行零偏調(diào)整，然后設置無線接收模塊等待對解鎖輸入信息的判斷，最后如果解鎖成功，則對IMU讀取出來的簡單的加速度、陀螺儀角速度的原始數(shù)據(jù)作處理得到本系統(tǒng)想要得到姿態(tài)角度，從而進行PID電機控制，并通過飛控板上ADC實時獲取板上供電電壓參數(shù)以便于自動返航情況處理。其中L3G4200D初始化及數(shù)據(jù)采集操作主要有：寄存器配置、數(shù)據(jù)輸出速率配置、工作模式設置、三維坐標軸采集參數(shù)設置、高通濾波器使能啟動和數(shù)據(jù)量程設定等。

飛控程序中使用定時器中斷的方式對時間進行處理，每0.5ms中斷一次，通過對中斷標志位的查詢結合不同時間的間隔來分別處理優(yōu)先級不同的任務，每次中斷后立即檢查無線模塊的接收數(shù)據(jù)，確保飛控主板控制信息的實時性。每2次中斷即1ms獲取一次IMU單元的原始數(shù)據(jù)并作濾波處理獲得較為準確的系統(tǒng)加速度、角速度的當前數(shù)據(jù)。每4次中斷即2ms測量并計算當前飛控主板的運動姿態(tài)，與PC機遙控端的目標姿態(tài)一起求取差值再通過PID控制算法對各個電機進行PWM調(diào)速控制。每200次中斷即100ms，飛控系統(tǒng)由STM32F103的ADC通道采集一次主板供電電壓，并把供電電壓實時參數(shù)返送給PC端。 PC端無線遙控部分的程序功能就是把遙控端的操作動作轉化成信號傳給飛控主板，并且實時顯示PC端當前所執(zhí)行的控制信息和飛控主板返送的飛行姿態(tài)及供電電壓參數(shù)等信息。

2.3 系統(tǒng)運作過程

使用PC機發(fā)送控制指令，發(fā)送到機體的飛控板STM32_CONTROL上。飛控板通過接收姿態(tài)處理板的運動狀態(tài)信息和PC機的控制指令進行控制算法的處理，得出控制要求的PWM波。PWM波經(jīng)過電調(diào)的處理產(chǎn)生出占空比符合PWM波的電壓信號輸入四個電機。根據(jù)電壓的變化，電機的轉速變化引起機體的姿態(tài)信息的變化。陀螺儀和加速度計組成的捷聯(lián)式慣性導航系統(tǒng)， 用計算機把測量信號變換為導航參數(shù)，測量機體的姿態(tài)信息，陀螺儀測出機體的姿態(tài)角速度，加速度計測出機體的線加速度。陀螺儀使用SPI總線傳輸?shù)阶藨B(tài)處理芯片進行姿態(tài)信總的處理得出飛行器的姿態(tài)角度和角速度和線加速度傳輸?shù)絊TM32F103中。

3 結果分析

本文的系統(tǒng)可以較好的實現(xiàn)四旋翼飛行器嵌入式陀螺儀數(shù)據(jù)采集，從IMU獲取并作濾波算法處理后的L3G4200D、LIS3DH數(shù)據(jù)準確有效，并完成了四旋翼飛行器飛行姿態(tài)的穩(wěn)定控制以及自動循跡返航。這就為接下來六旋翼或八旋翼等多旋翼飛行器的穩(wěn)定控制研究奠定了理論和實踐基礎。

參考文獻

[1]Scott D.Hanford.Unmanned Aircraft System Roadmap.2005-2030.Office of the Secretary ofDefense（USA） Reprort.August，2005：1-5.

[2]張春慧.高精度捷聯(lián)式慣性導航系統(tǒng)算法研究[碩士學位論文].哈爾濱工程大學，2005：23-27.

[3]吳軍，鮑其蓮，高精度捷聯(lián)慣導姿態(tài)更新優(yōu)化算法研究[J].電子測量技術，2010，15（13）：76-80.

作者簡介

陳新銳（1982-），男，廣西壯族自治區(qū)北海市人。碩士研究生學歷。現(xiàn)為北海職業(yè)學院講師。主要研究方向為數(shù)字信號處理及嵌入式應用開發(fā)。

作者單位

北海職業(yè)學院 廣西壯族自治區(qū)北海市 536000