发明授权
- 专利标题: 一种基于陀螺仪的物体运动轨迹监测方法
-
申请号: CN202311239689.9申请日: 2023-09-25
-
公开(公告)号: CN116972875B公开(公告)日: 2024-01-02
- 发明人: 高俊然 , 于复生 , 张涵 , 范文利 , 沈孝芹 , 衣杰 , 李臣山 , 王成涛 , 曹蕾 , 刘瑾 , 张辛铎 , 张永超 , 黄明珠
- 申请人: 山东建筑大学
- 申请人地址: 山东省济南市临港区凤鸣路1000号山东建筑大学
- 专利权人: 山东建筑大学
- 当前专利权人: 山东建筑大学
- 当前专利权人地址: 山东省济南市临港区凤鸣路1000号山东建筑大学
- 代理机构: 青岛高晓专利事务所
- 代理商 步丽丽
- 主分类号: G01C23/00
- IPC分类号: G01C23/00 ; G01C25/00
摘要:
本发明涉及陀螺仪领域,具体地说是涉及一种基于陀螺仪的物体运动轨迹监测方法,包括:利用陀螺仪输出的三轴加速度和三轴角速度数据,判断陀螺仪载体状态;对陀螺仪状态进行标定;将标定好的数据进行姿态解算,对加速度计进行修正,获得姿态变换矩阵,解算出加速度计估计值,得到加速度计误差向量、加速度计的单位向量、欧拉角和姿态角;将世界坐标下的物体总矢量转化为物体坐标下的物体总矢量,再通过一阶的龙格库塔法,对加速度积分得到速度,对速度积分得到位移,最后消除误差,得到最终物体坐标。本发明能够快速获取陀螺仪载体的姿态角和位置信息,从而监测物体的运动轨迹,可以应用于水下或不方便使用GPS的领域。
公开/授权文献
- CN116972875A 一种基于陀螺仪的物体运动轨迹监测方法 公开/授权日:2023-10-31