關(guān)鍵詞:四元數(shù) 陀螺儀 加速度計(jì) 地磁計(jì) 姿態(tài)解算
摘要:云臺(tái)的穩(wěn)定性對(duì)搭載的設(shè)備有重要影響,為實(shí)現(xiàn)云臺(tái)自穩(wěn),設(shè)計(jì)了一種基于多傳感器數(shù)據(jù)融合的云臺(tái)自穩(wěn)控制方法。采用三軸陀螺儀、三軸加速度計(jì)、三軸地磁的(Attitude and Heading Reference System,AHRS)系統(tǒng)獲取角速度、加速度及地磁強(qiáng)度等信號(hào),采用卡爾曼濾波算法對(duì)加速度進(jìn)行處理,采用四元數(shù)對(duì)三種數(shù)據(jù)進(jìn)行融合,并求解云臺(tái)俯仰姿態(tài)角和偏航姿態(tài)角,使用串級(jí)雙閉環(huán)PID作為控制策略。實(shí)驗(yàn)結(jié)果表明,該方法能夠使云臺(tái)在復(fù)雜環(huán)境下具有較高的精度和抗干擾能力,同時(shí)具有超調(diào)量小、魯棒性強(qiáng)的特點(diǎn)。
控制工程雜志要求:
{1}全文注釋采用當(dāng)頁(yè)腳注模式,用規(guī)范的中文或外文標(biāo)點(diǎn)符號(hào)。編碼用①、②、③……之類排序,每頁(yè)重新編碼。
{2}本刊可以對(duì)準(zhǔn)備發(fā)表的文章酌情修改、刪節(jié),不愿本刊修改、刪節(jié)者請(qǐng)隨稿注明。
{3}作者姓名在題名下按序排列,排序應(yīng)由全體作者共同討論確定,稿件受理后不應(yīng)再作改動(dòng)。確需改動(dòng)時(shí),必須出示單位證明以及所有作者親筆簽名表明對(duì)署名改動(dòng)無(wú)異議的書(shū)面證明。
{4}國(guó)家及省部級(jí)自然科學(xué)基金資助項(xiàng)目研究論文、國(guó)家及省部級(jí)獲獎(jiǎng)項(xiàng)目論文優(yōu)先錄用。
{5}正文按“前言、資料(對(duì)象)與方法、結(jié)果、討論”的順序書(shū)寫,為一級(jí)標(biāo)題;以下各級(jí)小標(biāo)題按照:一、(一)、1.安排序號(hào)。
注:因版權(quán)方要求,不能公開(kāi)全文,如需全文,請(qǐng)咨詢雜志社