多旋翼無人機故障檢測及自救系統(tǒng)設計

南京航空航天大學金城學院機電工程與自動化學院 袁 鋼 陳 薇 張芮嘉 賈 寧

0 引言

近年來，隨著無人機的市場需求量不斷增大，其也越來越頻繁地出現(xiàn)在人們的日常生活中。但由于無人機對可能發(fā)生的故障往往難以控制，一旦發(fā)生墜機，對地面人和物造成的傷害是不可估量的。無人機發(fā)生故障時，其飛行姿態(tài)數(shù)據(jù)相較與穩(wěn)態(tài)，將有較大的突變，本系統(tǒng)能夠根據(jù)飛行數(shù)據(jù)準確地計算出飛行姿態(tài)，同時預估電池的剩余電量，在發(fā)生故障時進行報警并自救。

1 總體結構

本系統(tǒng)的硬件組成如圖1所示，主要包括主控模塊、高度檢測模塊（GY-63-03）、慣性模塊（MPU6050）、供電電池管理模塊等。

主控模塊采用意法半導體公司的STM32F103ZET6 型微處理器，傳感器和主控模塊之間的數(shù)據(jù)傳輸通過模擬成降落傘無法打開的情況，本產品自帶獨立電源供電。I2C總線進行；高度檢測模塊采用GY-63氣壓傳感器實時檢測無人機飛行對地高度；慣性單元采用MPU6050作為傳感器，測得無人機的三個姿態(tài)角，通過主控模塊對姿態(tài)數(shù)據(jù)進行解算，用于確認無人機是否偏離穩(wěn)定飛行姿態(tài)。

圖1 系統(tǒng)硬件組成原理圖

系統(tǒng)獨有的電池管理模塊可實時測量無人機供電電池的電壓、電流數(shù)據(jù)，并推算出未來電池狀態(tài)，在低電量狀態(tài)及時報警，避免了因電量低而導致的墜機事件。該模塊主要由霍爾傳感器及采樣電阻組成，并借助STM32的ADC模塊，獲取供電電池的電壓及電流值。

該系統(tǒng)能夠在無人機達到墜機極限狀態(tài)，或達到供電電池電量警戒值時，產生報警信號并切斷無人機電源，彈射傘降裝置。此外，本系統(tǒng)為了避免無人機由于電池電量低而無法啟動降落傘的情況，本產品自帶獨立電源供電。

2 系統(tǒng)故障診斷方法設計

無人機墜機的發(fā)生具有一定規(guī)律性，若發(fā)生碰撞或動力損毀，其姿態(tài)角將發(fā)生改變，即會導致當前角速度、加速度發(fā)生驟變；若是電池故障，姿態(tài)角改變不大，但是其高度一定下降的很快。

2.1 穩(wěn)態(tài)判別

多旋翼無人機靠改變自身的姿態(tài)角和螺旋槳差速來實現(xiàn)方向可控運動，靠發(fā)動機持續(xù)對空氣做功來維持高度。飛行器飛行過程中的某些物理量的變化是有一定的規(guī)律的。

若檢測系統(tǒng)測得角速度β，加速度a，高度h，并設無人機角度為α，高度的變化率為h’時間為t，有式(1)、式(2)：

一旦α>70°，β>200°/s，a>5g，H’>0.8g即可判斷無人機偏離穩(wěn)態(tài)。

2.2 電池能量推算

無人機鋰電池在放電過程中電壓會逐漸降低，并且電量不同的時刻電壓變化率不同，而電壓相同且容量相同的電池有相同的放電曲線。

圖2 電池放電V-T曲線

多旋翼無人機使用的鋰電池種類有限，一般來說，鋰電池單片電壓為2.5-4.2V之間。電壓2.5v對應電池完全放電結束，且電池過度放電損毀；電壓4.2V則為100%電量。

對電池進行放電測量得到V-t曲線，如圖2所示，擬合得到式(3)：

其中k是比例系數(shù)，不同種類的電池k不同。

根據(jù)k值與相應曲線相對應即可判斷所使用的電池種類及參數(shù)，包括電池電壓范圍以及電池總能量，將電壓V與電流I的乘積對時間積分，得到當前時刻電池已消耗的能量E，如式(4)所示：

針對上述問題，算法流程圖如圖3所示。

圖3 算法流程圖

3 總結

本產品重量輕，體積小，價格低，解決了兼容性問題，實現(xiàn)了低空開傘，非常適合各類無人機攜帶。本系統(tǒng)對無人機的飛行狀態(tài)實時監(jiān)測，在無人機出現(xiàn)問題前報警，在出現(xiàn)不可挽回問題后彈射自救，以降低無人機飛行風險，是對無人機風險的把控和降低，對人民生命財產安全的尊重與保障。

[1]程煦,郭珊珊,陳華賓．基于STM32單片機的四旋翼飛行器設計[J]．電子世界,2017(03)∶121-124．

[2]劉恒山．基于STM32單片機的四旋翼飛行器控制系統(tǒng)研究與設計[D]．內蒙古科技大學,2017．

[3]羅浩．無人機飛行姿態(tài)檢測及控制研究[J]．電子世界,2018(01)∶175-176．

[4]何松,陳興武．基于MPU9250的無人機姿態(tài)信息采集及處理[J]．福建工程學院學報,2016,14(06)∶587-592．