CN114111759A - 矿井定位机器人及定位方法 - Google Patents
矿井定位机器人及定位方法 Download PDFInfo
- Publication number
- CN114111759A CN114111759A CN202111301813.0A CN202111301813A CN114111759A CN 114111759 A CN114111759 A CN 114111759A CN 202111301813 A CN202111301813 A CN 202111301813A CN 114111759 A CN114111759 A CN 114111759A
- Authority
- CN
- China
- Prior art keywords
- total station
- vehicle body
- degree prism
- mine
- positioning robot
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D55/00—Endless track vehicles
- B62D55/06—Endless track vehicles with tracks without ground wheels
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1652—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with ranging devices, e.g. LIDAR or RADAR
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请提出了一种矿井定位机器人及定位方法,其中,矿井定位机器人包括:第一车体和设置在第一车体上的全站仪,第一车体可在巷道内自由移动,全站仪用于:根据全站仪的位置确定被测目标的位置。本申请能够在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位。
Description
技术领域
本申请涉及矿井定位技术领域,尤其涉及一种矿井定位机器人及定位方法。
背景技术
目前,煤矿智能化建设是煤矿长期发展的趋势和目标,实现煤矿生产的自动操作、远程控制、智能开采离不开多种技术手段的融合和支撑。矿井定位技术,作为一项基础共性技术,对煤矿智能化建设至关重要。有精确的位置信息作为基础,才能对井下装备、车辆和人员等进行定位和控制,实现井下位置信息的整合,实现地理信息的数字化。
因此,在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位成为煤矿智能化建设亟待解决的问题。
发明内容
本申请旨在至少在一定程度上解决相关技术中的技术问题之一。
为此,本申请的第一个目的在于提出一种矿井定位机器人,在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位。
本申请的第二个目的在于提出一种定位方法。
为达上述目的,本申请第一方面实施例提出了一种矿井定位机器人,包括:第一车体和设置在所述第一车体上的全站仪,所述第一车体可在巷道内自由移动;所述全站仪用于:根据所述全站仪的位置确定被测目标的位置。
本申请实施例提出的矿井定位机器人,包括:第一车体和设置在第一车体上的全站仪,第一车体可在巷道内自由移动,全站仪用于:根据全站仪的位置确定被测目标的位置。本申请能够在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位。
根据本申请的一个实施例,所述矿井定位机器人还包括:第二车体、第三车体、设置在所述第二车体上的第一360度棱镜和设置在所述第三车体上的第二360度棱镜,所述第二车体和所述第一车体可在所述巷道内自由移动;所述全站仪具体用于:在所述全站仪照准所述第一360度棱镜和所述第二360度棱镜的情况下,测量所述第一360度棱镜与所述全站仪之间的第一距离、所述第二360度棱镜与所述全站仪之间的第二距离,以及所述第一360度棱镜与所述全站仪之间连线与所述第二360度棱镜与所述全站仪之间连线的夹角;根据所述第一360度棱镜的位置、所述第二360度棱镜的位置、所述第一距离、所述第二距离和所述夹角,确定所述全站仪的位置。
根据本申请的一个实施例,所述被测目标上设置有多个目标圆棱镜;所述全站仪具体用于:在所述目标圆棱镜与所述全站仪保持通视的情况下,测量所述目标圆棱镜与所述全站仪之间的第三距离;根据所述全站仪的位置和多个所述第三距离确定所述被测目标的位置。
根据本申请的一个实施例,所述矿井定位机器人还包括:设置在所述第一车体上的惯性导航单元;所述惯性导航单元用于:检测所述全站仪的姿态,并判断所述全站仪各时刻的状态。
根据本申请的一个实施例,所述矿井定位机器人还包括:设置在所述第一车体上的紧急制动装置;所述紧急制动装置用于:控制所述第一车体紧急制动。
根据本申请的一个实施例,还包括:设置在所述第一车体上的激光雷达;所述激光雷达用于:检测前方障碍物信息,当预设距离内有障碍物靠近时,输出预警信息和/或触发紧急制动装置动作。
根据本申请的一个实施例,还包括:设置在所述第一车体上的防爆摄像仪;所述防爆摄像仪用于:采集所述第一车体周围的环境信息,并输出所述第一车体周围的环境视频图像。
根据本申请的一个实施例,还包括:设置在所述第一车体上且位于所述全站仪下方的底座,以及设置在所述第一车体上且位于所述底座下方的折板。
为达上述目的,本申请第二方面实施例提出了一种定位方法,包括:获取矿井定位机器人中全站仪的位置,其中,所述矿井定位机器人包括第一车体和设置在所述第一车体上的所述全站仪,所述第一车体可在巷道内自由移动;根据所述全站仪的位置确定被测目标的位置。
本申请实施例提出的定位方法,获取矿井定位机器人中全站仪的位置,其中,矿井定位机器人包括第一车体和设置在第一车体上的全站仪,第一车体可在巷道内自由移动,根据全站仪的位置确定被测目标的位置。本申请能够在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位。
根据本申请的一个实施例,所述矿井定位机器人还包括:第二车体、第三车体、设置在所述第二车体上的第一360度棱镜和设置在所述第三车体上的第二360度棱镜,所述第二车体和所述第三车体可在所述巷道内自由移动;所述获取矿井定位机器人中全站仪的位置,包括:在所述全站仪照准所述第一360度棱镜和所述第二360度棱镜的情况下,测量所述第一360度棱镜与所述全站仪之间的第一距离、所述第二360度棱镜与所述全站仪之间的第二距离,以及所述第一360度棱镜与所述全站仪之间连线与所述第二360度棱镜与所述全站仪之间连线的夹角;根据所述第一360度棱镜的位置、所述第二360度棱镜的位置、所述第一距离、所述第二距离和所述夹角,确定所述全站仪的位置。
本申请附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本申请的实践了解到。
附图说明
本申请上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解,其中:
图1是根据本申请一个实施例的矿井定位机器人在巷道的布置示意图;
图2是本申请一个实施例的矿井定位机器人中第一车体的总体结构示意图;
图3是本申请一个实施例的矿井定位机器人中第一车体的俯视图;
图4是本申请一个实施例的矿井定位机器人中第一车体的后视图;
图5是本申请一个实施例的矿井定位机器人中第一车体的侧视图;
图6是本申请一个实施例的矿井定位机器人中第二车体的结构示意图;
图7是本申请一个实施例的矿井定位机器人中第三车体的结构示意图;
图8是本申请一个实施例的矿井定位机器人中全站仪定位原理图;
图9是根据本申请一个实施例的定位方法的流程示意图;
图10是根据本申请另一个实施例的定位方法的流程示意图。
附图标记:
10-矿井定位机器人,101-第一车体,1011-全站仪,1012-惯性导航单元,1013-紧急制动装置,1014-激光雷达,1015-防爆摄像仪,1016-底座,1017-折板,1018-工控机,102-第二车体,1021-第一360度棱镜,1022-底板,1023-立柱,103-第三车体,1031-第二360度棱镜,1032-底板,1033-立柱,20-被测目标,201-目标圆棱镜。
具体实施方式
下面详细描述本申请的实施例,实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本申请,而不能理解为对本申请的限制。
下面结合附图来描述本申请实施例的矿井定位机器人及定位方法。
如图1-图5所示,本申请实施例的矿井定位机器人10具体可包括:第一车体101和设置在第一车体101上的全站仪1011。
本申请实施例中,如图1所示,第一车体101可以在巷道内自由移动,使得矿井定位机器人10可步进式地实现不同范围的定位,进而在全矿井范围内实现对被测目标20的精确定位。在一些实施例中为了减少矿井定位机器人10对采掘装备、辅运车辆等矿井内作业设备正常工作的影响,矿井定位机器人10不测量时在支巷上停留,需要测量时再进入主巷。其中,被测目标20可以为采掘装备、辅助运输车辆或其他重点检测设备等。
其中,全站仪1011可以安装在第一车体101的车身平整平面上,与车身固连,可以根据全站仪1011的位置确定被测目标20的位置。本申请实施例中,全站仪1011不受煤矿粉尘、能见度、煤壁吸收等恶劣环境影响,可满足高精度定位,可靠性、适应性强。
进一步的,在上述实施例的基础上,本申请实施例中矿井定位机器人10还可以包括:第二车体102、第三车体103、设置在第二车体102上的第一360度棱镜1021和设置在第三车体上的第二360度棱镜1031。
在一些实施例中,如图6所示,可以在第二车体102的底板1022上设置立柱1023,将第一360度棱镜1021安装在立柱1023的顶端;如图7所示,在第三车体103的底板1032上设置立柱1033,将第二360度棱镜1031安装在立柱1033的顶端,以便于全站仪1011照准第一360度棱镜1021和第二360度棱镜1031,通过后方交会的方式确定全站仪1011的位置。
作为一种可行的实施方式,在全站仪1011照准第一360度棱镜1021和第二360度棱镜1031的情况下,测量第一360度棱镜1021与全站仪1011之间的第一距离和第二360度棱镜1031与全站仪1011之间的第二距离,以及第一360度棱镜1021与全站仪1011之间连线与第二360度棱镜1031与全站仪1011之间连线的夹角α。
根据第一360度棱镜1021的位置、第二360度棱镜1031的位置、第一距离、第二距离和夹角α,确定全站仪1011的位置,从而可以确定全站仪此时的定位基准,进而可以基于此定位基准,测量全站仪可视范围内被测目标的位置。
其中,第二车体102和第三车体103可在巷道内自由移动以便于在全站仪1011换站后仍然能够通过第一360度棱镜1021和第二360度棱镜1031确定换站后的全站仪1011的位置,可在360度范围内确定全站仪1011准确的位置坐标。
在本申请实施例中,在矿井定位机器人10进行定位作业之前,在矿井上测量井口精确的定位坐标,通过该坐标将矿井上已知的坐标位置对应至井下,从而建立两个已知点A、B作为第二车体20(即第一360度棱镜1021)和第三车体30(即第二360度棱镜1031)的起始坐标点。根据第一360度棱镜1021的位置、第二360度棱镜1031的位置以及上述测量到的第一距离、第二距离和夹角α确定全站仪1011的位置。
图8为全站仪1011的定位原理图,如图8所示,第二车体20(即第一360度棱镜1021)放置在已知点A(XA,YA),第三车体30(即第二360度棱镜1031)放置在已知点B(XB,YB),第一车体10(即全站仪1011)设置在未知点T(XT,YT)。全站仪通过自动搜索和照准第一360度棱镜1021和第二360度棱镜1031,测量得到全站仪1011设站点T与已知点A之间的第一距离LA,以及设站点T与已知点B之间的第二距离LB,以及TA与TB两直线之间的夹角αT。根据已知点A和已知点B的坐标可得到两点间的距离LAB、AT和AB的夹角αA和BT和BA的夹角αB。
基于上述位置信息,可建立平面坐标系XOY,则有:
基于向量一和向量二可得:
基于向量三和向量四可得:
通过表达式一和表达式二可以得到全站仪1011的设站点T的坐标T(XT,YT)。
在一些实施例中,当被测目标20超出全站仪1011可视范围或者全站仪1011视线被遮挡时,需要第一车体101携带全站仪1011移动至新的位置(换站)完成后续定位。在全站仪1011移动换站前,将第二车体102移动至位置A′处固定,将第三车体103移动至位置B′处固定,全站仪通过照准第二车体102上的第一360度棱镜1021和第三车体103上的第二360度棱镜1031确定第一360度棱镜1021和第二360度棱镜1031的位置坐标,全站仪1011记录第一360度棱镜1021和第二360度棱镜1031当前的位置坐标(即位置A′和位置B′的坐标),将位置A′和位置B′作为新的后方交会点,全站仪1011移动换站后,基于图8所示的全站仪定位原理,通过位置A′处的第一360度棱镜1021和位置B′处第二360度棱镜1031进行后方交会,确定全站仪1011移动换站后新的坐标位置,以此完成全站仪1011的一次换站。
由此,无需人工频繁换站操作,矿井定位机器人自动换站,循环使用可步进式扩大全站仪测量范围,实现矿井定位机器人对全矿井范围内的定位。
进一步的,如图1所示,本申请实施例中,被测目标20上可以设置有多个目标圆棱镜201。
在一些实现中,在多个目标圆棱镜201与全站仪1011保持通视的情况下,全站仪1011通过照准多个目标圆棱镜201,测量多个目标圆棱镜201与全站仪1011之间的多个第三距离,并根据全站仪1011的位置和多个目标圆棱镜201对应的多个第三距离确定被测目标20的位置。
进一步的,在上述实施例的基础上,如图3所示,本申请实施例的矿井定位机器人10还可以包括:惯性导航单元1012;
其中,惯性导航单元1012设置在第一车体101上,安装在第一车体101的车身平整平面上,与车身固连。惯性导航单元1012可用于检测全站仪1011的姿态,例如:航向角、俯仰角和横滚角等,并判断全站仪1011各时刻的状态。
进一步的,在上述实施例的基础上,如图2或图3所示,本申请实施例的矿井定位机器人10还可以包括:紧急制动装置1013;
其中,紧急制动装置1013设置在第一车体101上,用于控制第一车体101紧急制动。
进一步的,在上述实施例的基础上,如图2或图3所示,本申请实施例的矿井定位机器人10还可以包括:激光雷达1014;
其中,激光雷达1014设置在第一车体101上,可用于检测第一车体101前方障碍物信息,当预设距离内有障碍物靠近时,输出预警信息和/或触发紧急制动装置1013动作。此处需要说明的是,预设距离可根据需要设定,本申请不做限定。
作为一种可行的实施方式,可以在第一车体101上安装工控机1018,当激光雷达1014检测到第一车体101的前方预设距离内有人员或其他设备靠近时,将预警信息发送至工控机1018,可通过工控机1018向紧急制动装置1013发送指令,触发紧急制动装置1013控制第一车体101紧急制动以有效避免人员受伤或机器受损。
作为另一种可行的实施方式,当激光雷达1014检测到第一车体101的前方预设距离内有人员或其他设备靠近时以触发语音播报的方式输出预警信息,必要时触发紧急制动装置1013控制第一车体101紧急制动。
进一步的,在上述实施例的基础上,如图2-图4所示,本申请实施例的矿井定位机器人10还可以包括:防爆摄像仪1015;
其中,防爆摄像仪1015设置在第一车体101上,可用于采集第一车体101周围的环境信息,并输出第一车体101周围的环境视频图像,例如上传至远程交互端以便对矿井定位机器人10进行安全监测。
进一步的,在上述实施例的基础上,如图4所示,本申请实施例的矿井定位机器人10还可以包括:设置在第一车体101上且位于全站仪1011下方的底座1016,以及设置在第一车体101上且位于底座1016下方的折板1017。将底座1016安装在垫高的折板1017上,以保证全站仪1011最大范围内的通视能力。
本申请实施例提出的矿井定位机器人,包括:第一车体和设置在第一车体上的全站仪,第一车体可在巷道内自由移动,全站仪用于:根据全站仪的位置确定被测目标的位置。本申请能够在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位。
为了实现上述实施例,本申请实施例还提出一种定位方法,该定位方法可应用于上述矿井定位机器人10中,以实现对被测目标20的灵活、精准定位。如图9所示,本申请实施例提出的定位方法具体可包括以下步骤:
S901,获取矿井定位机器人中全站仪的位置,其中,矿井定位机器人包括第一车体和设置在第一车体上的全站仪,第一车体可在巷道内自由移动。
S902,根据全站仪的位置确定被测目标的位置。
需要说明的是,前述对矿井定位机器人实施例的解释说明也适用于该实施例的定位方法,此处不再赘述。
进一步的,在上述实施例的基础上,本申请实施例中矿井定位机器人还可以包括第二车体、第三车体、设置在第二车体上的第一360度棱镜和设置在第三车体上的第二360度棱镜,第一车体和第二车体可在巷道内自由移动,如图10所示,步骤S901中“获取矿井定位机器人中全站仪的位置”,具体可包括以下步骤:
S1001,在全站仪照准第一360度棱镜和第二360度棱镜的情况下,测量第一360度棱镜与全站仪之间的第一距离、第二360度棱镜与全站仪之间的第二距离,以及第一360度棱镜与全站仪之间连线与第二360度棱镜与全站仪之间连线的夹角。
S1002,根据第一360度棱镜的位置、第二360度棱镜的位置、第一距离、第二距离和夹角,确定全站仪的位置。
需要说明的是,前述对矿井定位机器人实施例的解释说明也适用于该实施例的定位方法,此处不再赘述。获取矿井定位机器人中全站仪的位置,其中,矿井定位机器人包括第一车体和设置在第一车体上的全站仪,第一车体可在巷道内自由移动,根据全站仪的位置确定被测目标的位置。本申请能够在满足井下特殊的工作环境要求的基础上,实现灵活、精准定位。
在本申请的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“顺时针”、“逆时针”、“轴向”、“径向”、“周向”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本申请和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。在本申请的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。
在本申请中,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”、“固定”等术语应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或成一体;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本申请中的具体含义。
在本申请中,除非另有明确的规定和限定,第一特征在第二特征“上”或“下”可以是第一和第二特征直接接触,或第一和第二特征通过中间媒介间接接触。而且,第一特征在第二特征“之上”、“上方”和“上面”可是第一特征在第二特征正上方或斜上方,或仅仅表示第一特征水平高度高于第二特征。第一特征在第二特征“之下”、“下方”和“下面”可以是第一特征在第二特征正下方或斜下方,或仅仅表示第一特征水平高度小于第二特征。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
尽管上面已经示出和描述了本申请的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本申请的限制,本领域的普通技术人员在本申请的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (10)
1.一种矿井定位机器人,其特征在于,包括:第一车体和设置在所述第一车体上的全站仪,所述第一车体可在巷道内自由移动;
所述全站仪用于:根据所述全站仪的位置确定被测目标的位置。
2.根据权利要求1所述的矿井定位机器人,其特征在于,还包括:第二车体、第三车体、设置在所述第二车体上的第一360度棱镜和设置在所述第三车体上的第二360度棱镜,所述第二车体和所述第三车体可在所述巷道内自由移动;所述全站仪具体用于:
在所述全站仪照准所述第一360度棱镜和所述第二360度棱镜的情况下,测量所述第一360度棱镜与所述全站仪之间的第一距离、所述第二360度棱镜与所述全站仪之间的第二距离,以及所述第一360度棱镜与所述全站仪之间连线与所述第二360度棱镜与所述全站仪之间连线的夹角;
根据所述第一360度棱镜的位置、所述第二360度棱镜的位置、所述第一距离、所述第二距离和所述夹角,确定所述全站仪的位置。
3.根据权利要求1所述的矿井定位机器人,其特征在于,所述被测目标上设置有多个目标圆棱镜;所述全站仪具体用于:
在所述目标圆棱镜与所述全站仪保持通视的情况下,测量所述目标圆棱镜与所述全站仪之间的第三距离;
根据所述全站仪的位置和多个所述第三距离确定所述被测目标的位置。
4.根据权利要求1所述的矿井定位机器人,其特征在于,还包括:设置在所述第一车体上的惯性导航单元;
所述惯性导航单元用于:检测所述全站仪的姿态,并判断所述全站仪各时刻的状态。
5.根据权利要求1所述的矿井定位机器人,其特征在于,还包括:设置在所述第一车体上的紧急制动装置;
所述紧急制动装置用于:控制所述第一车体紧急制动。
6.根据权利要求5所述的矿井定位机器人,其特征在于,还包括:设置在所述第一车体上的激光雷达;
所述激光雷达用于:检测前方障碍物信息,当预设距离内有障碍物靠近时,输出预警信息和/或触发紧急制动装置动作。
7.根据权利要求1所述的矿井定位机器人,其特征在于,还包括:设置在所述第一车体上的防爆摄像仪;
所述防爆摄像仪用于:采集所述第一车体周围的环境信息,并输出所述第一车体周围的环境视频图像。
8.根据权利要求4所述的矿井定位机器人,其特征在于,还包括:设置在所述第一车体上且位于所述全站仪下方的底座,以及设置在所述第一车体上且位于所述底座下方的折板。
9.一种定位方法,其特征在于,包括:
获取矿井定位机器人中全站仪的位置,其中,所述矿井定位机器人包括第一车体和设置在所述第一车体上的所述全站仪,所述第一车体可在巷道内自由移动;
根据所述全站仪的位置确定被测目标的位置。
10.根据权利要求9所述的定位方法,其特征在于,所述矿井定位机器人还包括:第二车体、第三车体、设置在所述第二车体上的第一360度棱镜和设置在所述第三车体上的第二360度棱镜,所述第二车体和所述第三车体可在所述巷道内自由移动;所述获取矿井定位机器人中全站仪的位置,包括:
在所述全站仪照准所述第一360度棱镜和所述第二360度棱镜的情况下,测量所述第一360度棱镜与所述全站仪之间的第一距离、所述第二360度棱镜与所述全站仪之间的第二距离,以及所述第一360度棱镜与所述全站仪之间连线与所述第二360度棱镜与所述全站仪之间连线的夹角;
根据所述第一360度棱镜的位置、所述第二360度棱镜的位置、所述第一距离、所述第二距离和所述夹角,确定所述全站仪的位置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111301813.0A CN114111759A (zh) | 2021-11-04 | 2021-11-04 | 矿井定位机器人及定位方法 |
PCT/CN2021/134675 WO2023077589A1 (zh) | 2021-11-04 | 2021-12-01 | 矿井定位机器人及定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111301813.0A CN114111759A (zh) | 2021-11-04 | 2021-11-04 | 矿井定位机器人及定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114111759A true CN114111759A (zh) | 2022-03-01 |
Family
ID=80380687
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111301813.0A Pending CN114111759A (zh) | 2021-11-04 | 2021-11-04 | 矿井定位机器人及定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114111759A (zh) |
Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103322989A (zh) * | 2013-06-06 | 2013-09-25 | 上海米度测量技术有限公司 | 一种动态实时测量顶管机位置和姿态的测量装置及其方法 |
CN103994752A (zh) * | 2014-06-05 | 2014-08-20 | 中铁上海工程局集团有限公司 | 一种有关顶管施工的自动测量导向***及方法 |
CN105444782A (zh) * | 2015-12-02 | 2016-03-30 | 苏州迅威光电科技有限公司 | 室内基线全自动检测***以及方法 |
CN106052660A (zh) * | 2016-08-17 | 2016-10-26 | 上海交通大学 | 与全站仪交互的自动锚点标识小车 |
CN207937813U (zh) * | 2018-08-21 | 2018-10-02 | 中信重工开诚智能装备有限公司 | 一种煤矿综采工作面巡检机器人及*** |
CN109959334A (zh) * | 2019-03-01 | 2019-07-02 | 湖南悟空信息科技有限公司 | 一种轨道自动测量车视频坐标的计算方法 |
CN110241696A (zh) * | 2019-04-01 | 2019-09-17 | 中建三局集团有限公司 | 移动式高精度测量机器人***及其测量方法 |
CN111044042A (zh) * | 2020-01-03 | 2020-04-21 | 中国船舶重工集团公司第七0七研究所 | 基于陀螺全站仪和惯导设备的掘进机定位导航***及方法 |
CN111093150A (zh) * | 2019-12-27 | 2020-05-01 | 中国煤炭科工集团太原研究院有限公司 | 一种井工定位及通信*** |
CN111121735A (zh) * | 2020-01-03 | 2020-05-08 | 中国船舶重工集团公司第七0七研究所 | 一种隧道、地铁和矿井开挖掘进自主定位定向***及方法 |
CN111828027A (zh) * | 2020-07-31 | 2020-10-27 | 中交隧道工程局有限公司 | 基于移动转点的全站仪换站方法 |
CN112378390A (zh) * | 2021-01-12 | 2021-02-19 | 北京龙软科技股份有限公司 | 一种综采工作面测量机器人装置和自动测量*** |
CN112855173A (zh) * | 2021-01-21 | 2021-05-28 | 中建五局土木工程有限公司 | 一种盾构姿态调整激光靶连续量测*** |
CN113219505A (zh) * | 2021-04-30 | 2021-08-06 | 阿波罗智联(北京)科技有限公司 | 用于车路协同隧道场景的采集gps坐标的方法、装置和设备 |
CN113252063A (zh) * | 2021-05-25 | 2021-08-13 | 中国煤炭科工集团太原研究院有限公司 | 一种基于全站仪的采掘装备进深测量方法 |
CN113280807A (zh) * | 2021-05-25 | 2021-08-20 | 上海大学 | 一种移动机器人定位装置、方法及*** |
-
2021
- 2021-11-04 CN CN202111301813.0A patent/CN114111759A/zh active Pending
Patent Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103322989A (zh) * | 2013-06-06 | 2013-09-25 | 上海米度测量技术有限公司 | 一种动态实时测量顶管机位置和姿态的测量装置及其方法 |
CN103994752A (zh) * | 2014-06-05 | 2014-08-20 | 中铁上海工程局集团有限公司 | 一种有关顶管施工的自动测量导向***及方法 |
CN105444782A (zh) * | 2015-12-02 | 2016-03-30 | 苏州迅威光电科技有限公司 | 室内基线全自动检测***以及方法 |
CN106052660A (zh) * | 2016-08-17 | 2016-10-26 | 上海交通大学 | 与全站仪交互的自动锚点标识小车 |
CN207937813U (zh) * | 2018-08-21 | 2018-10-02 | 中信重工开诚智能装备有限公司 | 一种煤矿综采工作面巡检机器人及*** |
CN109959334A (zh) * | 2019-03-01 | 2019-07-02 | 湖南悟空信息科技有限公司 | 一种轨道自动测量车视频坐标的计算方法 |
CN110241696A (zh) * | 2019-04-01 | 2019-09-17 | 中建三局集团有限公司 | 移动式高精度测量机器人***及其测量方法 |
CN111093150A (zh) * | 2019-12-27 | 2020-05-01 | 中国煤炭科工集团太原研究院有限公司 | 一种井工定位及通信*** |
CN111044042A (zh) * | 2020-01-03 | 2020-04-21 | 中国船舶重工集团公司第七0七研究所 | 基于陀螺全站仪和惯导设备的掘进机定位导航***及方法 |
CN111121735A (zh) * | 2020-01-03 | 2020-05-08 | 中国船舶重工集团公司第七0七研究所 | 一种隧道、地铁和矿井开挖掘进自主定位定向***及方法 |
CN111828027A (zh) * | 2020-07-31 | 2020-10-27 | 中交隧道工程局有限公司 | 基于移动转点的全站仪换站方法 |
CN112378390A (zh) * | 2021-01-12 | 2021-02-19 | 北京龙软科技股份有限公司 | 一种综采工作面测量机器人装置和自动测量*** |
CN112855173A (zh) * | 2021-01-21 | 2021-05-28 | 中建五局土木工程有限公司 | 一种盾构姿态调整激光靶连续量测*** |
CN113219505A (zh) * | 2021-04-30 | 2021-08-06 | 阿波罗智联(北京)科技有限公司 | 用于车路协同隧道场景的采集gps坐标的方法、装置和设备 |
CN113252063A (zh) * | 2021-05-25 | 2021-08-13 | 中国煤炭科工集团太原研究院有限公司 | 一种基于全站仪的采掘装备进深测量方法 |
CN113280807A (zh) * | 2021-05-25 | 2021-08-20 | 上海大学 | 一种移动机器人定位装置、方法及*** |
Non-Patent Citations (5)
Title |
---|
卢新明;闫长青;袁照平;: "掘进机精准定位方法与掘进机器人***", 通信学报, no. 02 * |
孙连;: "动态测台盾构自动测量***的研究", 上海建设科技, no. 04 * |
温继满;刘少春;: "全站仪后方交会在中小型矿井定向中的应用探讨", 矿山测量, no. 03 * |
陈慎金: "基于掘进机位姿测量***的自主标定方法误差分析", 煤炭学报, pages 1 - 6 * |
黄琴;兰红军;张家珍;姜红姣;谢秀飞;: "全站仪换站中坐标变换的数学模型研究", 计量与测试技术, no. 02 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107631718B (zh) | 一种基于tm30的智能机器人监测***及方法 | |
US10876307B2 (en) | Construction management system and method | |
KR101372023B1 (ko) | 차량 주변의 이동체 감지 장치 및 방법 | |
EP3217380B1 (en) | Map creation device | |
JP7076086B2 (ja) | トンネル内空変位計測方法 | |
CN104428686A (zh) | 用于获得车辆位置的方法和车辆 | |
JP2007276996A (ja) | 建設機械のジブ動作監視装置、建設機械のジブ動作監視方法、建設機械の動作監視システム | |
KR101549144B1 (ko) | 위치기록장치 | |
CN103821514A (zh) | 掘进机截割*** | |
EP4102327A1 (en) | Position recognition method and position recognition system for vehicle | |
CN115229817B (zh) | 机械臂式测量机器人装置和应用方法 | |
US20190039863A1 (en) | Crawler crane | |
US10665103B2 (en) | Vehicle periphery information verification device and method | |
CN114111759A (zh) | 矿井定位机器人及定位方法 | |
KR101677035B1 (ko) | 이동형 데이터 수집장치 | |
CN111325944A (zh) | 一种车辆停车熄火检测*** | |
US20150168155A1 (en) | Method and system for measuring a vehicle position indoors | |
CN114485614B (zh) | 基于双全站仪的采掘设备的导航定位***及方法 | |
JP7132740B2 (ja) | 物体検知システム | |
US11472685B1 (en) | Aerial platform occupancy detection | |
CN114199225A (zh) | 矿井定位机器人及定位方法 | |
CN203228792U (zh) | 一种车辆限界的检测装置 | |
CN214470600U (zh) | 一种基于gnss的空间坐标测量装置 | |
WO2023077589A1 (zh) | 矿井定位机器人及定位方法 | |
CN114485633A (zh) | 一种悬臂式掘进机截割头空间定位方法和装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |