


下載本文檔
版權(quán)說(shuō)明:本文檔由用戶(hù)提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)
文檔簡(jiǎn)介
1、雙軸微機(jī)械陀螺儀的移動(dòng)機(jī)器人運(yùn)動(dòng)檢測(cè)系統(tǒng)引言在未知環(huán)境中,路況具有復(fù)雜性及未知性特點(diǎn)。移動(dòng)機(jī)器人準(zhǔn)確的路況探測(cè)及其自身的平穩(wěn)運(yùn)行,對(duì)機(jī)載設(shè)備與探測(cè)任務(wù)本身都非常重要。目前,對(duì)移動(dòng)機(jī)器人運(yùn)動(dòng)控制研究多集中在前向通道的算法研究,有關(guān)狀態(tài)信息檢測(cè)、傳輸反饋環(huán)節(jié)的研究相對(duì)較少。雙軸微機(jī)械陀螺儀傳感器可以測(cè)量機(jī)器人的俯仰與翻轉(zhuǎn),但微機(jī)械陀螺儀有隨機(jī)漂移性,無(wú)法直接應(yīng)用,需要對(duì)輸出值作算法處理。參考文獻(xiàn)中的微機(jī)械陀螺儀隨機(jī)漂移的算法,可以在一定程度引言 在未知環(huán)境中,路況具有復(fù)雜性及未知性特點(diǎn)。移動(dòng)機(jī)器人準(zhǔn)確的路況探測(cè)及其自身的平穩(wěn)運(yùn)行,對(duì)機(jī)載設(shè)備與探測(cè)任務(wù)本身都非常重要。目前,對(duì)移動(dòng)機(jī)器人運(yùn)動(dòng)控制研究多
2、集中在前向通道的算法研究,有關(guān)狀態(tài)信息檢測(cè)、傳輸反饋環(huán)節(jié)的研究相對(duì)較少。 雙軸微機(jī)械陀螺儀傳感器可以測(cè)量機(jī)器人的俯仰與翻轉(zhuǎn),但微機(jī)械陀螺儀有隨機(jī)漂移性,無(wú)法直接應(yīng)用,需要對(duì)輸出值作算法處理。參考文獻(xiàn)中的微機(jī)械陀螺儀隨機(jī)漂移的算法,可以在一定程度上解決漂移方面的問(wèn)題,但仍有改進(jìn)的空間,濾波性能有待進(jìn)一步優(yōu)化提高。在現(xiàn)有自適應(yīng)UKF算法的基礎(chǔ)上,改變比例對(duì)稱(chēng)采樣策略的相關(guān)參數(shù)可達(dá)到較好的濾波效果?,F(xiàn)有的以ATmegal6為微處理器的CAN總線(xiàn)程序還有一些不完備之處,本文采用PeliCAN模式加入了完備的錯(cuò)誤分析程序,并支持系統(tǒng)自身測(cè)試功能。1 系統(tǒng)硬件設(shè)計(jì) 移動(dòng)機(jī)器人運(yùn)動(dòng)檢測(cè)系統(tǒng)原理如圖1所示。采
3、用InvenSense公司生產(chǎn)的IDG300型雙軸微機(jī)械陀螺儀進(jìn)行移動(dòng)機(jī)器人運(yùn)動(dòng)過(guò)程的俯仰與翻轉(zhuǎn)角度檢測(cè);AD采樣電路的主芯片為8位AD轉(zhuǎn)換器ADC0809。采集的數(shù)據(jù)經(jīng)改進(jìn)的自適應(yīng)UKF算法濾波后,經(jīng)CAN節(jié)點(diǎn)向運(yùn)動(dòng)控制平臺(tái)傳輸機(jī)器人的運(yùn)動(dòng)狀態(tài)數(shù)據(jù)。以ATmegal6為微處理器,SJAl000為CAN協(xié)議控制器,PCA82C250為CAN收發(fā)器的CAN節(jié)點(diǎn)原理如圖2所示。2 系統(tǒng)軟件設(shè)計(jì)21 改進(jìn)自適應(yīng)UKF濾波算法 改進(jìn)的自適應(yīng)UKF算法如圖3所示。 經(jīng)典UKF濾波算法采用某種策略得到狀態(tài)估計(jì)sigma點(diǎn)集后,大致分兩個(gè)步驟預(yù)測(cè)與更新,具體方程見(jiàn)參考文獻(xiàn)。不同的采樣策略會(huì)影響sigma點(diǎn)采
4、樣及sigma點(diǎn)個(gè)數(shù)計(jì)算。比例對(duì)稱(chēng)采樣方法中具體的sigma點(diǎn)采樣方法為: 式(1)式(5)中需要確定3個(gè)參數(shù)α、和。有一定的經(jīng)驗(yàn)值,但是微機(jī)械陀螺儀不同時(shí)間測(cè)量輸出差別較大,固定的值不能滿(mǎn)足角度測(cè)量的需要。在陀螺儀輸出值有明顯差別時(shí),需要采用最小二乘支持向量回歸機(jī)(LSSVR)對(duì)、和值進(jìn)行回歸,支持向量機(jī)對(duì)小樣本的支持,因此可以做出下一步較準(zhǔn)確的預(yù)測(cè)。結(jié)合參考文獻(xiàn)中的算法原理,算法步驟如下: 輸入狀態(tài)初始條件的值(;=2,=O或3-n,n取13)。 卡爾曼濾波估計(jì)的參數(shù)輸入RBF神經(jīng)網(wǎng)絡(luò),利用神經(jīng)網(wǎng)絡(luò)的自適應(yīng)能力和函數(shù)逼近能力對(duì)這些特征量進(jìn)行訓(xùn)練調(diào)整。 更新方程。若輸出角度輸出較
5、準(zhǔn)確,則數(shù)據(jù)發(fā)往CAN總線(xiàn),程序轉(zhuǎn)至第步。 若輸出角度有偏差,則LSSVR算法調(diào)整參數(shù)、的值,程序轉(zhuǎn)至第步。22 CAN節(jié)點(diǎn)程序設(shè)計(jì) 以ATmegal6作CAN節(jié)點(diǎn)的微處理器需要解決端口(ALE,RDE,WR)的模擬問(wèn)題。CAN節(jié)點(diǎn)部分主從機(jī),節(jié)點(diǎn)ID地址決定是否接收任務(wù)以及發(fā)送的順序;幀格式采用數(shù)據(jù)幀;幀類(lèi)型采用擴(kuò)展幀;PB0PB7作地址數(shù)據(jù)總線(xiàn);PC3輸出片選信號(hào);PC4控制SJAl000的復(fù)位引腳;INT0(PD2)控制終端信號(hào)。錯(cuò)誤檢測(cè)分析程序包括:仲裁丟失捕捉(ALE)、錯(cuò)誤代碼捕捉(ECC)、錯(cuò)誤警告限制(EWLR)、RX錯(cuò)誤計(jì)數(shù)(RXERR)、TX錯(cuò)誤計(jì)數(shù)(TXERR)寄存器配置。 程序流程如下: SJAl000寄存器地址配置; CAN初始化、進(jìn)入復(fù)位狀態(tài)配置時(shí)鐘分頻、代碼驗(yàn)收、驗(yàn)收屏蔽寄存
溫馨提示
- 1. 本站所有資源如無(wú)特殊說(shuō)明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶(hù)所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁(yè)內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒(méi)有圖紙預(yù)覽就沒(méi)有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 人人文庫(kù)網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶(hù)上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶(hù)上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶(hù)因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 品牌策劃與推廣手冊(cè)
- 浙江國(guó)企招聘2025溫州市甌海旅游投資集團(tuán)有限公司及下屬子公司招聘10人筆試參考題庫(kù)附帶答案詳解
- 浙江國(guó)企招聘2025天童旅游景區(qū)開(kāi)發(fā)股份有限公司招聘4人筆試參考題庫(kù)附帶答案詳解
- 項(xiàng)目實(shí)施方案與執(zhí)行路線(xiàn)圖
- 互聯(lián)網(wǎng)+制造項(xiàng)目協(xié)議
- 餐飲供應(yīng)鏈企業(yè)合并合同(2篇)
- 啄木鳥(niǎo)簡(jiǎn)介課件
- 2025年會(huì)計(jì)職稱(chēng)考試《初級(jí)會(huì)計(jì)實(shí)務(wù)》稅務(wù)處理與籌劃案例分析解析與實(shí)戰(zhàn)試題
- 2025年湖北省八市高三語(yǔ)文3月模擬調(diào)考試卷附答案解析
- 口才課堂教學(xué)課件
- 2025年臨床醫(yī)師定期考核必考復(fù)習(xí)題庫(kù)及答案(1080題)
- 2025中國(guó)移動(dòng)招聘在線(xiàn)統(tǒng)一筆試高頻重點(diǎn)提升(共500題)附帶答案詳解
- 第四單元 第二課 創(chuàng)作學(xué)校電子相冊(cè)說(shuō)課稿 2024-2025學(xué)年西交大版(2024)初中信息技術(shù)七年級(jí)上冊(cè)
- 城市管理執(zhí)法人員著裝規(guī)范
- 第12課 踢足球(教學(xué)實(shí)錄)2024-2025學(xué)年五年級(jí)上冊(cè)信息技術(shù)新世紀(jì)版
- 《皮膚病中成藥導(dǎo)引》課件
- 健康行業(yè)調(diào)研報(bào)告
- 中國(guó)高血壓防治指南(2024年修訂版)
- 《始終堅(jiān)持以人民為中心》教案
- 組織拳擊比賽行業(yè)市場(chǎng)突圍建議書(shū)
- 2024年上海市安全員-B證(項(xiàng)目負(fù)責(zé)人)理論考試題及答案
評(píng)論
0/150
提交評(píng)論