農(nóng)用多軸無人機(jī)姿態(tài)解算與控制.pdf

1、農(nóng)用小型多軸無人機(jī)飛行高度低，易受地面氣流的干擾，且允許姿態(tài)糾正的時(shí)間很短。因此，農(nóng)用多軸無人機(jī)對(duì)姿態(tài)數(shù)據(jù)的實(shí)時(shí)性和準(zhǔn)確度要求很高。本文通過理論分析，對(duì)比不同算法，重點(diǎn)針對(duì)農(nóng)用無人機(jī)姿態(tài)解算方法進(jìn)行研究，以期提高姿態(tài)解算結(jié)果的實(shí)時(shí)性和準(zhǔn)確度。
　　研究過程中四軸無人機(jī)試驗(yàn)樣機(jī)采用X型結(jié)構(gòu)，設(shè)計(jì)了姿態(tài)解算系統(tǒng);根據(jù)四軸無人機(jī)結(jié)構(gòu)，忽略了空氣阻力，近似求得部分結(jié)構(gòu)參數(shù)，建立了四軸無人機(jī)動(dòng)力學(xué)模型;為了方便在實(shí)驗(yàn)室內(nèi)進(jìn)行飛行試驗(yàn)，設(shè)計(jì)了

2、一種可約束飛行器運(yùn)動(dòng)范圍的多自由度測(cè)試臺(tái)架。該多自由度測(cè)試臺(tái)架在5個(gè)自由度上為無人機(jī)預(yù)留了姿態(tài)調(diào)整區(qū)間。
　　姿態(tài)解算過程中，將四軸無人機(jī)安裝到多自由度測(cè)試臺(tái)架上，實(shí)測(cè)了加速度計(jì)、磁力計(jì)、陀螺儀的信號(hào)特點(diǎn)。根據(jù)上述三種姿態(tài)傳感器的信號(hào)特點(diǎn)，對(duì)比分析了互補(bǔ)濾波、改進(jìn)型互補(bǔ)濾波、基于加權(quán)滑動(dòng)濾波方差的卡爾曼濾波等算法，提出了一種基于前置卡爾曼濾波器的互補(bǔ)融合姿態(tài)解算方法。對(duì)于姿態(tài)控制，本文結(jié)合四軸無人機(jī)的力學(xué)模型，對(duì)比分析了PID控制

3、算法和FUZZY-PID控制算法，設(shè)計(jì)了PID串聯(lián)FUZZY-PID的姿態(tài)控制方案。
　　實(shí)驗(yàn)結(jié)果顯示，系統(tǒng)時(shí)鐘為72MHz時(shí)，本文所提出的姿態(tài)解算算法運(yùn)行周期比基于加權(quán)滑動(dòng)濾波方差的卡爾曼濾波等算法短了0.246ms，姿態(tài)解算誤差減少了2°;姿態(tài)更新時(shí)間比改進(jìn)型互補(bǔ)濾波融合算法提前約了1ms;表明本文所提出的姿態(tài)解算算法同時(shí)具備互補(bǔ)濾器誤差小，卡爾曼濾波器實(shí)時(shí)性強(qiáng)的優(yōu)點(diǎn)?？刂葡到y(tǒng)仿真結(jié)果顯示PID串聯(lián)FUZZY-PID的姿態(tài)控制