四旋翼飛行器姿態(tài)角估計(jì)與控制.pdf

1、四旋翼飛行器因機(jī)械設(shè)計(jì)簡(jiǎn)單、體積小、飛行速度快、機(jī)動(dòng)性強(qiáng)、控制靈活等特點(diǎn)被廣泛應(yīng)用于軍事、民用以及科學(xué)研究等眾多領(lǐng)域。同時(shí)，它也是一個(gè)飛行狀態(tài)復(fù)雜的非線(xiàn)性欠驅(qū)動(dòng)系統(tǒng)，在高動(dòng)態(tài)飛行狀態(tài)下，難以建立準(zhǔn)確的數(shù)學(xué)模型對(duì)其姿態(tài)進(jìn)行準(zhǔn)確描述。
　　本文通過(guò)對(duì)四旋翼飛行器姿態(tài)傳感器（加速度傳感器、磁力計(jì)、陀螺儀）工作原理及特性分析，給出了基于多傳感器數(shù)據(jù)組合測(cè)量飛行器姿態(tài)角的方法。重點(diǎn)研究了基于不同數(shù)據(jù)融合算法的姿態(tài)角數(shù)據(jù)融合問(wèn)題，并利用融合后

2、的角度實(shí)現(xiàn)對(duì)四旋翼飛行器小角度擾動(dòng)的穩(wěn)定控制。利用加速度傳感器和磁力計(jì)建立組合測(cè)量飛行器姿態(tài)角的數(shù)學(xué)模型，利用坐標(biāo)系變換建立陀螺儀測(cè)量姿態(tài)角數(shù)學(xué)模型。分析磁力計(jì)解算偏航角過(guò)程中產(chǎn)生較大影響的羅差，并通過(guò)最小二乘法進(jìn)行羅差補(bǔ)償，得到比較準(zhǔn)確的偏航角估計(jì)值。對(duì)姿態(tài)角解算結(jié)果利用最小方差估計(jì)權(quán)值，建立了基于加權(quán)法解算飛行器姿態(tài)的數(shù)據(jù)融合模型；通過(guò)分析姿態(tài)角解算數(shù)學(xué)模型，分別建立標(biāo)準(zhǔn)卡爾曼濾波和擴(kuò)展卡爾曼濾波的狀態(tài)方程和測(cè)量方程，利用加速度計(jì)和

3、磁力計(jì)數(shù)據(jù)，實(shí)時(shí)反饋修正陀螺儀的積分誤差。針對(duì)本文中提出的三種數(shù)據(jù)融合算法，分別利用MATLAB進(jìn)行仿真?；诩訖?quán)融合方法解算姿態(tài)角在一定程度上能夠提高姿態(tài)角解算精度，且建模簡(jiǎn)單，計(jì)算量??；標(biāo)準(zhǔn)卡爾曼濾波對(duì)于姿態(tài)角解算精度優(yōu)于加權(quán)融合，但航向角的計(jì)算依賴(lài)于俯仰角和橫滾角，俯仰角和橫滾角的估計(jì)要在偏航角之前，實(shí)時(shí)性較差；擴(kuò)展卡爾曼濾波建模和計(jì)算比較繁瑣，但濾波結(jié)果最優(yōu)。最后將融合估算角度和目標(biāo)角度差值作為輸入量，利用增量式PID控制算法得