陀螺仪和加速度传感器角度融合算法.doc

上传人:夺命阿水 文档编号:17963 上传时间:2022-07-01 格式:DOC 页数:3 大小:125KB
返回 下载 相关 举报
陀螺仪和加速度传感器角度融合算法.doc_第1页
第1页 / 共3页
陀螺仪和加速度传感器角度融合算法.doc_第2页
第2页 / 共3页
陀螺仪和加速度传感器角度融合算法.doc_第3页
第3页 / 共3页
亲,该文档总共3页,全部预览完了,如果喜欢就下载吧!
资源描述

《陀螺仪和加速度传感器角度融合算法.doc》由会员分享,可在线阅读,更多相关《陀螺仪和加速度传感器角度融合算法.doc(3页珍藏版)》请在课桌文档上搜索。

word加速度计和陀螺仪角度融合一、 预期结果图中A-Angle:通过加速度计解算出的角度值,G-Angle: 通过加速度计解算出的角度数据,M-Angle:融合过后的角度值。1、传感器在某一固定点绕Z轴进展X围为-90,90的转动 图1从图1可看出,当传感器在静止或做匀速运动状态下进展角度变化时,通过加速度计解算出的角度是可靠的,由于系统刚开始运行时间很短,因而通过陀螺仪解算出的角度也是可靠的。2、传感器保持固定角度(0)不变进展变速运动图2从图2可看出,在变速运动情况下,通过加速度计解算出的角度不可靠,陀螺仪的误差随着时间的增长而变大,亦不再可靠。而融合后的角度根本没有变化,可以得到融合模块对加速度计和陀螺仪的数据进展了有效的融合。二、软件算法采用互补滤波算法,算法流程图如图3所示。图3算法并不是直接融合通过加速度计和陀螺仪解算得到的角度,而是先用通过加速度计得到的角度和上一次融合后的角度对陀螺仪的角速度进展了修改后再积分,有效地抑制了加速度计和陀螺仪的偏差。融合模块的调用采用中断方式,中断时间为5ms。中断服务函数内容如下:Angle_new=Angle_last+(-angle)n +(w-offset)t;Angle_last=Angle_new;3 / 3

展开阅读全文
相关资源
猜你喜欢
相关搜索
资源标签

当前位置:首页 > 在线阅读 > 生活休闲


备案号:宁ICP备20000045号-1

经营许可证:宁B2-20210002

宁公网安备 64010402000986号