- 104
- 0
- 约1.43万字
- 约 11页
- 2023-11-01 发布于四川
- 举报
本发明涉及陀螺仪领域,具体地说是涉及一种基于陀螺仪的物体运动轨迹监测方法,包括:利用陀螺仪输出的三轴加速度和三轴角速度数据,判断陀螺仪载体状态;对陀螺仪状态进行标定;将标定好的数据进行姿态解算,对加速度计进行修正,获得姿态变换矩阵,解算出加速度计估计值,得到加速度计误差向量、加速度计的单位向量、欧拉角和姿态角;将世界坐标下的物体总矢量转化为物体坐标下的物体总矢量,再通过一阶的龙格库塔法,对加速度积分得到速度,对速度积分得到位移,最后消除误差,得到最终物体坐标。本发明能够快速获取陀螺仪载体的姿态角
(19)国家知识产权局
(12)发明专利申请
(10)申请公布号 CN 116972875 A
(43)申请公布日 2023.10.31
(21)申请号 202311239689.9
(22)申请日 2023.09.25
(71)申请人 山东建筑大学
原创力文档

文档评论(0)