一种一般MEMS陀螺在AGV应用上的模型系统

基本信息

申请号 CN202010529726.X 申请日 -
公开(公告)号 CN111928844A 公开(公告)日 2020-11-13
申请公布号 CN111928844A 申请公布日 2020-11-13
分类号 G01C21/16(2006.01)I;G01C25/00(2006.01)I 分类 测量;测试;
发明人 沈烨斌;张洁萍;周骏 申请(专利权)人 嘉兴市纳杰微电子技术有限公司
代理机构 杭州华鼎知识产权代理事务所(普通合伙) 代理人 嘉兴市纳杰微电子技术有限公司
地址 314000浙江省嘉兴市南湖区凌公塘路3339号(嘉兴科技城)1号楼306室
法律状态 -

摘要

摘要 本发明公开了一种一般MEMS陀螺在AGV应用上的模型系统,包括:陀螺数据采集模块:用于采集AGV上安装的MEMS陀螺的角速度数据;陀螺数据补偿模块:对采集的陀螺数据进行补偿,补偿方法依次包括温度补偿、标定以及减去零偏;状态判断模块:将补偿后的陀螺数据与动静状态切换阈值A进行比较,如果大于动静状态切换阈值A,判定AGV为运动状态,判定AGV为静止状态;航向角YAW计算模块:采用动态航向角YAW计算方法和静态航向角YAW计算方法分别计算运动状态下的航向角YAW和静止状态下的航向角YAW。本发明使一般MEMS陀螺也能在AGV上应用,且性能与高价格的陀螺相当甚至更优,大大的降低了AGV应用开发的成本。