CN209117035U - 一种掘进机惯性导航系统二维位置精度标定系统 - Google Patents
一种掘进机惯性导航系统二维位置精度标定系统 Download PDFInfo
- Publication number
- CN209117035U CN209117035U CN201821596987.8U CN201821596987U CN209117035U CN 209117035 U CN209117035 U CN 209117035U CN 201821596987 U CN201821596987 U CN 201821596987U CN 209117035 U CN209117035 U CN 209117035U
- Authority
- CN
- China
- Prior art keywords
- development machine
- dimensional surface
- inertial navigation
- navigation system
- total station
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Navigation (AREA)
Abstract
本实用新型公开了一种掘进机惯性导航系统二维位置精度标定系统，包括：陀螺寻北经纬仪、全站仪和数据分析装置；其中，陀螺寻北经纬仪用于确定参照方向，并根据参照方向确定全站仪的位置；全站仪用于定时采集掘进机移动过程中的第一二维平面位置坐标，同时掘进机的惯性导航系统采集掘进机的第二二维平面位置坐标，并将第一二维平面位置坐标和第二二维平面位置坐标信息发送到数据分析装置；数据分析装置根据第一二维平面位置坐标和第二二维平面位置坐标信息进行数据分析，评价惯性导航系统的二维定位精度。通过本实用新型，能够利用陀螺寻北经纬仪角秒级检测精度和全站仪毫米级检测精度完成对掘进机用惯性导航系统的厘米级定位精度标定。
Description
技术领域
本实用新型涉及位置精度标定领域，尤其涉及一种掘进机惯性导航系统二维位置精度标定系统。
背景技术
煤矿巷道截割过程中产生的大量粉尘、噪音和存在的极大安全隐患对掘进机自动化和无人化作业提出了迫切的要求，其中掘进机自动导航技术成为关键技术之一。惯性导航技术很好地解决了煤矿井下掘进机光电导航技术遇到的环境适应性问题，因此成为近年来行业内的研究热点。
《煤矿巷道成型规范》要求巷道边界偏差不超过-25mm～150mm，考虑到掘进机控制精度及悬臂的偏差放大作用，掘进机空间定位检测精度应达到厘米级，姿态和航向检测精度达到角分级才有可能实现《规范》要求的断面成型精度。
其他应用领域中，通常采用搭载卫星定位的车载试验验证和标定惯性导航系统定位精度，或者采用地形匹配或里程校准等方法，但难以进行厘米级精度验证，或只能进行行进距离验证而无法进行二维平面定位精度验证，而这正是掘进机导航定位所要求的。
实用新型内容
本实用新型的目的在于避免现有技术的不足之处而提供一种掘进机惯性导航系统二维位置精度标定系统。
本实用新型的目的可以通过采用如下的技术措施来实现，设计一种掘进机惯性导航系统二维位置精度标定系统，包括：陀螺寻北经纬仪、全站仪和数据分析装置；其中，所述陀螺寻北经纬仪用于确定参照方向，并根据参照方向确定全站仪的位置；全站仪用于定时采集掘进机移动过程中的第一二维平面位置坐标，同时掘进机的惯性导航系统采集掘进机的第二二维平面位置坐标，并将第一二维平面位置坐标和第二二维平面位置坐标信息发送到数据分析装置；所述数据分析装置根据第一二维平面位置坐标和第二二维平面位置坐标信息进行数据分析，评价惯性导航系统的二维定位精度。
其中，陀螺寻北经纬仪经过粗对北、对心、纬度输入操作后进入测量程序，寻北过程结束后，将陀螺寻北经纬仪瞄准全站仪，此时测出的角度即为全站仪的北向方位角。
区别于现有技术，本实用新型的掘进机惯性导航系统二维位置精度标定系统，包括：陀螺寻北经纬仪、全站仪和数据分析装置；其中，陀螺寻北经纬仪用于确定参照方向，并根据参照方向确定全站仪的位置；全站仪用于定时采集掘进机移动过程中的第一二维平面位置坐标，同时掘进机的惯性导航系统采集掘进机的第二二维平面位置坐标，并将第一二维平面位置坐标和第二二维平面位置坐标信息发送到数据分析装置；数据分析装置根据第一二维平面位置坐标和第二二维平面位置坐标信息进行数据分析，评价惯性导航系统的二维定位精度。通过本实用新型，能够利用陀螺寻北经纬仪角秒级检测精度和全站仪毫米级检测精度完成对掘进机用惯性导航系统的厘米级定位精度标定。
附图说明
图1是本实用新型提供的一种掘进机惯性导航系统二维位置精度标定系统的结构示意图。
具体实施方式
下面结合具体实施方式对本实用新型的技术方案作进一步更详细的描述。显然，所描述的实施例仅仅是本实用新型的一部分实施例，而不是全部的实施例。基于本实用新型中的实施例，本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例，都应属于本实用新型保护的范围。
参阅图1，图1是本实用新型提供的一种掘进机惯性导航系统二维位置精度标定系统的结构示意图。该装置200包括：
陀螺寻北经纬仪1、全站仪2和数据分析装置3；其中，陀螺寻北经纬仪1用于确定参照方向，并根据参照方向确定全站仪2的位置；全站仪2用于定时采集掘进机10移动过程中的第一二维平面位置坐标，同时掘进机10的惯性导航系统11采集掘进机12的第二二维平面位置坐标，并将第一二维平面位置坐标和第二二维平面位置坐标信息发送到数据分析装置3；数据分析装置3根据第一二维平面位置坐标和第二二维平面位置坐标信息进行数据分析，评价惯性导航系统 11的二维定位精度。
陀螺寻北经纬仪1经过粗对北、对心、纬度输入操作后进入测量程序，寻北过程结束后，将陀螺寻北经纬仪1瞄准全站仪2，此时测出的角度即为全站仪2的北向方位角。
具体的，设陀螺寻北经纬仪位于O1，O1N1为寻北仪获得的正北方向，O1E1为其东向；全站仪位于o1，当陀螺寻北经纬仪与全站仪互相照准时，O1、o1连线相对陀螺寻北经纬仪正北方向O1N1的夹角为α，相对全站仪正北方向O1N2的夹角为β，此时设置全站仪水平角β＝α，则全站仪的参照方向及测量基准被设置为正北方向。
驱动装载有被测惯性导航系统的测试小车沿预先设定直线轨迹以约5～10米/分钟的速度前进，大约1分钟后停车；多次执行行进和停止的操作，并在测试小车停止后，通过全站仪采集测试小车当前的二维平面位置坐标。
设被测试小车的惯性导航系统位于o2，其敏感轴方向分别为o2Y2和o2X2，其自身北向为o2N2，o2E2为其东向，o2v为其行进方向，行进方向与其敏感轴o2Y2之间的夹角为γ。
只考虑惯性导航系统在二维平面内的位置检测精度，则可忽略其高度方向的位置改变。用设置好水平角的全站仪检测惯性导航系统外壳上某一特定点的空间位置坐标。
操作全站仪瞄准被测惯性导航系统壳体上预先选定的特征点并测量其二维平面位置坐标，作为第一二维平面位置坐标并进行记录；为提高精度可采用全站仪专用棱镜。全站仪采集多组第一二维平面位置坐标，同时记录测试小车上的惯性导航系统输出的第二二维位置坐标。两种二维平面位置坐标优选采集至少10组。
坐标采集完成后，对第一二维平面位置坐标和第二二维平面位置坐标进行数据分析。
具体的，设(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)可标定被测试惯性导航系统的定位精度。
区别于现有技术，本实用新型的掘进机惯性导航系统二维位置精度标定系统，包括：陀螺寻北经纬仪、全站仪和数据分析装置；其中，陀螺寻北经纬仪用于确定参照方向，并根据参照方向确定全站仪的位置；全站仪用于定时采集掘进机移动过程中的第一二维平面位置坐标，同时掘进机的惯性导航系统采集掘进机的第二二维平面位置坐标，并将第一二维平面位置坐标和第二二维平面位置坐标信息发送到数据分析装置；数据分析装置根据第一二维平面位置坐标和第二二维平面位置坐标信息进行数据分析，评价惯性导航系统的二维定位精度。通过本实用新型，能够利用陀螺寻北经纬仪角秒级检测精度和全站仪毫米级检测精度完成对掘进机用惯性导航系统的厘米级定位精度标定。
以上仅为本实用新型的实施方式，并非因此限制本实用新型的专利范围，凡是利用本实用新型说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本实用新型的专利保护范围内。
Claims (1)
1.一种掘进机惯性导航系统二维位置精度标定系统，其特征在于，包括：陀螺寻北经纬仪、全站仪和数据分析装置；其中，所述陀螺寻北经纬仪用于确定参照方向，并根据参照方向确定全站仪的位置；全站仪用于定时采集掘进机移动过程中的第一二维平面位置坐标，同时掘进机的惯性导航系统采集掘进机的第二二维平面位置坐标，并将第一二维平面位置坐标和第二二维平面位置坐标信息发送到数据分析装置；所述数据分析装置根据第一二维平面位置坐标和第二二维平面位置坐标信息进行数据分析，评价惯性导航系统的二维定位精度。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201821596987.8U CN209117035U (zh) | 2018-09-29 | 2018-09-29 | 一种掘进机惯性导航系统二维位置精度标定系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201821596987.8U CN209117035U (zh) | 2018-09-29 | 2018-09-29 | 一种掘进机惯性导航系统二维位置精度标定系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN209117035U true CN209117035U (zh) | 2019-07-16 |
Family
ID=67199793
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201821596987.8U Active CN209117035U (zh) | 2018-09-29 | 2018-09-29 | 一种掘进机惯性导航系统二维位置精度标定系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN209117035U (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110160557A (zh) * | 2018-09-29 | 2019-08-23 | 中国煤炭科工集团太原研究院有限公司 | 一种掘进机惯性导航系统二维位置精度标定方法和系统 |
| CN110631598A (zh) * | 2019-08-06 | 2019-12-31 | 北京百度网讯科技有限公司 | 车辆定位精度的评测方法、装置、设备及计算机可读存储介质 |
| CN113252044A (zh) * | 2021-05-25 | 2021-08-13 | 中国煤炭科工集团太原研究院有限公司 | 一种掘进装备机身偏差计算方法 |
-
2018
- 2018-09-29 CN CN201821596987.8U patent/CN209117035U/zh active Active
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110160557A (zh) * | 2018-09-29 | 2019-08-23 | 中国煤炭科工集团太原研究院有限公司 | 一种掘进机惯性导航系统二维位置精度标定方法和系统 |
| CN110160557B (zh) * | 2018-09-29 | 2024-03-12 | 中国煤炭科工集团太原研究院有限公司 | 一种掘进机惯性导航系统二维位置精度标定方法和系统 |
| CN110631598A (zh) * | 2019-08-06 | 2019-12-31 | 北京百度网讯科技有限公司 | 车辆定位精度的评测方法、装置、设备及计算机可读存储介质 |
| CN113252044A (zh) * | 2021-05-25 | 2021-08-13 | 中国煤炭科工集团太原研究院有限公司 | 一种掘进装备机身偏差计算方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110160557A (zh) | 一种掘进机惯性导航系统二维位置精度标定方法和系统 | |
| CN209117035U (zh) | 一种掘进机惯性导航系统二维位置精度标定系统 | |
| CN106772493B (zh) | 基于北斗差分定位的无人机航向测算系统及其测算方法 | |
| CN102901977B (zh) | 一种飞行器的初始姿态角的确定方法 | |
| CN104898139A (zh) | 一种车辆定位纠偏方法及装置 | |
| CN105547288A (zh) | 一种煤矿井下移动设备自主定位的方法及系统 | |
| CN1680776B (zh) | 用低漂移差分全球定位系统制作精确地形图的系统和方法 | |
| CN104819716A (zh) | 一种基于mems的ins/gps组合的室内外个人导航算法 | |
| CN108645420B (zh) | 一种基于差分导航的自动驾驶车辆多路径地图的创建方法 | |
| CN104678415A (zh) | 车辆位置推测系统及其方法 | |
| CN105115518B (zh) | 一种用于惯性导航系统与gps双天线航向偏角标定方法 | |
| CN103499350A (zh) | Gps盲区下融合多源信息的车辆高精度定位方法及装置 | |
| CN113219507B (zh) | 基于rt3000的自动驾驶车辆感知融合数据的精度测量方法 | |
| CN107402006A (zh) | 基于轨道几何特征信息匹配的列车精密定位方法和系统 | |
| JP2014235510A (ja) | 走行路情報生成装置 | |
| CN207318731U (zh) | 一种具有北斗定位定向功能的车辆监控装置 | |
| Štern et al. | Positioning performance assessment of geodetic, automotive, and smartphone gnss receivers in standardized road scenarios | |
| CN110631579A (zh) | 一种用于农业机械导航的组合定位方法 | |
| CN108168544A (zh) | 北斗增强惯导高效融合车道级定位工作方法及系统装置 | |
| CN107402005A (zh) | 一种基于惯性/里程计/rfid的高精度组合导航方法 | |
| CN102538790A (zh) | 惯性导航中陀螺仪参数的差异性解决方法 | |
| CN202649469U (zh) | 有效全球卫星定位系统所在位置判断的定位装置 | |
| CN104655134A (zh) | 一种基于gps时标的多传感器数据采集系统 | |
| CN202092653U (zh) | 一种变电站巡视机器人的导航系统 | |
| CN109459777A (zh) | 一种机器人、机器人定位方法及其存储介质 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| GR01 | Patent grant | ||
| GR01 | Patent grant |