[发明专利]一种基于惯性导航数据的采煤机自主定位方法及装置有效
申请号: | 201910511919.X | 申请日: | 2019-06-13 |
公开(公告)号: | CN110285810B | 公开(公告)日: | 2023-07-14 |
发明(设计)人: | 张元刚;刘坤;彭继国;张波;逯峰;李政;赵文豪;亓玉浩;马钢;商登涛;李纪栋;赵峰;刘万仓 | 申请(专利权)人: | 兖矿集团有限公司;北斗天地股份有限公司山东分公司 |
主分类号: | G01C21/16 | 分类号: | G01C21/16 |
代理公司: | 北京轻创知识产权代理有限公司 11212 | 代理人: | 何佩英 |
地址: | 273599 山东*** | 国省代码: | 山东;37 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 惯性 导航 数据 采煤 自主 定位 方法 装置 | ||
1.一种基于惯性导航数据的采煤机自主定位方法,其特征在于,所述方法包括:
根据安装在采煤机上的惯性传感仪,在载体坐标系下测量得到采煤机的第一定位数据,其中所述第一定位数据包括:采煤机在载体坐标系下的平移加速度和采煤机在载体坐标系下的旋转角速度值;
在载体坐标系下构建第一姿态矩阵,并进行微分得到导航坐标系下的第二姿态矩阵;
对所述第一定位数据中的所述平移加速度结合采煤机的速度和位置的初始估值进行积分计算得到导航坐标系下的第二定位数据;
根据所述第二姿态矩阵进行逆运算得到采煤机在导航坐标系下的姿态角;
根据所述第二定位数据和所述姿态角确定采煤机在所述导航坐标系下的位置;
所述在载体坐标系下构建第一姿态矩阵,包括:
通过采煤机的初态航向角、俯仰角和横滚角构建第一姿态矩阵,通过如下公式构建第一姿态矩阵:其中表示n系与b系之间旋转角度,分别表示n系与b系之间的三维坐标系下的转轴方向;设u是n系中的旋转矢量,载体绕u旋转,旋转角度为β,l,m,n分别表示为u在n系中三个转轴方向的投影;n表示导航坐标系;b表示载体坐标系;
所述对所述第一姿态矩阵进行微分包括:所述第一姿态矩阵和所述载体坐标系下的旋转角速度值的乘积作为所述微分的结果。
2.根据权利要求1所述的基于惯性导航数据的采煤机自主定位方法,其特征在于,
所述第二定位数据包括:采煤机在导航坐标系下的速度值和采煤机在载体坐标系下的位移值。
3.根据权利要求1所述的基于惯性导航数据的采煤机自主定位方法,其特征在于,所述惯性传感仪包括:用于测量所述第一定位数据的平移加速度的摆式加速度计和用于测量所述第一定位数据的旋转角速度值的激光陀螺仪。
4.根据权利要求2或3所述的基于惯性导航数据的采煤机自主定位方法,其特征在于,在所述对所述第一定位数据中的所述平移加速度结合采煤机的速度和位置的初始估值进行积分计算得到导航坐标系下的第二定位数据之前,所述方法还包括:
利用扩展卡尔曼滤波对所述第一定位数据的旋转角速度和平移加速度进行误差补偿。
5.根据权利要求1所述的基于惯性导航数据的采煤机自主定位方法,其特征在于,将微分后得到所述第二姿态矩阵中的方向余弦元素作为矩阵中的元素对所述第一姿态矩阵中的元素进行更新,采用更新后的第一姿态矩阵结合采煤机的速度和位置的初始估值进行积分计算得到导航坐标系下的第二定位数据。
6.一种基于惯性导航数据的采煤机自主定位装置,其特征在于,所述装置包括:
测量模块,用于根据安装在采煤机上的惯性传感仪,在载体坐标系下测量得到采煤机的第一定位数据,其中所述第一定位数据包括:采煤机在载体坐标系下的平移加速度和采煤机在载体坐标系下的旋转角速度值;
微分运算模块,用于在载体坐标系下构建第一姿态矩阵,并进行微分得到导航坐标系下的第二姿态矩阵;
积分运算模块,用于对所述第一定位数据中的所述平移加速度结合采煤机的速度和位置的初始估值进行积分计算得到导航坐标系下的第二定位数据;
逆运算模块,用于根据所述第二姿态矩阵进行逆运算得到采煤机在导航坐标系下的姿态角;
位置确定模块,用于根据所述第二定位数据和所述姿态角确定采煤机在所述导航坐标系下的位置;
所述微分运算模块中所述在载体坐标系下构建第一姿态矩阵,包括:
通过采煤机的初态航向角、俯仰角和横滚角构建第一姿态矩阵,通过如下公式构建第一姿态矩阵:其中表示n系与b系之间旋转角度,分别表示n系与b系之间的三维坐标系下的转轴方向;设u是n系中的旋转矢量,载体绕u旋转,旋转角度为β,l,m,n分别表示为u在n系中三个转轴方向的投影;n系表示导航坐标系;b系表示载体坐标系;
所述对所述第一姿态矩阵进行微分包括:所述第一姿态矩阵和所述载体坐标系下的旋转角速度值的乘积作为所述微分的结果。
7.根据权利要求6所述的基于惯性导航数据的采煤机自主定位装置,其特征在于,所述第二定位数据包括:采煤机在导航坐标系下的速度值和采煤机在载体坐标系下的位移值。
8.根据权利要求6所述的基于惯性导航数据的采煤机自主定位装置,其特征在于,所述惯性传感仪包括:用于测量所述第一定位数据的平移加速度的摆式加速度计和用于测量所述第一定位数据的旋转角速度值的激光陀螺仪。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于兖矿集团有限公司;北斗天地股份有限公司山东分公司,未经兖矿集团有限公司;北斗天地股份有限公司山东分公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910511919.X/1.html,转载请声明来源钻瓜专利网。
- 数据显示系统、数据中继设备、数据中继方法、数据系统、接收设备和数据读取方法
- 数据记录方法、数据记录装置、数据记录媒体、数据重播方法和数据重播装置
- 数据发送方法、数据发送系统、数据发送装置以及数据结构
- 数据显示系统、数据中继设备、数据中继方法及数据系统
- 数据嵌入装置、数据嵌入方法、数据提取装置及数据提取方法
- 数据管理装置、数据编辑装置、数据阅览装置、数据管理方法、数据编辑方法以及数据阅览方法
- 数据发送和数据接收设备、数据发送和数据接收方法
- 数据发送装置、数据接收装置、数据收发系统、数据发送方法、数据接收方法和数据收发方法
- 数据发送方法、数据再现方法、数据发送装置及数据再现装置
- 数据发送方法、数据再现方法、数据发送装置及数据再现装置