[发明专利]一种掘进机惯性导航系统二维位置精度标定方法和系统在审
| 申请号: | 201910533293.2 | 申请日: | 2019-06-19 |
| 公开(公告)号: | CN110160557A | 公开(公告)日: | 2019-08-23 |
| 发明(设计)人: | 王虹;田原;田野;王帅;王传武;桑盛远;赵永红;梁万吉;白雪峰;王炳效;杨文杰;王瑶;王学成 | 申请(专利权)人: | 中国煤炭科工集团太原研究院有限公司;山西天地煤机装备有限公司 |
| 主分类号: | G01C25/00 | 分类号: | G01C25/00 |
| 代理公司: | 太原晋科知识产权代理事务所(特殊普通合伙) 14110 | 代理人: | 任林芳 |
| 地址: | 030000 *** | 国省代码: | 山西;14 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 掘进机 惯性导航系统 二维平面 位置坐标 全站仪 精度标定 参照方向 二维位置 时间点 特征点 预设 经纬仪 采集 二维定位 数据分析 毫米级 级检测 厘米级 掘进 陀螺 行进 测试 参考 检测 分析 | ||
1.一种掘进机惯性导航系统二维位置精度标定方法,其特征在于,包括:
确定参照方向,并以参照方向为参考,在指定位置设置一全站仪,同时控制掘进机沿指定方向,以预设速度行进;
在掘进机上设置特征点,控制全站仪在预设的时间点采集所述特征点的第一二维平面位置坐标,同时控制所述掘进机的惯性导航系统在与全站仪相同的时间点采集掘进机的第二二维平面位置坐标;
通过分析全站仪采集的第一二维平面位置坐标和掘进机的惯性导航系统采集的第二二维平面位置坐标,进行数据分析,评价惯性导航系统的二维定位精度。
2.根据权利要求1所述的掘进机惯性导航系统二维位置精度标定方法,其特征在于,在确定参照方向的步骤中,还包括通过一陀螺寻北经纬仪确定正北方向的步骤。
3.根据权利要求2所述的掘进机惯性导航系统二维位置精度标定方法,其特征在于,设陀螺寻北经纬仪位于O1,O1N1为寻北仪获得的正北方向,O1E1为其东向;全站仪位于o1,当陀螺寻北经纬仪与全站仪互相照准时,O1、o1连线相对陀螺寻北经纬仪正北方向O1N1的夹角为α,相对全站仪正北方向O1N2的夹角为β,此时设置全站仪水平角β=α,则全站仪的参照方向及测量基准被设置为正北方向。
4.根据权利要求1所述的掘进机惯性导航系统二维位置精度标定方法,其特征在于,在评价被测试惯性导航系统的二维定位精度的步骤中,包括步骤:
设(xi,t,yi,t)、(xi+1,t,yi+1,t)、...,(xi+n,t,yi+n,t)为分布在掘进机行进的直线轨迹上的n个测试位置的第一二维平面位置坐标,(xi,I,yi,I)、(xi+1,I,yi+1,I)、...,(xi+n,I,yi+n,I)为对应的第二二维平面位置坐标,则其拟合直线表达式分别为,
yt=kt·xt+bt;
yI=kI·xI+bI;
掘进机惯性导航系统敏感轴与掘进机轴线方向夹角为,
α=arctan kt-arctan kI;
则惯性导航系统测量值应修正为
惯性导航系统在o1X1和o1Y1方向的位置偏差分别为
Δxi=xi,t-xi,I′,i=1,2,…,n
和
Δyi=yi,t-yi,I′,i=1,2,…,n
则惯性导航系统在o1X1和o1Y1方向的定位偏差均值分别为
惯性导航系统在o1X1和o1Y1方向的定位偏差的标准差分别为
利用式(1)、(2)、(3)、(4)可标定被测试惯性导航系统的定位精度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国煤炭科工集团太原研究院有限公司;山西天地煤机装备有限公司,未经中国煤炭科工集团太原研究院有限公司;山西天地煤机装备有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910533293.2/1.html,转载请声明来源钻瓜专利网。





