一種一般MEMS陀螺在AGV應(yīng)用上的模型系統(tǒng)

基本信息

申請(qǐng)?zhí)?/td> CN202010529726.X 申請(qǐng)日 -
公開(公告)號(hào) CN111928844A 公開(公告)日 2020-11-13
申請(qǐng)公布號(hào) CN111928844A 申請(qǐng)公布日 2020-11-13
分類號(hào) G01C21/16(2006.01)I;G01C25/00(2006.01)I 分類 測(cè)量;測(cè)試;
發(fā)明人 沈燁斌;張潔萍;周駿 申請(qǐng)(專利權(quán))人 嘉興市納杰微電子技術(shù)有限公司
代理機(jī)構(gòu) 杭州華鼎知識(shí)產(chǎn)權(quán)代理事務(wù)所(普通合伙) 代理人 嘉興市納杰微電子技術(shù)有限公司
地址 314000浙江省嘉興市南湖區(qū)凌公塘路3339號(hào)(嘉興科技城)1號(hào)樓306室
法律狀態(tài) -

摘要

摘要 本發(fā)明公開了一種一般MEMS陀螺在AGV應(yīng)用上的模型系統(tǒng),包括:陀螺數(shù)據(jù)采集模塊:用于采集AGV上安裝的MEMS陀螺的角速度數(shù)據(jù);陀螺數(shù)據(jù)補(bǔ)償模塊:對(duì)采集的陀螺數(shù)據(jù)進(jìn)行補(bǔ)償,補(bǔ)償方法依次包括溫度補(bǔ)償、標(biāo)定以及減去零偏;狀態(tài)判斷模塊:將補(bǔ)償后的陀螺數(shù)據(jù)與動(dòng)靜狀態(tài)切換閾值A(chǔ)進(jìn)行比較,如果大于動(dòng)靜狀態(tài)切換閾值A(chǔ),判定AGV為運(yùn)動(dòng)狀態(tài),判定AGV為靜止?fàn)顟B(tài);航向角YAW計(jì)算模塊:采用動(dòng)態(tài)航向角YAW計(jì)算方法和靜態(tài)航向角YAW計(jì)算方法分別計(jì)算運(yùn)動(dòng)狀態(tài)下的航向角YAW和靜止?fàn)顟B(tài)下的航向角YAW。本發(fā)明使一般MEMS陀螺也能在AGV上應(yīng)用,且性能與高價(jià)格的陀螺相當(dāng)甚至更優(yōu),大大的降低了AGV應(yīng)用開發(fā)的成本。??