一种基于全站仪的掘进装备机身偏差测量方法技术

本发明专利技术公开了一种基于全站仪的掘进装备机身偏差测量方法，硬件配置上只需采用全站仪和棱镜即可完成，无需再借助其他类型的传感器和测量单元。该方法可实时计算得出装备机身相对巷道设计中线的偏差，以大地坐标系为基准，不需进行大地坐标系、机身坐标系、巷道坐标系等多坐标系的转换，依赖全站仪和棱镜即可进行装备机身偏差计算，简单可行易于操作。另外，本发明专利技术的方法与装备机型及结构无关，不需考虑装备的机械结构，通用性强、适用性广。通过实时的偏差计算结果，掌握装备机身相对于巷道中线的偏差情况，有利于操作人员远程获取装备的位置数据。

【技术实现步骤摘要】
一种基于全站仪的掘进装备机身偏差测量方法
本专利技术涉及井下掘进
，具体为一种基于全站仪的掘进装备机身偏差测量方法。
技术介绍
掘进装备作为综掘机械化生产过程中的一种重要采掘装备，广泛应用于煤矿巷道开采和公路隧道等工程建设中。据统计，我国煤矿掘进工作面超过两万个，且掘进工作面危险高、粉尘大，不利于掘进工人的生产劳动和安全健康。随着计算机技术、环境感知技术、数据融合技术及智能算法的普及应用，掘进装备的远程控制及工作面无人化成为未来发展的必然要求。要实现掘进装备的远程控制及工作面无人化，需要准确获取掘进装备在巷道中的实时位置，并能检测出掘进装备在巷道中机身的偏移情况，掌握掘进装备在巷道中的行驶轨迹，并将实际行驶轨迹与设定路线进行对比，指导并控制掘进装备的运行方向及动作。现有的掘进装备定位技术及方法主要集中在掘进装备机身及截割头的定位，并未获取装备机身的实时偏差信息，进而无法判断装备在巷道运行过程中相对巷道设计中线的偏移程度，无法确定装备实际行驶轨迹与设定路线的偏差情况。同时，现有的掘进装备定位技术及方法需涉及大地坐标系、机身坐标系、巷道坐标系等多坐标系之间的转换，转换过程繁杂且需要装备机身的详细设计参数。
技术实现思路
针对现有技术存在的不足，本专利技术的目的在于提供一种基于全站仪的掘进装备机身偏差测量方法。为了解决上述技术问题，本专利技术提供了如下技术方案：一种基于全站仪的掘进装备机身偏差测量方法，包括：设置全站仪单元；其中，所述全站仪单元包括全站仪和四个棱镜；全站仪设置于巷道内采掘装备行进方向后方，四个棱镜中，三个为用于确定全站仪三维坐标的后方交会棱镜，另一个为用于确定采掘装备三维位置的坐标目标棱镜；在巷道内选定坐标原点，构建东北天坐标系，将三个后方交会棱镜设置于所述东北天坐标系下三个已知点位置，根据全站仪后方交会原理，确定全站仪位置的三维坐标；采掘装备运行过程中，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置改变量计算采掘装备机身偏差。其中，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置改变量计算采掘装备机身偏差的步骤中，包括步骤：东北天坐标系中，设东方向为X轴，北方向为Y轴，天方向为Z轴，以通过目标棱镜点且与XOY平面平行建立平面Q；计算前后两个测量时刻，全站仪与目标棱镜之间的斜距和相对北方向偏角，将斜距投影至平面Q内，两斜距在X方向的斜距差即为机身的偏差值。其中，后方交会棱镜的设置方式为：安装并固定于全站仪后方的开阔位置，不被遮挡，保证与全站仪通视，放置后方交会棱镜时，将其中两个后方交会棱镜安装沿巷道行进方向的于一侧，另一个后方交会棱镜安装于另一侧。其中，目标棱镜安装于采掘装备机身后方位置，不被遮挡，保证与全站仪通视。区别于现有技术，本专利技术提供的一种基于全站仪的掘进装备机身偏差测量方法，硬件配置上只需采用全站仪和棱镜即可完成，无需再借助其他类型的传感器和测量单元。该方法可实时计算得出装备机身相对巷道设计中线的偏差，以大地坐标系为基准，不需进行大地坐标系、机身坐标系、巷道坐标系等多坐标系的转换，依赖全站仪和棱镜即可进行装备机身偏差计算，简单可行易于操作。另外，本专利技术的方法与装备机型及结构无关，不需考虑装备的机械结构，通用性强、适用性广。通过实时的偏差计算结果，掌握装备机身相对于巷道中线的偏差情况，有利于操作人员远程获取装备的位置数据。附图说明下面将结合附图及实施例对本专利技术作进一步说明，附图中：图1为本专利技术提供的一种基于全站仪的掘进装备机身偏差测量方法中掘进装备机身目标棱镜测量的流程示意图。图2为本专利技术提供的一种基于全站仪的掘进装备机身偏差测量方法的全站仪测量掘进装备目标棱镜的示意图。图3为本专利技术提供的种基于全站仪的掘进装备机身偏差测量方法的掘进装备机身偏差计算过程示意图。图2中：1为掘进装备，1(1)为装备机身在初始时刻的位置，1(2)为机身在前进方向上行走下一时刻的位置，2为棱镜，2(1)为棱镜安装在机身右侧时在初始时刻的位置，2(2)为棱镜安装在机身右侧时在前进方向上行走下一时刻的位置，2(3)为棱镜安装在机身左侧时在初始时刻的位置，2(4)为棱镜安装在机身左侧时在前进方向上行走下一时刻的位置，3为全站仪。具体实施方式为了对本专利技术的技术特征、目的和效果有更加清楚的理解，现对照附图详细说明本专利技术的具体实施方式。参阅图1，本专利技术提供了一种基于全站仪的掘进装备机身偏差测量方法，包括：设置全站仪单元；其中，所述全站仪单元包括全站仪和四个棱镜；全站仪设置于巷道内采掘装备行进方向后方，四个棱镜中，三个为用于确定全站仪三维坐标的后方交会棱镜，另一个为用于确定采掘装备三维位置的坐标目标棱镜；后方交会棱镜的设置方式为：安装并固定于全站仪后方的开阔位置，不被遮挡，保证与全站仪通视，放置后方交会棱镜时，将其中两个后方交会棱镜安装沿巷道行进方向的于一侧，另一个后方交会棱镜安装于另一侧。目标棱镜安装于采掘装备机身后方位置，不被遮挡，保证与全站仪通视。在巷道内选定坐标原点，构建东北天坐标系，将三个后方交会棱镜设置于所述东北天坐标系下三个已知点位置，根据全站仪后方交会原理，确定全站仪位置的三维坐标；采掘装备运行过程中，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置改变量计算采掘装备机身偏差。掘进装备在巷道运行过程中，由于受煤层分布的影响，机身会产生上坡、下坡、左偏、右偏等姿态的变化。全站仪测量装备机身目标棱镜的位置坐标，由于在运行过程中装备位置的不断变化，目标棱镜的位置也不断改变，通过测量目标棱镜在不同位置的改变量计算装备机身偏差。其中，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置改变量计算采掘装备机身偏差的步骤中，包括步骤：东北天坐标系中，设东方向为X轴，北方向为Y轴，天方向为Z轴，以通过目标棱镜点且与XOY平面平行建立平面Q；计算前后两个测量时刻，全站仪与目标棱镜之间的斜距和相对北方向偏角，将斜距投影至平面Q内，两斜距在X方向的斜距差即为机身的偏差值。如图1和图2，偏差测量方法以大地坐标系(东北天坐标系)为基准，全站仪T与棱镜P1的位置坐标均以大地坐标系进行计算，建立大地坐标系的三维坐标方向，设东方向为X轴，北方向为Y轴，天方向为Z轴。确定大地坐标系坐标轴方向后，由于后方交会棱镜的三维坐标已知由矿方给出，通过全站仪与后方三棱镜进行后方交会，可确定全站仪在大地坐标系下准确的测站坐标(XT，YT，ZT)。根据全站仪的工作原理，将全站仪对准装备机身的目标棱镜，搜索并锁定成功目标棱镜后，对目标棱镜进行测量，可获得装备机身精确的三维坐标，即机身在大地坐标系下的坐标值(XP1，YP1，ZP1)、(XP2，YP2，ZP2)。如图3所示，掘进装备机身偏差可通过以下方式进行计本文档来自技高网...

【技术保护点】
1.一种基于全站仪的掘进装备机身偏差测量方法，其特征在于，包括：/n设置全站仪单元；其中，所述全站仪单元包括全站仪和四个棱镜；全站仪设置于巷道内采掘装备行进方向后方，四个棱镜中，三个为用于确定全站仪三维坐标的后方交会棱镜，另一个为用于确定采掘装备三维位置的坐标目标棱镜；/n在巷道内选定坐标原点，构建东北天坐标系，将三个后方交会棱镜设置于所述东北天坐标系下三个已知点位置，根据全站仪后方交会原理，确定全站仪位置的三维坐标；/n采掘装备运行过程中，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置改变量计算采掘装备机身偏差。/n

【技术特征摘要】
1.一种基于全站仪的掘进装备机身偏差测量方法，其特征在于，包括：
设置全站仪单元；其中，所述全站仪单元包括全站仪和四个棱镜；全站仪设置于巷道内采掘装备行进方向后方，四个棱镜中，三个为用于确定全站仪三维坐标的后方交会棱镜，另一个为用于确定采掘装备三维位置的坐标目标棱镜；
在巷道内选定坐标原点，构建东北天坐标系，将三个后方交会棱镜设置于所述东北天坐标系下三个已知点位置，根据全站仪后方交会原理，确定全站仪位置的三维坐标；
采掘装备运行过程中，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置改变量计算采掘装备机身偏差。


2.根据权利要求1所述的基于全站仪的掘进装备机身偏差测量方法，其特征在于，通过全站仪实时测量采掘装备机身目标棱镜的位置坐标，通过测量不同时刻目标棱镜的位置...

【专利技术属性】
技术研发人员：张婷，索艳春，陈宁，田原，李涛，董孟阳，郭皇煌，贾曲，马亚丽，李瑞媛，常映辉，冀鹏飞，吕继双，邢晨，郝明锐，
申请(专利权)人：中国煤炭科工集团太原研究院有限公司，山西天地煤机装备有限公司，
类型：发明
国别省市：山西;14