【摘要】：小型多旋翼無人機(jī)由于其便攜、靈活、功能性強(qiáng)的特點(diǎn),近些年受到了很大的關(guān)注。無人機(jī)的姿態(tài)控制系統(tǒng)需要得到準(zhǔn)確的姿態(tài)信息作為反饋以便進(jìn)行控制,同時(shí)要實(shí)現(xiàn)航跡跟蹤、定點(diǎn)懸停等功能也需要準(zhǔn)確的位置及速度信息。但無人機(jī)上空間有限,所搭載的導(dǎo)航傳感器精度較低,測量噪聲大,單靠某一個(gè)傳感器的測量是無法得到準(zhǔn)確的導(dǎo)航信息的。本文的研究重點(diǎn)就是通過設(shè)計(jì)導(dǎo)航解算算法,將多個(gè)傳感器的測量信息進(jìn)行融合,抑制單個(gè)傳感器的噪聲,從而獲得較為準(zhǔn)確的姿態(tài)、位置、速度信息,因此本文針對小型多旋翼無人機(jī)的導(dǎo)航信息解算的研究具有重要的研究價(jià)值和應(yīng)用前景。本文首先對導(dǎo)航相關(guān)原理知識以及機(jī)上常用導(dǎo)航傳感器的特性進(jìn)行了介紹,包括常用導(dǎo)航坐標(biāo)系、姿態(tài)角的表示方法、陀螺儀及加速度計(jì)的測量原理和噪聲特性、磁強(qiáng)計(jì)及加速度計(jì)的姿態(tài)測量原理。然后,針對無人機(jī)在飛行過程中電機(jī)轉(zhuǎn)動(dòng)產(chǎn)生的高頻振動(dòng)會(huì)使陀螺儀、加速度計(jì)的測量值產(chǎn)生較大偏差的問題,研究并設(shè)計(jì)了數(shù)字低通濾波器,以便過濾掉傳感器輸出信號中機(jī)體振動(dòng)所帶來的高頻噪聲。本文通過分析機(jī)體高頻振動(dòng)對加速度計(jì)和陀螺儀的輸出信號產(chǎn)生的影響,得到噪聲的頻率特性,并據(jù)此分別使用hamming窗函數(shù)法以及yulewalk函數(shù)法設(shè)計(jì)了FIR、IIR數(shù)字低通濾波器,并通過濾波效果以及濾波實(shí)時(shí)性的考慮,選擇了可以有效抑制機(jī)體高頻噪聲幅值的數(shù)字低通濾波器。接著,針對如何準(zhǔn)確地獲取無人機(jī)的姿態(tài)信息的問題,設(shè)計(jì)了四元數(shù)形式的二階互補(bǔ)濾波姿態(tài)解算算法并且對算法的解算效果進(jìn)行了驗(yàn)證。該算法根據(jù)陀螺儀、加速度計(jì)、磁強(qiáng)計(jì)頻率特性互補(bǔ)的原理,對三個(gè)傳感器的輸出進(jìn)行數(shù)據(jù)融合,將陀螺儀作為主要測量元件,利用加速度計(jì)和磁強(qiáng)計(jì)對其進(jìn)行修正,從而得到準(zhǔn)確的姿態(tài)解算結(jié)果。同時(shí),在Matlab中對算法程序進(jìn)行了編譯,搭建了仿真系統(tǒng),分別使用仿真數(shù)據(jù)以及實(shí)驗(yàn)飛行數(shù)據(jù)在Matlab中對算法進(jìn)行了驗(yàn)證。最后,本文針對如何準(zhǔn)確獲取無人機(jī)的位置、速度信息的問題,設(shè)計(jì)了基于擴(kuò)展卡爾曼濾波器的位置、速度信息解算算法并且對算法進(jìn)行了驗(yàn)證。該算法利用加速度計(jì)、氣壓計(jì)、GPS對機(jī)體飛行過程中的位置、速度進(jìn)行測量,并且通過擴(kuò)展卡爾曼濾波算法對三者的信息進(jìn)行融合。本算法基于連續(xù)-離散時(shí)間系統(tǒng),引入加速度計(jì)的偏移量作為狀態(tài)向量,通過利用四階龍格庫塔法避免了雅克比矩陣的計(jì)算,提高了解算速度,最后利用仿真和實(shí)驗(yàn)數(shù)據(jù)對算法進(jìn)行了驗(yàn)證。
[Abstract]:Small multi-rotor UAV has attracted much attention in recent years because of its portable, flexible and functional characteristics. The attitude control system of UAV needs accurate attitude information as feedback to control. At the same time, it also needs accurate position and velocity information to realize track tracking, fixed point hovering and other functions. However, the space of UAV is limited, the accuracy of navigation sensor is low and the measurement noise is large. It is impossible to get accurate navigation information by a single sensor alone. The focus of this paper is to design a navigation algorithm to fuse the measurement information of multiple sensors to suppress the noise of a single sensor, so as to obtain more accurate information of attitude, position and velocity. Therefore, the study of navigation information calculation for small multi-rotor UAV in this paper has important research value and application prospect. This paper first introduces the related principles of navigation and the characteristics of common navigation sensors on board, including the common navigation coordinate system, the expression method of attitude angle, the measurement principle and noise characteristics of gyroscopes and accelerometers. The principle of attitude measurement for magnetometers and accelerometers. Then, aiming at the problem that the high frequency vibration caused by the motor rotation of UAV during flight will make the measurement value of gyroscope and accelerometer deviate greatly, the digital low-pass filter is studied and designed. In order to filter out the high frequency noise caused by the vibration of the body in the output signal of the sensor. By analyzing the influence of high frequency vibration on the output signals of accelerometers and gyroscopes, the frequency characteristics of noise are obtained in this paper. Based on this, the Fir IIR digital low-pass filters are designed by using hamming window function method and yulewalk function method, respectively. Considering the effect of filtering and the real time of filtering, a digital low-pass filter which can effectively suppress the amplitude of high frequency noise is selected. Then, aiming at the problem of how to obtain the attitude information of UAV accurately, a quaternion second-order complementary filtering attitude algorithm is designed and the effect of the algorithm is verified. According to the principle of complementary frequency characteristics of gyroscopes, accelerometers and magnetometers, the algorithm fuses the output data of the three sensors, takes gyroscope as the main measuring element, and modifies it by using accelerometer and magnetometer. Thus the accurate attitude solution is obtained. At the same time, the algorithm program is compiled in Matlab, and the simulation system is built. The algorithm is verified in Matlab using the simulation data and the experimental flight data. Finally, aiming at the problem of how to accurately obtain the position and velocity information of UAV, the location and velocity information algorithm based on extended Kalman filter is designed and validated. The algorithm uses accelerometers, barometers and GPS to measure the position and velocity of the airframe during flight, and uses extended Kalman filter algorithm to fuse the three information. In this algorithm, based on the continuous discrete time system, the offset of accelerometer is introduced as the state vector. By using the fourth order Runge-Kutta method to avoid the calculation of the Jacobian matrix, the computational speed of the solution is improved. Finally, the algorithm is verified by simulation and experimental data.
【學(xué)位授予單位】：哈爾濱工業(yè)大學(xué)
【學(xué)位級別】：碩士
【學(xué)位授予年份】：2017
【分類號】：V249.3;TP212

【相似文獻(xiàn)】

相關(guān)期刊論文 前10條

1 趙忠;加速度計(jì)零偏測量的一種新方法[J];壓電與聲光;2000年06期

2 于治會(huì),王阿春;關(guān)于加速度計(jì)參數(shù)的選定(1)[J];傳感器世界;2000年11期

3 于治會(huì),王阿春;關(guān)于加速度計(jì)參數(shù)的選定(下)[J];傳感器世界;2000年12期

4 于治會(huì);加速度計(jì)的靜態(tài)校準(zhǔn)[J];宇航計(jì)測技術(shù);2000年02期

5 顧英;慣導(dǎo)加速度計(jì)技術(shù)綜述[J];飛航導(dǎo)彈;2001年06期

6 徐剛,于治會(huì);關(guān)于加速度計(jì)參數(shù)的選定[J];氣象水文海洋儀器;2001年01期

7 徐剛,于治會(huì);關(guān)于加速度計(jì)參數(shù)的選定[J];鑿巖機(jī)械氣動(dòng)工具;2001年01期

8 高宗;正確地連接和使用加速度計(jì)[J];世界產(chǎn)品與技術(shù);2001年04期

9 顧英,趙連元;微硅加速度計(jì)技術(shù)綜述[J];飛航導(dǎo)彈;2002年09期

10 于治會(huì);關(guān)于加速度計(jì)參數(shù)的選定[J];航空兵器;2002年06期

相關(guān)會(huì)議論文 前10條

1 曹慧丹;沈昱明;賴際舟;;微硅加速度計(jì)標(biāo)定及試驗(yàn)研究[A];第六屆全國信息獲取與處理學(xué)術(shù)會(huì)議論文集（2）[C];2008年

2 索智群;喬東海;;力平衡模擬反饋電容加速度計(jì)的研究[A];2010’中國西部聲學(xué)學(xué)術(shù)交流會(huì)論文集[C];2010年

3 劉惠蘭;林恒;李莉;張春熹;;光學(xué)加速度計(jì)的技術(shù)及發(fā)展[A];慣性技術(shù)發(fā)展動(dòng)能發(fā)展方向研討會(huì)論文集[C];2004年

4 劉惠蘭;林恒;李莉;張春熹;;光學(xué)加速度計(jì)的技術(shù)研究與發(fā)展[A];2004全國光學(xué)與光電子學(xué)學(xué)術(shù)研討會(huì)、2005全國光學(xué)與光電子學(xué)學(xué)術(shù)研討會(huì)、廣西光學(xué)學(xué)會(huì)成立20周年年會(huì)論文集[C];2005年

5 錢朋安;;一體化多維加速度計(jì)研究的若干問題分析[A];中國儀器儀表學(xué)會(huì)第九屆青年學(xué)術(shù)會(huì)議論文集[C];2007年

6 宋長福;嚴(yán)小軍;韓豐田;郭曉芳;馬高印;;硅微靜電懸浮加速度計(jì)關(guān)鍵技術(shù)研究[A];微機(jī)電慣性技術(shù)的發(fā)展現(xiàn)狀與趨勢——慣性技術(shù)發(fā)展動(dòng)態(tài)發(fā)展方向研討會(huì)文集[C];2011年

7 李建飛;薛兵;張俊峰;朱小毅;王曉蕾;;應(yīng)用于MEMS加速度計(jì)的小型恒溫系統(tǒng)的實(shí)現(xiàn)[A];中國地震學(xué)會(huì)第14次學(xué)術(shù)大會(huì)專題[C];2012年

8 周澤兵;祝竺;;靜電懸浮加速度計(jì)研究[A];中國地球物理2013——第二十六專題論文集[C];2013年

9 薛旭;李丹東;劉國文;萬蔡辛;張承亮;;MEMS加速度計(jì)工程樣機(jī)的研制[A];慣性技術(shù)發(fā)展動(dòng)態(tài)發(fā)展方向研討會(huì)文集——新世紀(jì)慣性技術(shù)在國民經(jīng)濟(jì)中的應(yīng)用[C];2012年

10 張亮;陸秋海;;靜電懸浮式電容差分加速度計(jì)測量原理與動(dòng)特性設(shè)計(jì)[A];第九屆全國振動(dòng)理論及應(yīng)用學(xué)術(shù)會(huì)議論文集[C];2007年

相關(guān)重要報(bào)紙文章 前4條

1 包秋紅;加速度計(jì)測試的加速者[N];中國航空報(bào);2004年

2 唐新培;“黑黢俠”再顯神威[N];中國航天報(bào);2012年

3 黃忠魁 付秀娟 本報(bào)記者 徐建華;“敏感精靈”助力嫦娥探月[N];中國質(zhì)量報(bào);2014年

4 唐新培;搬走“三座山” 促成“太空吻”[N];中國航天報(bào);2011年

相關(guān)博士學(xué)位論文 前10條

1 蔣玉齊;高量程MEMS加速度計(jì)封裝研究[D];中國科學(xué)院研究生院（上海微系統(tǒng)與信息技術(shù)研究所）;2004年

2 王俊;振子型光纖光柵加速度計(jì)關(guān)鍵技術(shù)研究[D];國防科學(xué)技術(shù)大學(xué);2016年

3 楊杰;無陀螺捷聯(lián)慣導(dǎo)系統(tǒng)加速度計(jì)構(gòu)型研究與誤差分析[D];哈爾濱工程大學(xué);2011年

4 張習(xí)文;微小型加速度計(jì)的精密裝配及影響性能的因素研究[D];大連理工大學(xué);2013年

5 黃添添;氣隙磁力表征型磁懸浮加速度計(jì)的關(guān)鍵技術(shù)研究[D];浙江大學(xué);2015年

6 劉志平;無陀螺捷聯(lián)慣導(dǎo)系統(tǒng)若干關(guān)鍵技術(shù)研究[D];哈爾濱工程大學(xué);2010年

7 李博;基于共振隧穿結(jié)構(gòu)介觀壓阻效應(yīng)的納機(jī)電加速度計(jì)研究[D];中北大學(xué);2008年

8 劉力;慣性傳感器扭擺測試中地面振動(dòng)和放電金絲的影響研究[D];華中科技大學(xué);2012年

9 王世明;基于離心機(jī)的慣性儀表測試方法研究與誤差分析[D];哈爾濱工業(yè)大學(xué);2014年

10 邢朝洋;高性能MEMS慣性器件工程化關(guān)鍵技術(shù)研究[D];中國航天科技集團(tuán)公司第一研究院;2017年

相關(guān)碩士學(xué)位論文 前10條

1 王世昌;基于角速率的加速度計(jì)陣列誤差系數(shù)標(biāo)定方法的研究[D];中北大學(xué);2009年

2 徐小麗;高過載條件下微型加速度計(jì)的動(dòng)態(tài)分析[D];南京理工大學(xué);2009年

3 黎淵;三軸高g加速度計(jì)的測試?yán)碚撆c實(shí)驗(yàn)研究[D];國防科學(xué)技術(shù)大學(xué);2008年

4 鮑路路;高g值加速度計(jì)及其檢測電路的設(shè)計(jì)[D];中國科學(xué)技術(shù)大學(xué);2009年

5 高宇;捷聯(lián)系統(tǒng)中加速度計(jì)信息處理技術(shù)研究[D];哈爾濱工程大學(xué);2010年

6 胡紅革;硅撓性伺服加速度計(jì)設(shè)計(jì)[D];電子科技大學(xué);2002年

7 紀(jì)君寵;鈸式結(jié)構(gòu)加速度計(jì)的研究與設(shè)計(jì)[D];北京大學(xué);2008年

8 李永光;高精度加速度計(jì)標(biāo)定與補(bǔ)償技術(shù)研究[D];哈爾濱工業(yè)大學(xué);2011年

9 李園晴;懸絲支承加速度計(jì)溫度誤差建模及補(bǔ)償研究[D];上海交通大學(xué);2011年

10 王巍;高精度加速度計(jì)測量系統(tǒng)的分析與設(shè)計(jì)[D];哈爾濱工程大學(xué);2011年

，

本文編號：2161366