[go: up one dir, main page]

CN103869283B - Method and system for positioning underground trackless vehicle - Google Patents

Method and system for positioning underground trackless vehicle Download PDF

Info

Publication number
CN103869283B
CN103869283B CN201410052500.XA CN201410052500A CN103869283B CN 103869283 B CN103869283 B CN 103869283B CN 201410052500 A CN201410052500 A CN 201410052500A CN 103869283 B CN103869283 B CN 103869283B
Authority
CN
China
Prior art keywords
information
trackless vehicle
scanning
label
information labels
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
Application number
CN201410052500.XA
Other languages
Chinese (zh)
Other versions
CN103869283A (en
Inventor
李建国
战凯
顾洪枢
石峰
冯孝华
郭鑫
段辰玥
龙智卓
李恒通
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing General Research Institute of Mining and Metallurgy
BGRIMM Machinery and Automation Technology Co Ltd
Original Assignee
Beijing General Research Institute of Mining and Metallurgy
BGRIMM Machinery and Automation Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing General Research Institute of Mining and Metallurgy, BGRIMM Machinery and Automation Technology Co Ltd filed Critical Beijing General Research Institute of Mining and Metallurgy
Priority to CN201410052500.XA priority Critical patent/CN103869283B/en
Publication of CN103869283A publication Critical patent/CN103869283A/en
Application granted granted Critical
Publication of CN103869283B publication Critical patent/CN103869283B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/16Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves

Landscapes

  • Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

The invention relates to mining engineering, in particular to a method and a system for positioning an underground trackless vehicle, which comprise the following steps: selecting a plurality of label positions with the distance not exceeding a preset value from the underground along the running direction of the trackless vehicle; setting correspondingly coded information tags on the roadway wall of each tag position, and storing the corresponding relation in a tag information base; the trackless vehicle in running scans the information label, acquires the position information of the information label from the label information base according to the obtained corresponding code, and acquires the position information of the trackless vehicle relative to the information label at the moment by measuring the distance between the trackless vehicle and the information label; and calculating the position of the trackless vehicle at the moment by combining the position information of the information tag and the position information of the trackless vehicle relative to the information tag at the moment. The invention can conveniently acquire the global coordinate of the trackless vehicle when the trackless vehicle runs underground.

Description

一种井下无轨车辆的定位方法及系统A positioning method and system for an underground trackless vehicle

技术领域technical field

本发明涉及矿业工程,具体涉及一种井下无轨车辆的定位方法及系统。The invention relates to mining engineering, in particular to a positioning method and system for an underground trackless vehicle.

背景技术Background technique

近年来,随着矿产资源的大量消耗,地表和浅层矿产资源开发面临的形势日益严峻,现有矿产资源逐渐全面转入地下开采,并向深部和难开采资源延伸,随着井下的工作环境越来越恶劣,同时还有不确定的冒顶等危险因素,不可避免的给从事采矿运输装备工作的人员带来了一定的安全和风险,大力发展无人化无轨运输车辆或远程遥控运输车辆已经成为未来井下开采技术的发展趋势,而基于远程遥控技术的相关技术,由于井下数据的传输容易受到干扰,可靠性下降,另一方面遥控系统需要大量的视频设备相配合,增加了系统的成本和复杂程度。因此,大力发展自主式无人操纵运输车辆已经成为井下无轨车辆技术的发展趋势,In recent years, with the massive consumption of mineral resources, the situation faced by the development of surface and shallow mineral resources has become increasingly severe. It is getting worse and worse, and at the same time, there are uncertain risk factors such as roof fall, which inevitably brings certain safety and risks to the personnel engaged in mining and transportation equipment. Vigorously developing unmanned trackless transport vehicles or remote control transport vehicles has already It will become the development trend of underground mining technology in the future, and related technologies based on remote control technology, because the transmission of underground data is easily disturbed, the reliability will decline. Complexity. Therefore, vigorously developing autonomous unmanned transport vehicles has become the development trend of underground trackless vehicle technology.

井下定位的研究目前以人员定位为主,且以区域性定位为主,依靠无线网络或RFID技术确定所处的区域,定位精度一般在10米左右。无法达到车辆自主行使所需要的定位精度。The research on underground positioning is currently focused on personnel positioning and regional positioning, relying on wireless network or RFID technology to determine the area where the location is located, and the positioning accuracy is generally about 10 meters. The positioning accuracy required for the autonomous driving of the vehicle cannot be achieved.

而且在车辆定位中,地面上所用的GPS技术无法使用,露天矿可以利用全球卫星定位系统(GPS)为车辆定位,但地下无法收到GPS信号。其他惯性产品存在误差累积问题,需要对误差进行绝对修正,在地下的巷道环境中,现有技术无法进行准确修正,实际操作复杂而且精度不高。Moreover, in the vehicle positioning, the GPS technology used on the ground cannot be used. The open-pit mine can use the global satellite positioning system (GPS) to locate the vehicle, but the GPS signal cannot be received underground. Other inertial products have the problem of error accumulation, and the error needs to be corrected absolutely. In the underground roadway environment, the existing technology cannot be accurately corrected, and the actual operation is complicated and the accuracy is not high.

发明内容Contents of the invention

(一)解决的技术问题(1) Solved technical problems

针对现有技术的不足,本发明提供一种井下无轨车辆的定位方法及系统,可以方便的获取无轨车辆在井下行驶时的全局坐标。Aiming at the deficiencies of the prior art, the present invention provides a positioning method and system for an underground trackless vehicle, which can conveniently obtain the global coordinates of the trackless vehicle when it is running underground.

(二)技术方案(2) Technical solution

为实现以上目的,本发明通过以下技术方案予以实现:To achieve the above object, the present invention is achieved through the following technical solutions:

一种井下无轨车辆的定位方法,其特征在于,该方法包括:A positioning method for an underground trackless vehicle, characterized in that the method comprises:

在井下沿无轨车辆行驶方向选取若干个间距不超过预定值的标签位置;Select a number of label positions whose spacing does not exceed a predetermined value along the trackless vehicle driving direction in the mine;

在每个所述标签位置的巷道壁上设置对应编码的信息标签,并将其对应关系存储在标签信息库中;setting a corresponding coded information label on the roadway wall at each label position, and storing the corresponding relationship in the label information library;

行驶中的无轨车辆通过扫描所述信息标签,根据得到的对应编码从所述标签信息库中获取该信息标签的位置信息,并通过测量与所述信息标签的距离获取该时刻无轨车辆相对于该信息标签的位置信息;The moving trackless vehicle scans the information label, obtains the position information of the information label from the label information library according to the obtained corresponding code, and obtains the position information of the trackless vehicle at this moment relative to the information label by measuring the distance from the information label. The location information of the information label;

结合所述该信息标签的位置信息和所述该时刻无轨车辆相对于该信息标签的位置信息计算其在该时刻所处的位置。Combining the position information of the information tag and the position information of the trackless vehicle relative to the information tag at the time to calculate its position at the time.

优选地,所述信息标签为一个外表面上有条状反射区域与条状镂空区域按编码顺序交替排列的空心平板,所述空心平板的内外表面都可以反射所述扫描时和所述测量时所发射的信号,每个所述条状反射区域与条状镂空区域分别具有固定的尺寸。Preferably, the information label is a hollow plate with strip-shaped reflective areas and strip-shaped hollow areas arranged alternately in coding order on the outer surface, and the inner and outer surfaces of the hollow plate can reflect the scanning time and the measurement time For the transmitted signal, each of the strip-shaped reflective areas and the strip-shaped hollow areas has a fixed size.

优选地,所述扫描和所述测量都是以激光扫描测距方式同时进行的。Preferably, both the scanning and the measuring are performed simultaneously by means of laser scanning ranging.

优选地,所述扫描和所述测量都仅在无轨车辆自身坐标系下的一个预定水平面内进行,所述在每个所述标签位置的巷道壁上设置对应编码的信息标签包括在每个所述标签位置的巷道壁上参照所述预定水平面所在的高度设置对应编码的信息标签。Preferably, both the scanning and the measuring are carried out only in a predetermined horizontal plane under the trackless vehicle's own coordinate system, and the setting of correspondingly coded information tags on the roadway wall at each tag position includes A corresponding coded information label is set on the roadway wall at the position of the label with reference to the height of the predetermined horizontal plane.

优选地,所述计算包括从所述该时刻无轨车辆相对于该信息标签的位置信息中以不同方式选取数据进行该时刻无轨车辆相对于该信息标签的位置计算,并对得到的多个计算结果进行统计平均,将统计平均后的结果作为该时刻无轨车辆相对于该信息标签的位置计算结果。Preferably, the calculation includes selecting data in different ways from the position information of the trackless vehicle at this time relative to the information tag to calculate the position of the trackless vehicle at this time relative to the information tag, and calculating the obtained multiple calculation results Statistical averaging is performed, and the result after statistical averaging is used as the calculation result of the position of the trackless vehicle relative to the information tag at this moment.

一种井下无轨车辆的定位系统,其特征在于,该系统包括:A positioning system for an underground trackless vehicle, characterized in that the system includes:

编码式信息标签模块,用于在井下沿无轨车辆行驶方向选取若干个间距不超过预定值的标签位置,并在每个所述标签位置的巷道壁上设置对应编码的信息标签,并将其对应关系存储在标签信息库中;The coded information label module is used to select a number of label positions whose spacing does not exceed a predetermined value along the trackless vehicle driving direction in the mine, and set a correspondingly coded information label on the roadway wall of each label position, and correspond to it. Relationships are stored in a tag repository;

扫描式距离检测模块,用于行驶中的无轨车辆通过扫描所述信息标签,根据得到的对应编码从所述标签信息库中获取该信息标签的位置信息,并通过测量与所述信息标签的距离获取该时刻无轨车辆相对于该信息标签的位置信息;The scanning distance detection module is used for the moving trackless vehicle to scan the information label, obtain the position information of the information label from the label information library according to the obtained corresponding code, and measure the distance to the information label Obtain the position information of the trackless vehicle relative to the information label at this moment;

位置信息处理模块,用于结合所述该信息标签的位置信息和所述该时刻无轨车辆相对于该信息标签的位置信息计算其在该时刻所处的位置。The position information processing module is used to combine the position information of the information tag and the position information of the trackless vehicle relative to the information tag at the time to calculate its position at the time.

优选地,所述编码式信息标签模块包括一个外表面上有条状反射区域与条状镂空区域按编码顺序交替排列的空心平板,所述空心平板的内外表面都可以反射所述扫描时和所述测量时所发射的信号,每个所述条状反射区域与条状镂空区域分别具有固定的尺寸。Preferably, the coded information label module includes a hollow plate with strip-shaped reflective areas and strip-shaped hollow areas arranged alternately in coding order on the outer surface, and the inner and outer surfaces of the hollow plate can reflect the scanning and the Each of the strip-shaped reflective areas and the strip-shaped hollow areas has a fixed size.

优选地,所述扫描式距离检测模块包括用于激光扫描测距的仪器。Preferably, the scanning distance detection module includes an instrument for laser scanning distance measurement.

优选地,所述扫描式距离检测模块包括水平扫描式距离检测模块,用于在无轨车辆自身坐标系下的一个预定水平面内进行所述扫描和所述测量;所述编码式信息标签模块包括信息标签高度设置模块,用于在每个所述标签位置的巷道壁上参照所述预定水平面所在的高度设置对应编码的信息标签。Preferably, the scanning distance detection module includes a horizontal scanning distance detection module, which is used to perform the scanning and the measurement in a predetermined horizontal plane in the trackless vehicle's own coordinate system; the coded information label module includes information The label height setting module is used to set a corresponding coded information label on the roadway wall at each label position with reference to the height of the predetermined horizontal plane.

优选地,其特征在于,所述位置信息处理模块包括:数据选取模块,用于从所述该时刻无轨车辆相对于该信息标签的位置信息中以不同方式选取数据进行该时刻无轨车辆相对于该信息标签的位置计算;统计平均模块,用于对数据选取模块计算得到的多个计算结果进行统计平均,将统计平均后的结果作为该时刻无轨车辆相对于该信息标签的位置计算结果。Preferably, it is characterized in that the position information processing module includes: a data selection module, which is used to select data in different ways from the position information of the trackless vehicle at the time relative to the information label to carry out the tracking of the trackless vehicle at the time relative to the information label. The position calculation of the information tag; the statistical average module is used to perform statistical average on the multiple calculation results calculated by the data selection module, and use the statistical average result as the calculation result of the position of the trackless vehicle relative to the information tag at this moment.

(三)有益效果(3) Beneficial effects

本发明至少具有如下的有益效果:The present invention at least has the following beneficial effects:

本发明设置了对应有位置信息的信息标签,使无轨车辆通过扫描信息标签可以得到无轨车辆所在的绝对位置区段,再通过测量与信息标签的相对位置,可以结合两者计算得到无轨车辆所在的具体绝对位置,也就使无轨车辆以一种方便快捷的方式获取了其在井下行驶时的全局坐标。The present invention sets the information label corresponding to the location information, so that the trackless vehicle can obtain the absolute position section where the trackless vehicle is located by scanning the information label, and then by measuring the relative position of the information label, the location of the trackless vehicle can be calculated by combining the two. The specific absolute position also enables the trackless vehicle to obtain its global coordinates when driving underground in a convenient and quick manner.

该方法中,需要预先在井下完成对信息标签的设置。一方面,其所设置位置的间隔不能超过一个预定值,这个预定值的设定是为了保障无轨车辆在行驶过程中总能至少扫描到一个信息标签,也就是说这个预定值是根据无轨车辆的可扫描范围大小决定的。另一方面,每个信息标签具有自身的编码,而且该编码与具体设置位置的对应关系已经事先存储好,并可以被行驶中的无轨车辆上的某个装置调用。In this method, it is necessary to complete the setting of the information label in the downhole in advance. On the one hand, the interval between its set positions cannot exceed a predetermined value. The setting of this predetermined value is to ensure that the trackless vehicle can always scan at least one information label during driving, that is to say, the predetermined value is based on the trackless vehicle. Depends on the size of the scanable range. On the other hand, each information label has its own code, and the corresponding relationship between the code and the specific setting position has been stored in advance, and can be called by a certain device on the trackless vehicle in motion.

从而在这样的信息标签设置下,井下的无轨车辆行驶线路就被分成了若干个固定的绝对位置区段,只要车辆扫描到附近信息标签的编码,就可以获取到自身所在的绝对位置区段。Therefore, under such information label setting, the underground trackless vehicle driving route is divided into several fixed absolute position sections. As long as the vehicle scans the code of the nearby information label, it can obtain the absolute position section where it is located.

进一步的,车辆可以通过测量与信息标签的相对位置,结合信息标签的编码对应的绝对位置,就可以计算得到车辆当前的绝对位置。只要一定频率重复扫描测量过程,就可以实时地获取到自身的位置信息,也就完成了井下无轨车辆的定位。Further, the current absolute position of the vehicle can be calculated by measuring the relative position of the vehicle to the information tag and combining the absolute position corresponding to the code of the information tag. As long as the scanning measurement process is repeated at a certain frequency, the location information of itself can be obtained in real time, and the positioning of the underground trackless vehicle is completed.

与背景技术相比,本方法不需要借助外界发送的信号来协助定位,也不存在惯性导航或里程计所存在的误差累积问题,实现装置简单,操作方便。Compared with the background technology, this method does not need external signals to assist in positioning, and does not have the error accumulation problem of inertial navigation or odometer, and the realization device is simple and easy to operate.

较特殊地,信息标签可以是一个外表面上有条状反射区域与条状镂空区域按编码顺序交替排列的空心平板,其中所述空心平板的内外表面都可以反射所述扫描时和所述测量时所发射的信号,每个所述条状反射区域与条状镂空区域分别具有固定的尺寸。此种标签制作简单,成本低,稳定性好,并且如此一来,扫描和测量就可以根据反射得到的信号同时进行,简化了处理流程,使方法实施起来更快捷。More specifically, the information label can be a hollow plate with striped reflective areas and striped hollow areas arranged alternately in coding order on the outer surface, wherein both the inner and outer surfaces of the hollow plate can reflect the scanning time and the measurement Each of the strip-shaped reflective areas and the strip-shaped hollow areas has a fixed size. This kind of label is simple to manufacture, low in cost and good in stability, and in this way, scanning and measurement can be performed simultaneously according to the signal obtained by reflection, which simplifies the processing flow and makes the implementation of the method faster.

较特殊地,扫描和测量都是以激光扫描测距方式同时进行的。这一方式可以获取标签表面的反射信息,同时获取表面与激光出射位置之间的距离,也就实现了扫描和测量的同时进行,简化了处理流程。而且激光扫描测距方式精度高,处理速度快,可以提高整个定位处理的效率。More specifically, scanning and measuring are carried out simultaneously by means of laser scanning ranging. This method can obtain the reflection information of the label surface, and at the same time obtain the distance between the surface and the laser emission position, which realizes simultaneous scanning and measurement, and simplifies the processing flow. Moreover, the laser scanning ranging method has high precision and fast processing speed, which can improve the efficiency of the entire positioning processing.

较特殊地,扫描和测量都仅在无轨车辆自身坐标系下的一个预定水平面内进行,对应的信息标签设置高度也是根据这个预定水平面来决定的。这样的方式只考虑车辆行驶的水平面上的位置信息,适用于一般垂直结构不太复杂的井下作业环境,可以缩小计算范围,减小计算量,更具实际应用价值。More specifically, scanning and measurement are only carried out within a predetermined horizontal plane in the trackless vehicle's own coordinate system, and the height of the corresponding information label is also determined according to this predetermined horizontal plane. This method only considers the position information on the horizontal plane where the vehicle travels, and is suitable for the downhole operation environment where the vertical structure is not too complicated. It can narrow the calculation range and reduce the calculation amount, and has more practical application value.

较特殊地,车辆相对于信息标签的相对位置信息实际上最少只需要三个(空间)或两个(平面)对应点的测量数据就可以计算得到了,从而可以以不同方式选取数据进行相对位置信息的计算,将统计平均后的结果作为相对位置信息的计算结果,可以减小误差,提高计算精度。More specifically, the relative position information of the vehicle relative to the information tag can be calculated with at least three (spatial) or two (plane) corresponding point measurement data, so that the relative position information can be selected in different ways For the calculation of the information, the statistically averaged result is used as the calculation result of the relative position information, which can reduce the error and improve the calculation accuracy.

当然,实施本发明的任一产品或方法并不一定需要同时达到以上所述的所有优点。Of course, implementing any product or method of the present invention does not necessarily need to achieve all the above-mentioned advantages at the same time.

附图说明Description of drawings

为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present invention or the prior art, the following will briefly introduce the drawings that need to be used in the description of the embodiments or the prior art. Obviously, the accompanying drawings in the following description These are some embodiments of the present invention. Those skilled in the art can also obtain other drawings based on these drawings without creative work.

图1是本发明一个实施例中一种井下无轨车辆的定位方法流程图;Fig. 1 is a flow chart of a positioning method for an underground trackless vehicle in an embodiment of the present invention;

图2是本发明一个实施例中以铲运机为例的扫描式距离检测模块工作示意图;Fig. 2 is a working schematic diagram of a scanning distance detection module taking a scraper as an example in an embodiment of the present invention;

图3是本发明一个实施例中编码式信息标签模块的基本设计原理图;Fig. 3 is a schematic diagram of the basic design of the coded information label module in one embodiment of the present invention;

图4是本发明一个实施例中一种实施井下无轨车辆的定位方法的具体装置的工作方式示意图;Fig. 4 is a schematic diagram of the working mode of a specific device implementing a positioning method for an underground trackless vehicle in an embodiment of the present invention;

图5是本发明一个实施例中位置信息处理模块算法处理流程图;Fig. 5 is a flow chart of the algorithm processing of the location information processing module in one embodiment of the present invention;

图6是本发明一个实施例中信息编码识别及位置坐标计算的示意图;Fig. 6 is a schematic diagram of information code identification and location coordinate calculation in an embodiment of the present invention;

图7是本发明一个实施例中一种井下无轨车辆的定位系统的结构框图。Fig. 7 is a structural block diagram of a positioning system for an underground trackless vehicle in an embodiment of the present invention.

具体实施方式detailed description

为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments It is a part of embodiments of the present invention, but not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without creative efforts fall within the protection scope of the present invention.

实施例1Example 1

本发明实施例提出了一种井下无轨车辆的定位方法,参见图1,该方法包括:The embodiment of the present invention proposes a positioning method for an underground trackless vehicle, referring to Fig. 1, the method includes:

步骤101:在井下沿无轨车辆行驶方向选取若干个间距不超过预定值的标签位置;Step 101: select a number of label positions whose spacing does not exceed a predetermined value along the trackless vehicle traveling direction in the mine;

步骤102:在每个所述标签位置的巷道壁上设置对应编码的信息标签,并将其对应关系存储在标签信息库中;Step 102: setting a corresponding coded information label on the roadway wall at each label position, and storing the corresponding relationship in the label information database;

步骤103:行驶中的无轨车辆通过扫描所述信息标签,根据得到的对应编码从所述标签信息库中获取该信息标签的位置信息,并通过测量与所述信息标签的距离获取该时刻无轨车辆相对于该信息标签的位置信息;Step 103: The moving trackless vehicle scans the information label, obtains the position information of the information label from the label information library according to the obtained corresponding code, and obtains the trackless vehicle at that time by measuring the distance from the information label Position information relative to the information label;

步骤104:结合所述该信息标签的位置信息和所述该时刻无轨车辆相对于该信息标签的位置信息计算其在该时刻所处的位置。Step 104: Combining the position information of the information tag and the position information of the trackless vehicle relative to the information tag at that time, calculate its position at that time.

该方法大致分为两个部分:信息标签的设置和无轨车辆的扫描测距。信息标签实际上只是一个虚拟的概念,代表了具有固定编码的,对应于预定标签位置的,可以被无轨车辆扫描获取编码、测量彼此距离的一种类似于标签的物体。The method is roughly divided into two parts: the setting of the information label and the scanning ranging of the trackless vehicle. The information tag is actually just a virtual concept, which represents a tag-like object with a fixed code corresponding to the predetermined tag position, which can be scanned by the trackless vehicle to obtain the code and measure the distance between each other.

该方法首先在井下沿无轨车辆行驶方向选取了若干个间距不超过预定值的标签位置,也就是在决定设置信息标签的位置。预定值是为了保证无轨车辆总能至少扫描到一个信息标签而设置的,其值不大于无轨车辆的最大扫描长度。而且,每个标签位置的坐标是可以通过常用技术手段预先获知的,比如通过实际测定或者根据井下环境的数字模型来标定,从而每个标签位置就都可以用相应坐标来表示。The method firstly selects several label positions along the traveling direction of the trackless vehicle in the mine with a spacing not exceeding a predetermined value, that is, the position where information labels are decided to be set. The predetermined value is set to ensure that the trackless vehicle can always scan at least one information label, and its value is not greater than the maximum scanning length of the trackless vehicle. Moreover, the coordinates of each tag position can be known in advance through common technical means, such as through actual measurement or calibration based on a digital model of the downhole environment, so that each tag position can be represented by corresponding coordinates.

然后,在每个所述标签位置的巷道壁上设置对应编码的信息标签,并将其对应关系存储在标签信息库中。这一步骤也属于在无轨车辆开始行驶前的预先设置,在已经标定好的标签位置上,在比较方便扫描的预定高度上设置各个信息标签。而且,信息标签和标签位置的对应关系需要预先存储到无轨车辆上的某个装置上,用于进行具体的位置计算。Then, a corresponding coded information label is set on the roadway wall at each label position, and the corresponding relationship is stored in the label information base. This step also belongs to the presetting before the trackless vehicle starts to run, and each information label is set at a predetermined height that is relatively convenient for scanning on the label position that has been calibrated. Moreover, the corresponding relationship between information tags and tag positions needs to be pre-stored on a certain device on the trackless vehicle for specific position calculation.

于是在无轨车辆的行驶过程中,只需要扫描周围巷道壁上的信息标签编码,对应编码在装置中找到对应的标签位置,结合测量得到的车辆与信息标签的相对位置信息,就可以计算得到车辆在该时刻的具体绝对位置,也就是其在井下行驶时的全局坐标。其具体的计算过程都属于一般的数据查找和距离测量过程的简单组合,属于现有技术。Therefore, during the driving process of the trackless vehicle, it is only necessary to scan the information label code on the surrounding roadway wall, find the corresponding label position in the device for the corresponding code, and combine the measured relative position information of the vehicle and the information label to calculate the vehicle The specific absolute position at this moment, that is, its global coordinates when driving underground. The specific calculation process is a simple combination of general data search and distance measurement process, which belongs to the prior art.

可见,本方法可以使无轨车辆在行驶时实时地获取自身位置,具有上文叙述过的有益效果,实现了无轨车辆在井下行驶时的全局坐标的方便获取。It can be seen that this method can enable the trackless vehicle to obtain its own position in real time while driving, has the beneficial effect described above, and realizes the convenient acquisition of the global coordinates of the trackless vehicle when driving underground.

更具体地,这里结合一套具体装置来说明本方法的步骤流程:More specifically, here is a set of specific devices to illustrate the steps of the method:

具体装置包括扫描式距离检测模块,编码式信息标签模块,和位置信息处理模块。在这里,要获取的全局坐标只在无轨车辆自身坐标系的一个水平面XOY上,故所有扫描和测量都只在这一个平面上进行。The specific device includes a scanning distance detection module, a coded information label module, and a position information processing module. Here, the global coordinates to be obtained are only on a horizontal plane XOY of the trackless vehicle's own coordinate system, so all scanning and measurement are only performed on this plane.

所述扫描式距离检测模块是指安装于井下无轨车辆上,用于检测车辆相对于编码式信息标签模块的距离信息。该模块的主要功能是在同一个水平面内,以一定的分辨率连续在同一角度范围内,反复测量标签模块相对于自身的距离信息,并将距离信息按照特定的存储方式进行存储,提供给位置信息处理模块。扫描和测量距离信息的具体方式是使用激光扫描测距技术,其激光扫描器在同一平面以一定周期,连续测量信息标签的相对于激光扫描器自己的距离信息。以铲运机为例的扫描式距离检测模块参见图2,图中1代表井下巷道壁,2为井下常用的无轨车辆—铲运机示意图,3是安装于铲运机的扫描式距离检测模块。该模块也可以选择360度测量,图中示意为180度测量。The scanning distance detection module is installed on the underground trackless vehicle, and is used to detect the distance information of the vehicle relative to the coded information label module. The main function of this module is to repeatedly measure the distance information of the label module relative to itself in the same horizontal plane with a certain resolution within the same angle range, store the distance information in a specific storage method, and provide it to the location information processing module. The specific way to scan and measure distance information is to use laser scanning distance measurement technology. The laser scanner continuously measures the distance information of the information label relative to the laser scanner itself on the same plane at a certain period. For the scanning distance detection module taking the scraper as an example, please refer to Figure 2. In the figure 1 represents the wall of the underground roadway, 2 is a schematic diagram of a trackless vehicle commonly used in underground mines—the scraper, and 3 is the scanning distance detection module installed on the scraper . The module can also choose 360-degree measurement, which is shown in the figure as 180-degree measurement.

编码式信息标签模块是放置于车辆行驶环境下,在扫描式距离检测模块的检测范围内的,具有特定结构的功能性结构物体,标签模块在车辆行驶环境下,所放置点的全局位置信息已事先存入位置信息处理模块中。该信息标签的主要功能是提供距离检测模块可识别的编码标志,识别编码是由宽窄不同、反射率不同的“条”和“空”(也就是上面所说的条状反射区域和条状镂空区域),按照一定的编码顺序组合起来的一种信息标签,信息标签被识别后,其相关信息被位置信息处理模块用于定位信息的计算和处理,编码式信息标签模块的基本设计原理如图3所示。其中黑色部分为实体可反射信号,便于扫描式距离检测模块检测距离,该模块可以在一定的扫描角度范围内根据D的实际大小进行扩展。The coded information label module is placed in the driving environment of the vehicle, within the detection range of the scanning distance detection module, a functional structural object with a specific structure. The global position information of the placed point of the label module has been Stored in the location information processing module in advance. The main function of the information label is to provide a coded mark that can be recognized by the distance detection module. Area), a kind of information label combined according to a certain coding sequence. After the information label is identified, its related information is used by the location information processing module to calculate and process the positioning information. The basic design principle of the coded information label module is shown in the figure 3 shown. The black part is the reflective signal of the entity, which is convenient for the scanning distance detection module to detect the distance. This module can be expanded according to the actual size of D within a certain scanning angle range.

位置信息处理模块是放置于无轨车辆上,用于收集扫描式距离检测模块获取的距离信息,和对应每个距离信息的相对测量角度信息,并结合识别后的信息标签中分析计算得到的信息标签编码,从而得到车辆相对于信息标签的相对位置,由于信息标签的绝对位置已经事先存放于位置信息处理模块内,结合自身相对位置和信息标签的绝对位置即可得到无轨车辆的绝对位置信息。The location information processing module is placed on the trackless vehicle to collect the distance information obtained by the scanning distance detection module, and the relative measurement angle information corresponding to each distance information, and combine the information label obtained by analysis and calculation in the identified information label Encoding, so as to obtain the relative position of the vehicle relative to the information label. Since the absolute position of the information label has been stored in the position information processing module in advance, the absolute position information of the trackless vehicle can be obtained by combining its own relative position and the absolute position of the information label.

结合这一具体装置,本方法的具体实现流程如下:Combined with this specific device, the specific implementation process of the method is as follows:

参见图4,图中编码式信息标签模块放置于井下巷道环境,离巷道壁有一定的距离,该距离信息由扫描式距离检测模块的最短检测单元(图3中的“D”)决定。扫描式距离检测模块和位置信息处理模块安装于井下移动车辆上。See Figure 4. In the figure, the coded information label module is placed in the underground roadway environment, and has a certain distance from the roadway wall. The distance information is determined by the shortest detection unit ("D" in Figure 3) of the scanning distance detection module. The scanning distance detection module and the position information processing module are installed on the underground mobile vehicle.

扫描式距离检测模块将接收到的“条”、“空”的不同的反射光信号,经过光电转换器转换成模拟电信号,然后经过整形变成通常的数字信号。根据码制所对应的编码规则,位置信息处理模块通过判断当前信标的编码,得到信息标签模块的绝对位置信息,再融合距离检测模块测量的道的实时距离信息和角度信息,进而得到扫描式距离检测模块的精确位置信息,由于扫描式距离检测模块是安装固定在移动车辆上的,从而得到移动车辆的精确位置信息。The scanning distance detection module converts the received "strip" and "empty" reflected light signals into analog electrical signals through photoelectric converters, and then transforms them into common digital signals. According to the encoding rules corresponding to the code system, the position information processing module obtains the absolute position information of the information label module by judging the encoding of the current beacon, and then fuses the real-time distance information and angle information of the track measured by the distance detection module to obtain the scanning distance The precise position information of the detection module, since the scanning distance detection module is installed and fixed on the mobile vehicle, the precise position information of the mobile vehicle can be obtained.

利用激光扫描测量系统在其扫描范围内所扫描返回的信息(举例:选用扫描角度60°,扫描频率300Hz,角分辨率0.2°,即一个完整的扫描周期返回300个扫描点的数值),位置信息处理模块的具体位置处理算法如图5所示。以图6为例,G代表安装于移动车辆的扫描式距离检测模块,EF表示为编码式信息标签模块。全局坐标系为XOY,G代表扫描式距离检测模块的坐标点,A、A1、B、B1、C、C1分别为关键标志点。算法流程具体包括:Use the information returned by the laser scanning measurement system within its scanning range (for example: choose a scanning angle of 60°, a scanning frequency of 300Hz, and an angular resolution of 0.2°, that is, a complete scanning cycle returns the value of 300 scanning points), position The specific position processing algorithm of the information processing module is shown in Fig. 5 . Taking Figure 6 as an example, G represents a scanning distance detection module installed on a moving vehicle, and EF represents a coded information label module. The global coordinate system is XOY, G represents the coordinate point of the scanning distance detection module, and A, A1, B, B1, C, and C1 are key marker points respectively. The algorithm process specifically includes:

步骤501:获取单个测量周期内的扫描式距离检测模块的各点测量数据。Step 501: Obtain the measurement data of each point of the scanning distance detection module in a single measurement period.

位置信息处理模块通过总线方式获取扫描式距离检测模块单个周期内的测量数据,并将数据存放于数组Distance[i](0<i<300)。The position information processing module obtains the measurement data of the scanning distance detection module in a single cycle through the bus, and stores the data in the array Distance[i] (0<i<300).

步骤502:识别关键标志点。Step 502: Identify key landmarks.

关键标志点指计算相邻两点的差值,如大于设定的差值阈值,abs(Distance[i+1]-Distance[i])>ε1(ε1为设定的差值阈值),abs为绝对值算符。则将此点作为关键标志点存储起来,即将i的值存放于数组Count[j++]。The key mark point refers to the calculation of the difference between two adjacent points, if it is greater than the set difference threshold, abs(Distance[i+1]-Distance[i])>ε1 (ε1 is the set difference threshold), abs is an absolute value operator. Then store this point as a key mark point, that is, store the value of i in the array Count[j++].

步骤503:测量点的矢量化。Step 503: Vectorization of measurement points.

利用前后两个关键标志点间的差值来区分两类扫描数值,如果Distance[Count[j]+1]-Distance[Count[j]]>ε2(ε2为设定的差值阈值),则该点矢量化为Distance[i].Flag=1;反之则Distance[i].Flag=0;即改点的标志位赋值为1,反之则为0。Use the difference between the two key marker points before and after to distinguish the two types of scan values, if Distance[Count[j]+1]-Distance[Count[j]]>ε2 (ε2 is the set difference threshold), then The point is vectorized as Distance[i].Flag=1; otherwise, Distance[i].Flag=0; that is, the flag bit of the changed point is assigned a value of 1, otherwise it is 0.

步骤504:标志点的归类存储。Step 504: Classification and storage of marker points.

关键标志点将信标分为若干段,段标志取自相应关键标志点,即:Data[j1].Flag=Distance[Count[j1]+1].Flag。The key mark points divide the beacon into several segments, and the segment flags are taken from the corresponding key mark points, namely: Data[j1].Flag=Distance[Count[j1]+1].Flag.

步骤505:信息标签计算。Step 505: Information label calculation.

信息标签的每一段宽度计算采用三角函数计算,利用三角几何关系分别计算出“条”和“空”的距离,存入Data[j1].Lenth,如图6,计算条状BC的距离方式为The width of each section of the information label is calculated using trigonometric functions, and the distance between the "bar" and "empty" is calculated using the triangular geometric relationship, and stored in Data[j1].Lenth, as shown in Figure 6, the method of calculating the distance of the strip BC is

BCBC == GBGB 22 ++ GCGC 22 -- GBGB ** GCGC ** COS&phi;COS&phi;

计算空状AA1的距离方式为The way to calculate the distance of the empty AA 1 is

AAAAA 11 == GAGA 11 22 ++ GAGA 22 -- 22 GAGA ** GAGA 11 ** COS&theta;COS&theta;

步骤506:匹配判断。Step 506: Matching judgment.

先判断每个Data[j1].Lenth都对应几倍的D,来将对应的连续的“1”或“0”进行还原。也就是先判断Data[j1].Lenth是否小于D+ε2,若小于则判断|Data[j1].Lenth–D|<ε2是否成立(ε2为误差容限,其大小一般不大于D/10),若成立则判定Data[j1].Lenth的位数为1;First determine how many times each Data[j1].Lenth corresponds to D, to restore the corresponding continuous "1" or "0". That is, first judge whether Data[j1].Lenth is less than D+ε2, and if it is less than, judge whether |Data[j1].Lenth–D|<ε2 is true (ε2 is the error tolerance, and its size is generally not greater than D/10) , if it is established, it is determined that the number of digits of Data[j1].Lenth is 1;

若不小于则继续判断Data[j1].Lenth是否小于2D+ε2,若小于则判断|Data[j1].Lenth-2D|<ε2是否成立,若成立则判定Data[j1].Lenth的位数为2,并以此类推,得到其位数后,将对应的标志位Data[j1].Flag按所得位数进行扩展。例如,若j1对应的标志位为“1”,且Data[j1].Lenth的位数为3,则把j1的标志位扩展为“111”。参见图6,由此就可以把原有的“10101”扩展为“111010111110111”。If it is not less than, continue to judge whether Data[j1].Lenth is less than 2D+ε2, if it is less than, judge whether |Data[j1].Lenth-2D|<ε2 is true, and if it is true, judge the number of digits of Data[j1].Lenth is 2, and so on, after obtaining the number of digits, expand the corresponding flag Data[j1].Flag according to the obtained number of digits. For example, if the flag bit corresponding to j1 is "1" and the number of bits of Data[j1].Lenth is 3, then the flag bit of j1 is extended to "111". Referring to FIG. 6, the original "10101" can be extended to "111010111110111".

标志位与模板标志的匹配:判断各段标志位Data[j1].Flag是否与模板给出标志位一致(图3所示);其中1表示反射区域的“条”,0代表空白区域的“空”。Matching of the flag bit and the template flag: judge whether the flag bit Data[j1].Flag of each segment is consistent with the flag bit given by the template (as shown in Figure 3); where 1 represents the "bar" of the reflection area, and 0 represents the "bar" of the blank area. null".

步骤507:位置计算。Step 507: Position calculation.

由于每个信息标签的位置是事先已经存放于位置信息处理模块中,根据步骤506判断出此信息标签编码后,则单个信息编码标签上的A、B、C点的坐标已知,假设分别为(X1,Y1)、(X2,Y2)、(X3,Y3),且GA、GB、GC均为扫描式距离测量模块的测量值,结合φ和θ的角度信息,利用三角函数关系反推计算得出此时扫描测量模块G的坐标(X,Y)的公式为:Since the position of each information label has been stored in the position information processing module in advance, after judging that the information label is encoded according to step 506, the coordinates of points A, B, and C on the single information encoding label are known, assuming that they are respectively (X 1 , Y 1 ), (X 2 , Y 2 ), (X 3 , Y 3 ), and GA, GB, and GC are the measured values of the scanning distance measurement module, combined with the angle information of φ and θ, using The formula of the coordinates (X, Y) of the scanning measurement module G at this time is calculated by reverse calculation of the trigonometric function relationship:

(( Xx -- Xx 11 )) 22 ++ (( YY -- YY 11 )) 22 == GAGA 22 (( Xx -- Xx 22 )) 22 ++ (( YY -- YY 22 )) 22 == GBGB 22 (( Xx -- Xx 33 )) 22 ++ (( YY -- YY 33 )) 22 == GCGC 22

(X,Y)为固定在移动车辆上的扫描式距离检测模块的坐标,根据模块安装的位置坐标和车体坐标系的转换关系,从而得到移动车辆的实时位置坐标。其中,每两个点都可以算出一个对应的(X,Y),所以在具体运算时,可以算出多组(X,Y)并取平均值,以减小偶然误差。上面的方程就取了3个点,可以得到3个解取其平均值。(X, Y) are the coordinates of the scanning distance detection module fixed on the moving vehicle, and the real-time position coordinates of the moving vehicle are obtained according to the conversion relationship between the position coordinates of the module installation and the vehicle body coordinate system. Among them, a corresponding (X, Y) can be calculated for every two points, so in specific operations, multiple groups of (X, Y) can be calculated and averaged to reduce accidental errors. The above equation takes 3 points, and 3 solutions can be obtained to take the average value.

步骤508:识别结束,计算出相应的位置。Step 508: The recognition ends, and the corresponding position is calculated.

自此完成了对编码式信息标签的扫描和测量。这里由于编码式信息标签是一个外表面上有条状反射区域与条状镂空区域按编码顺序交替排列的空心平板,条状反射区域(如图6中的EA段、A1B1段、BC段和C1F段)可以反射所述扫描时和所述测量时所发射的信号,所以这些区域上的点都可以被扫描到,也可以测量其间距;而由于其中的条状镂空区域(如图6中的AA1段、B1B段和CC1段)是被镂空的区域,所以在扫描和测量进行到这些区域时,测量和扫描到的其实是空心平板内表面上的点。所以在条状反射区域和条状镂空区域的边界附近,测量的距离在数值上通常会有一个较大幅度的突变。根据这一特性设置一个较小的差值阈值ε1,就可以识别出突变大于所设阈值的的边界位置,也就是上面所说的“关键标志点”。Scanning and measurement of coded information labels has since been completed. Here, because the coded information label is a hollow plate with striped reflective areas and striped hollow areas arranged alternately in the coding order on the outer surface, the striped reflective areas (such as the EA segment, A1B1 segment, BC segment and C1F segment in Figure 6) Segment) can reflect the signals emitted during the scanning and the measuring, so the points on these areas can be scanned, and their spacing can also be measured; and because of the strip-shaped hollow area (as shown in Figure 6 AA1 segment, B1B segment and CC1 segment) are hollowed out areas, so when scanning and measuring these areas, what is measured and scanned is actually a point on the inner surface of the hollow plate. Therefore, near the boundary of the strip-shaped reflection area and the strip-shaped hollow area, the measured distance usually has a large abrupt change in value. By setting a small difference threshold ε1 according to this characteristic, the boundary position where the mutation is greater than the set threshold can be identified, which is the "key mark point" mentioned above.

然后,进行“测量点的矢量化”,也就是区分两个关键标志点之间是“1”区域还是“0”区域。由于从“条”到“空”判断出的关键标志点对应测量的是条状反射区域上的点与坐标原点的距离,而从“空”到“条”判断出的关键标志点对应测量的是空心平板内表面上的点与坐标原点的距离,所以测量得到的距离后者通常都会比前者大。利用这一性质,就可以判断相邻关键标志点之间是“条”还是“空”。对应于上面的Distance[Count[j]+1]-Distance[Count[j]]>ε2,就是在比较两个距离与0的大小(ε2为0附近的数值,这里设为变量可以做调整),从而满足条件的对应i为“条”,否则为“空”。Then, "vectorization of measurement points" is carried out, that is, to distinguish whether the area between two key marker points is a "1" area or a "0" area. Since the key marker points judged from "bar" to "empty" correspond to the distance between the point on the bar-shaped reflection area and the coordinate origin, and the key marker points judged from "empty" to "bar" correspond to the measured is the distance between the point on the inner surface of the hollow plate and the origin of the coordinates, so the measured distance of the latter is usually greater than the former. Using this property, it can be judged whether the adjacent key marker points are "bar" or "empty". Corresponding to the above Distance[Count[j]+1]-Distance[Count[j]]>ε2, it is comparing the size of the two distances with 0 (ε2 is a value near 0, which can be adjusted as a variable here) , so that the corresponding i that satisfies the condition is "article", otherwise it is "empty".

在进行匹配时,由于这里还没有区分每个“条”是代表多少个“1”,每个“空”代表多少个“0”,所以要由相邻关键标志点之间的距离是多少倍的D来决定。具体实现方式已经在上面描述过,从而可以把原有的“1010101…”这样交替的编码,还原为“111001011011”这样有重复字段的编码。当然,条状反射区域与条状镂空区域的宽度都是固定的,长度为D,这样的设置下才能让扫描可以进行识别。When matching, since there is no distinction here about how many "1s" each "bar" represents and how many "0s" each "empty" represents, it is determined by how many times the distance between adjacent key marker points D to decide. The specific implementation method has been described above, so that the original alternate coding such as "1010101..." can be restored to the coding with repeated fields such as "111001011011". Of course, the width of the strip-shaped reflective area and the strip-shaped hollow area are fixed, and the length is D, so that the scanning can be recognized under such a setting.

还原编码后,就可以直接比对标签信息库找到对应标签的绝对位置,再由车辆与标签的相对位置就可以计算出车辆的绝对位置了。After restoring the code, you can directly compare the tag information database to find the absolute position of the corresponding tag, and then calculate the absolute position of the vehicle based on the relative position between the vehicle and the tag.

由于编码是人为设定的,所以自然界中的巷道壁很难出现能被识别并匹配的情况(那样就要求巷道壁平面平整地出现高-低-高-低-…这样的情形,可见这几乎是不可能的),基本上可以认定只有对应的编码式信息标签才能满足上述匹配。而且具体的扫描测量过程也可以有D、ε1、ε2、ε3多个数值来进行调整,以满足不同应用需要。Since the code is artificially set, it is difficult for the roadway wall in nature to be identified and matched (that requires the roadway wall plane to appear high-low-high-low-... such a situation, it can be seen that this is almost is impossible), basically it can be determined that only the corresponding coded information label can satisfy the above matching. Moreover, the specific scanning measurement process can also be adjusted with multiple values of D, ε1, ε2, and ε3 to meet different application needs.

以上就是一个结合具体装置的方法步骤流程,其具有上文已经叙述过的有益效果,可以实现无轨车辆在井下行驶时的全局坐标的方便获取。The above is a flow of method steps combined with a specific device, which has the beneficial effects described above, and can realize the convenient acquisition of the global coordinates of the trackless vehicle when it is driving underground.

总体来说,本发明针对井下巷道特殊的环境,提出一种适用于井下无轨车辆的的定位方法,利用该方法可以方便的获取车辆在井下的全局坐标,该方法所涉及的工作装置结构简单,工作稳定可靠,同时还满足井下无轨车辆自主行使控制过程中对定位的精度要求。Generally speaking, the present invention proposes a positioning method suitable for underground trackless vehicles for the special environment of underground roadways. By using this method, the global coordinates of the vehicle in the underground can be easily obtained. The structure of the working device involved in this method is simple. The work is stable and reliable, and at the same time, it also meets the accuracy requirements for positioning during the autonomous exercise control process of underground trackless vehicles.

实施例2Example 2

本发明实施例提出了一种井下无轨车辆的定位系统,参见图7,该系统包括:The embodiment of the present invention proposes a positioning system for an underground trackless vehicle, as shown in Fig. 7, the system includes:

编码式信息标签模块701,用于在井下沿无轨车辆行驶方向选取若干个间距不超过预定值的标签位置,并在每个所述标签位置的巷道壁上设置对应编码的信息标签,并将其对应关系存储在标签信息库中;The coded information label module 701 is used to select a number of label positions whose spacing does not exceed a predetermined value along the direction of trackless vehicle travel underground, and to set a corresponding coded information label on the roadway wall of each label position, and place it The corresponding relationship is stored in the tag information database;

扫描式距离检测模块702,用于行驶中的无轨车辆通过扫描所述信息标签,根据得到的对应编码从所述标签信息库中获取该信息标签的位置信息,并通过测量与所述信息标签的距离获取该时刻无轨车辆相对于该信息标签的位置信息;The scanning distance detection module 702 is used for the trackless vehicle in motion to scan the information label, obtain the position information of the information label from the label information library according to the obtained corresponding code, and measure the distance between the information label and the information label. Get the position information of the trackless vehicle relative to the information tag at that moment;

位置信息处理模块703,用于结合所述该信息标签的位置信息和所述该时刻无轨车辆相对于该信息标签的位置信息计算其在该时刻所处的位置。The position information processing module 703 is configured to combine the position information of the information tag and the position information of the trackless vehicle relative to the information tag at the time to calculate its position at the time.

其中:in:

所述编码式信息标签模块包括一个外表面上有条状反射区域与条状镂空区域按编码顺序交替排列的空心平板,所述条状反射区域可以反射所述扫描时和所述测量时所发射的信号,所述空心平板的内表面不能反射所述扫描时和所述测量时所发射的信号。The coded information label module includes a hollow plate with strip-shaped reflective areas and strip-shaped hollow areas arranged alternately in coding order on the outer surface, and the strip-shaped reflective areas can reflect the emitted light during scanning and measurement. The inner surface of the hollow plate cannot reflect the signals emitted during the scanning and the measuring.

所述扫描式距离检测模块包括用于激光扫描测距的仪器。The scanning distance detection module includes an instrument for laser scanning distance measurement.

所述扫描式距离检测模块包括水平扫描式距离检测模块,用于在无轨车辆自身坐标系下的一个预定水平面内进行所述扫描和所述测量;所述编码式信息标签模块包括信息标签高度设置模块,用于在每个所述标签位置的巷道壁上参照所述预定水平面所在的高度设置对应编码的信息标签。The scanning distance detection module includes a horizontal scanning distance detection module, which is used to perform the scanning and the measurement in a predetermined horizontal plane under the trackless vehicle's own coordinate system; the coded information label module includes an information label height setting A module, configured to set a correspondingly coded information label on the roadway wall at each label position with reference to the height where the predetermined horizontal plane is located.

所述位置信息处理模块包括:数据选取模块,用于从所述该时刻无轨车辆相对于该信息标签的位置信息中以不同方式选取数据进行该时刻无轨车辆相对于该信息标签的位置计算;统计平均模块,用于对数据选取模块计算得到的多个计算结果进行统计平均,将统计平均后的结果作为该时刻无轨车辆相对于该信息标签的位置计算结果。The position information processing module includes: a data selection module, which is used to select data in different ways from the position information of the trackless vehicle at this time relative to the information label to calculate the position of the trackless vehicle at this time relative to the information label; The averaging module is used to statistically average the multiple calculation results calculated by the data selection module, and use the statistically averaged results as the calculation results of the position of the trackless vehicle relative to the information tag at this moment.

该系统大致分为两个部分:信息标签的设置和无轨车辆的扫描测距。信息标签实际上只是一个虚拟的概念,代表了具有固定编码的,对应于预定标签位置的,可以被无轨车辆扫描获取编码、测量彼此距离的一种类似于标签的物体。The system is roughly divided into two parts: the setting of information labels and the scanning distance measurement of trackless vehicles. The information tag is actually just a virtual concept, which represents a tag-like object with a fixed code corresponding to the predetermined tag position, which can be scanned by the trackless vehicle to obtain the code and measure the distance between each other.

该系统首先在井下沿无轨车辆行驶方向选取了若干个间距不超过预定值的标签位置,也就是在决定设置信息标签的位置。预定值是为了保证无轨车辆总能至少扫描到一个信息标签而设置的,其值不大于无轨车辆的最大扫描长度。而且,每个标签位置的坐标是可以通过常用技术手段预先获知的,比如通过实际测定或者根据井下环境的数字模型来标定,从而每个标签位置就都可以用相应坐标来表示。The system first selects a number of label positions with a spacing not exceeding a predetermined value along the trackless vehicle driving direction underground, that is, the position where information labels are decided to be set. The predetermined value is set to ensure that the trackless vehicle can always scan at least one information label, and its value is not greater than the maximum scanning length of the trackless vehicle. Moreover, the coordinates of each tag position can be known in advance through common technical means, such as through actual measurement or calibration based on a digital model of the downhole environment, so that each tag position can be represented by corresponding coordinates.

然后,在每个所述标签位置的巷道壁上设置对应编码的信息标签,并将其对应关系存储在标签信息库中。这一步骤也属于在无轨车辆开始行驶前的预先设置,在已经标定好的标签位置上,在比较方便扫描的具体高度上设置各个信息标签。而且,信息标签和标签位置的对应关系需要预先存储到无轨车辆上的某个装置上,用于进行具体的位置计算。Then, a corresponding coded information label is set on the roadway wall at each label position, and the corresponding relationship is stored in the label information database. This step also belongs to the presetting before the trackless vehicle starts to drive, and each information label is set at a specific height that is more convenient for scanning on the label position that has been calibrated. Moreover, the corresponding relationship between information tags and tag positions needs to be pre-stored on a certain device on the trackless vehicle for specific position calculation.

于是在无轨车辆的行驶过程中,只需要扫描周围巷道壁上的信息标签编码,对应编码在装置中找到对应的标签位置,结合测量得到的车辆与信息标签的相对位置信息,就可以计算得到车辆在该时刻的具体绝对位置,也就是其在井下行驶时的全局坐标。其具体的计算过程都属于一般的数据查找和距离测量过程的简单组合,属于现有技术。Therefore, during the driving process of the trackless vehicle, it is only necessary to scan the information label code on the surrounding roadway wall, find the corresponding label position in the device for the corresponding code, and combine the measured relative position information of the vehicle and the information label to calculate the vehicle The specific absolute position at this moment, that is, its global coordinates when driving underground. The specific calculation process is a simple combination of general data search and distance measurement process, which belongs to the prior art.

可见,本系统可以使无轨车辆在行驶时实时地获取自身位置,具有上文叙述过的有益效果,实现了无轨车辆在井下行驶时的全局坐标的方便获取。It can be seen that this system can enable the trackless vehicle to obtain its own position in real time when it is driving, which has the beneficial effects described above, and realizes the convenient acquisition of the global coordinates of the trackless vehicle when it is driving underground.

更具体地,这里结合一套具体装置来说明本系统的具体组成:More specifically, here is a set of specific devices to illustrate the specific composition of the system:

该具体装置包括扫描式距离检测模块,编码式信息标签模块,和位置信息处理模块。在这里,要获取的全局坐标只在无轨车辆自身坐标系的一个水平面XOY上,故所有扫描和测量都只在这一个平面上进行。The specific device includes a scanning distance detection module, a coded information label module, and a position information processing module. Here, the global coordinates to be obtained are only on a horizontal plane XOY of the trackless vehicle's own coordinate system, so all scanning and measurement are only performed on this plane.

所述扫描式距离检测模块是指安装于井下无轨车辆上,用于检测车辆相对于编码式信息标签模块的距离信息。该模块的主要功能是在同一个水平面内,以一定的分辨率连续在同一角度范围内,反复测量标签模块相对于自身的距离信息,并将距离信息按照特定的存储方式进行存储,提供给位置信息处理模块。扫描和测量距离信息的具体方式是使用激光扫描测距技术,其激光扫描器在同一平面以一定周期,连续测量信息标签的相对于激光扫描器自己的距离信息。以铲运机为例的扫描式距离检测模块参见图2,图中1代表井下巷道壁,2为井下常用的无轨车辆—铲运机示意图,3是安装于铲运机的扫描式距离检测模块。该模块也可以选择360度测量,图中示意为180度测量。The scanning distance detection module is installed on the underground trackless vehicle, and is used to detect the distance information of the vehicle relative to the coded information label module. The main function of this module is to repeatedly measure the distance information of the label module relative to itself in the same horizontal plane with a certain resolution within the same angle range, store the distance information in a specific storage method, and provide it to the location information processing module. The specific way to scan and measure distance information is to use laser scanning distance measurement technology. The laser scanner continuously measures the distance information of the information label relative to the laser scanner itself on the same plane at a certain period. For the scanning distance detection module taking the scraper as an example, please refer to Figure 2. In the figure 1 represents the wall of the underground roadway, 2 is a schematic diagram of a trackless vehicle commonly used in underground mines—the scraper, and 3 is the scanning distance detection module installed on the scraper . The module can also choose 360-degree measurement, which is shown in the figure as 180-degree measurement.

编码式信息标签模块是放置于车辆行驶环境下,在扫描式距离检测模块的检测范围内的,具有特定结构的功能性结构物体,标签模块在车辆行驶环境下,所放置点的全局位置信息已事先存入位置信息处理模块中。该信息标签的主要功能是提供距离检测模块可识别的编码标志,识别编码是由宽窄不同、反射率不同的“条”和“空”(也就是上面所说的条状反射区域和空白区域),按照一定的编码顺序组合起来的一种信息标签,信息标签被识别后,其相关信息被位置信息处理模块用于定位信息的计算和处理,编码式信息标签模块的基本设计原理如图3所示。其中黑色部分为实体可反射信号,便于扫描式距离检测模块检测距离,该模块可以在一定的扫描角度范围内可以根据D的实际大小进行扩展。The coded information label module is placed in the driving environment of the vehicle, within the detection range of the scanning distance detection module, a functional structural object with a specific structure. The global position information of the placed point of the label module has been Stored in the location information processing module in advance. The main function of the information label is to provide a coded mark that can be recognized by the distance detection module. The identification code is composed of "bars" and "spaces" with different widths and different reflectivities (that is, the above-mentioned striped reflection areas and blank areas) , a kind of information label combined according to a certain coding sequence. After the information label is identified, its related information is used by the position information processing module to calculate and process the positioning information. The basic design principle of the coded information label module is shown in Figure 3 Show. The black part is the reflective signal of the entity, which is convenient for the scanning distance detection module to detect the distance. This module can be expanded according to the actual size of D within a certain scanning angle range.

位置信息处理模块是放置于无轨车辆上,用于收集扫描式距离检测模块获取的距离信息,和对应每个距离信息的相对测量角度信息,并结合识别后的信息标签中分析计算得到的信息标签编码,从而得到车辆相对于信息标签的相对位置,由于信息标签的绝对位置已经事先存放于位置信息处理模块内,结合自身相对位置和信息标签的绝对位置即可得到无轨车辆的绝对位置信息。The location information processing module is placed on the trackless vehicle to collect the distance information obtained by the scanning distance detection module, and the relative measurement angle information corresponding to each distance information, and combine the information label obtained by analysis and calculation in the identified information label Encoding, so as to obtain the relative position of the vehicle relative to the information label. Since the absolute position of the information label has been stored in the position information processing module in advance, the absolute position information of the trackless vehicle can be obtained by combining its own relative position and the absolute position of the information label.

该具体装置的工作流程如下所示:The workflow of this specific device is as follows:

参见图4,图中编码式信息标签模块放置于井下巷道环境,离巷道壁有一定的距离,该距离信息由扫描式距离检测模块的最短检测单元(图3中的“D”)决定。扫描式距离检测模块和位置信息处理模块为安装于井下移动车辆上。See Figure 4. In the figure, the coded information label module is placed in the underground roadway environment, and has a certain distance from the roadway wall. The distance information is determined by the shortest detection unit ("D" in Figure 3) of the scanning distance detection module. The scanning distance detection module and the position information processing module are installed on the underground mobile vehicle.

扫描式距离检测模块将接收到的“条”、“空”的不同的反射光信号,经过光电转换器转换成模拟电信号,然后经过整形变成通常的数字信号。根据码制所对应的编码规则,位置信息处理模块通过判断当前信标的编码,得到信息标签模块的绝对位置信息,再融合距离检测模块测量的道的实时距离信息和角度信息,进而得到扫描式距离检测模块的精确位置信息,由于扫描式距离检测模块是安装固定在移动车辆上的,从而得到移动车辆的精确位置信息。The scanning distance detection module converts the received "strip" and "empty" reflected light signals into analog electrical signals through photoelectric converters, and then transforms them into common digital signals. According to the encoding rules corresponding to the code system, the position information processing module obtains the absolute position information of the information label module by judging the encoding of the current beacon, and then fuses the real-time distance information and angle information of the track measured by the distance detection module to obtain the scanning distance The precise position information of the detection module, since the scanning distance detection module is installed and fixed on the mobile vehicle, the precise position information of the mobile vehicle can be obtained.

利用激光扫描测量系统在其扫描范围内所扫描返回的信息(举例:选用扫描角度60°,扫描频率300Hz,角分辨率0.2°,即一个完整的扫描周期返回300个扫描点的数值),位置信息处理模块的具体位置处理算法如图5所示。以图6为例,G代表安装于移动车辆的扫描式距离检测模块,EF表示为编码式信息标签模块。全局坐标系为XOY,G代表扫描式距离检测模块的坐标点,A、A1、B、B1、C、C1分别为关键标志点。算法流程具体包括:Use the information returned by the laser scanning measurement system within its scanning range (for example: choose a scanning angle of 60°, a scanning frequency of 300Hz, and an angular resolution of 0.2°, that is, a complete scanning cycle returns the value of 300 scanning points), position The specific position processing algorithm of the information processing module is shown in Fig. 5 . Taking Figure 6 as an example, G represents a scanning distance detection module installed on a moving vehicle, and EF represents a coded information label module. The global coordinate system is XOY, G represents the coordinate point of the scanning distance detection module, and A, A1, B, B1, C, and C1 are key marker points respectively. The algorithm process specifically includes:

步骤501:获取单个测量周期内的扫描式距离检测模块的各点测量数据。Step 501: Obtain the measurement data of each point of the scanning distance detection module within a single measurement cycle.

位置信息处理模块通过总线方式获取扫描式距离检测模块单个周期内的测量数据,并将数据存放于数组Distance[i](0<i<300)。The position information processing module obtains the measurement data of the scanning distance detection module in a single cycle through the bus, and stores the data in the array Distance[i] (0<i<300).

步骤502:识别关键标志点。Step 502: Identify key landmarks.

关键标志点指计算相邻两点的差值,如大于设定的差值阈值,abs(Distance[i+1]-Distance[i])>ε1(ε1为设定的差值阈值),abs为绝对值算符。则将此点作为关键标志点存储起来,即将i的值存放于数组Count[j++]。The key mark point refers to the calculation of the difference between two adjacent points, if it is greater than the set difference threshold, abs(Distance[i+1]-Distance[i])>ε1 (ε1 is the set difference threshold), abs is an absolute value operator. Then store this point as a key mark point, that is, store the value of i in the array Count[j++].

步骤503:测量点的矢量化。Step 503: Vectorization of measurement points.

利用前后两个关键标志点间的差值来区分两类扫描数值,如果Distance[Count[j]+1]-Distance[Count[j]]>ε2(ε2为设定的差值阈值),则该点矢量化为Distance[i].Flag=1;反之则Distance[i].Flag=0;即改点的标志位赋值为1,反之则为0。Use the difference between the two key marker points before and after to distinguish the two types of scan values, if Distance[Count[j]+1]-Distance[Count[j]]>ε2 (ε2 is the set difference threshold), then The point is vectorized as Distance[i].Flag=1; otherwise, Distance[i].Flag=0; that is, the flag bit of the changed point is assigned a value of 1, otherwise it is 0.

步骤504:标志点的归类存储。Step 504: Classification and storage of marker points.

关键标志点将信标分为若干段,段标志取自相应关键标志点,即:Data[j1].Flag=Distance[Count[j1]+1].Flag。The key mark points divide the beacon into several segments, and the segment flags are taken from the corresponding key mark points, namely: Data[j1].Flag=Distance[Count[j1]+1].Flag.

步骤505:信息标签计算。Step 505: Information label calculation.

信息标签的每一段宽度计算采用三角函数计算,利用三角几何关系分别计算出“条”和“空”的距离,存入Data[j1].Lenth,如图6,计算条状BC的距离方式为The width of each section of the information label is calculated using trigonometric functions, and the distance between the "bar" and "empty" is calculated using the triangular geometric relationship, and stored in Data[j1].Lenth, as shown in Figure 6, the method of calculating the distance of the strip BC is

BCBC == GBGB 22 ++ GCGC 22 -- GBGB ** GCGC ** COS&phi;COS&phi;

计算空状AA1的距离方式为The way to calculate the distance of the empty AA 1 is

AAAAA 11 == GAGA 11 22 ++ GAGA 22 -- 22 GAGA ** GAGA 11 ** COS&theta;COS&theta;

步骤506:匹配判断。Step 506: Matching judgment.

先判断每个Data[j1].Lenth都对应几倍的D,来将对应的连续的“1”或“0”进行还原。也就是先判断Data[j1].Lenth是否小于D+ε2,若小于则判断|Data[j1].Lenth–D|<ε2是否成立(ε2为误差容限,其大小一般不大于D/10),若成立则判定Data[j1].Lenth的位数为1;First determine how many times each Data[j1].Lenth corresponds to D, to restore the corresponding continuous "1" or "0". That is, first judge whether Data[j1].Lenth is less than D+ε2, and if it is less than, judge whether |Data[j1].Lenth–D|<ε2 is true (ε2 is the error tolerance, and its size is generally not greater than D/10) , if it is established, it is determined that the number of digits of Data[j1].Lenth is 1;

若不小于则继续判断Data[j1].Lenth是否小于2D+ε2,若小于则判断|Data[j1].Lenth-2D|<ε2是否成立,若成立则判定Data[j1].Lenth的位数为2,并以此类推,得到其位数后,将对应的标志位Data[j1].Flag按所得位数进行扩展。例如,若j1对应的标志位为“1”,且Data[j1].Lenth的位数为3,则把j1的标志位扩展为“111”。参见图6,由此就可以把原有的“10101”扩展为“111010111110111”。If it is not less than, continue to judge whether Data[j1].Lenth is less than 2D+ε2, if it is less than, judge whether |Data[j1].Lenth-2D|<ε2 is true, and if it is true, judge the number of digits of Data[j1].Lenth is 2, and so on, after obtaining the number of digits, expand the corresponding flag Data[j1].Flag according to the obtained number of digits. For example, if the flag bit corresponding to j1 is "1" and the number of bits of Data[j1].Lenth is 3, then the flag bit of j1 is extended to "111". Referring to FIG. 6, the original "10101" can be extended to "111010111110111".

标志位与模板标志的匹配:判断各段标志位Data[j1].Flag是否与模板给出标志位一致(图3所示);其中1表示反射区域的“条”,0代表空白区域的“空”。Matching of the flag bit and the template flag: judge whether the flag bit Data[j1].Flag of each segment is consistent with the flag bit given by the template (as shown in Figure 3); where 1 represents the "bar" of the reflection area, and 0 represents the "bar" of the blank area. null".

步骤507:位置计算。Step 507: Position calculation.

由于每个信息标签的位置是事先已经存放于位置信息处理模块中,根据步骤506判断出此信息标签编码后,则单个信息编码标签上的A、B、C点的坐标已知,假设分别为(X1,Y1)、(X2,Y2)、(X3,Y3),且GA、GB、GC均为扫描式距离测量模块的测量值,结合φ和θ的角度信息,利用三角函数关系反推计算得出此时扫描测量模块G的坐标(X,Y)的公式为:Since the position of each information label has been stored in the position information processing module in advance, after judging that the information label is encoded according to step 506, the coordinates of points A, B, and C on the single information encoding label are known, assuming that they are respectively (X 1 , Y 1 ), (X 2 , Y 2 ), (X 3 , Y 3 ), and GA, GB, and GC are the measured values of the scanning distance measurement module, combined with the angle information of φ and θ, using The formula of the coordinates (X, Y) of the scanning measurement module G at this time is calculated by reverse calculation of the trigonometric function relationship:

(( Xx -- Xx 11 )) 22 ++ (( YY -- YY 11 )) 22 == GAGA 22 (( Xx -- Xx 22 )) 22 ++ (( YY -- YY 22 )) 22 == GBGB 22 (( Xx -- Xx 33 )) 22 ++ (( YY -- YY 33 )) 22 == GCGC 22

(X,Y)为固定在移动车辆上的扫描式距离检测模块的坐标,根据模块安装的位置坐标和车体坐标系的转换关系,从而得到移动车辆的实时位置坐标。其中,每两个点都可以算出一个对应的(X,Y),所以在具体运算时,可以算出多组(X,Y)并取平均值,以减小偶然误差。上面的方程就取了3个点,可以得到3个解取其平均值。(X, Y) are the coordinates of the scanning distance detection module fixed on the moving vehicle, and the real-time position coordinates of the moving vehicle are obtained according to the conversion relationship between the position coordinates of the module installation and the vehicle body coordinate system. Among them, a corresponding (X, Y) can be calculated for every two points, so in specific operations, multiple groups of (X, Y) can be calculated and averaged to reduce accidental errors. The above equation takes 3 points, and 3 solutions can be obtained to take the average value.

步骤508:识别结束,计算出相应的位置。Step 508: The recognition ends, and the corresponding position is calculated.

自此完成了对编码式信息标签的扫描和测量。这里由于编码式信息标签是一个外表面上有条状反射区域与条状镂空区域按编码顺序交替排列的空心平板,条状反射区域(如图6中的EA段、A1B1段、BC段和C1F段)可以反射所述扫描时和所述测量时所发射的信号,所以这些区域上的点都可以被扫描到,也可以测量其间距;而由于其中的条状镂空区域(如图6中的AA1段、B1B段和CC1段)是被镂空的区域,所以在扫描和测量进行到这些区域时,测量和扫描到的其实是空心平板内表面上的点。所以在条状反射区域和条状镂空区域的边界附近,测量的距离在数值上通常会有一个较大幅度的突变。根据这一特性设置一个较小的差值阈值ε1,就可以识别出突变大于所设阈值的的边界位置,也就是上面所说的“关键标志点”。Scanning and measurement of coded information labels has since been completed. Here, because the coded information label is a hollow plate with striped reflective areas and striped hollow areas arranged alternately in the coding order on the outer surface, the striped reflective areas (such as the EA segment, A1B1 segment, BC segment and C1F segment in Figure 6) Segment) can reflect the signals emitted during the scanning and the measuring, so the points on these areas can be scanned, and their spacing can also be measured; and because of the strip-shaped hollow area (as shown in Figure 6 AA1 segment, B1B segment and CC1 segment) are hollowed out areas, so when scanning and measuring these areas, what is measured and scanned is actually a point on the inner surface of the hollow plate. Therefore, near the boundary of the strip-shaped reflection area and the strip-shaped hollow area, the measured distance usually has a large abrupt change in value. By setting a small difference threshold ε1 according to this characteristic, the boundary position where the mutation is greater than the set threshold can be identified, which is the "key mark point" mentioned above.

然后,进行“测量点的矢量化”,也就是区分两个关键标志点之间是“1”区域还是“0”区域。由于从“条”到“空”判断出的关键标志点对应测量的是条状反射区域上的点与坐标原点的距离,而从“空”到“条”判断出的关键标志点对应测量的是空心平板内表面上的点与坐标原点的距离,所以测量得到的距离后者通常都会比前者大。利用这一性质,就可以判断相邻关键标志点之间是“条”还是“空”。对应于上面的Distance[Count[j]+1]-Distance[Count[j]]>ε2,就是在比较两个距离与0的大小(ε2为0附近的数值,这里设为变量可以做调整),从而满足条件的对应i为“条”,否则为“空”。Then, "vectorization of measurement points" is carried out, that is, to distinguish whether the area between two key marker points is a "1" area or a "0" area. Since the key marker points judged from "bar" to "empty" correspond to the distance between the point on the bar-shaped reflection area and the coordinate origin, and the key marker points judged from "empty" to "bar" correspond to the measured is the distance between the point on the inner surface of the hollow plate and the origin of the coordinates, so the measured distance of the latter is usually greater than the former. Using this property, it can be judged whether the adjacent key marker points are "bar" or "empty". Corresponding to the above Distance[Count[j]+1]-Distance[Count[j]]>ε2, it is comparing the size of the two distances with 0 (ε2 is a value near 0, which can be adjusted as a variable here) , so that the corresponding i that satisfies the condition is "bar", otherwise it is "empty".

在进行匹配时,由于这里还没有区分每个“条”是代表多少个“1”,每个“空”代表多少个“0”,所以要由相邻关键标志点之间的距离是多少倍的D来决定。具体实现方式已经在上面描述过,从而可以把原有的“1010101…”这样交替的编码,还原为“111001011011”这样有重复字段的编码。当然,条状反射区域与条状镂空区域的宽度都是固定的,长度为D,这样的设置下才能让扫描可以进行识别。When matching, since there is no distinction here about how many "1s" each "bar" represents and how many "0s" each "empty" represents, it is determined by how many times the distance between adjacent key marker points D to decide. The specific implementation method has been described above, so that the original alternate coding such as "1010101..." can be restored to the coding with repeated fields such as "111001011011". Of course, the width of the strip-shaped reflective area and the strip-shaped hollow area are fixed, and the length is D, so that the scanning can be recognized under such a setting.

还原编码后,就可以直接比对标签信息库找到对应标签的绝对位置,再由车辆与标签的相对位置就可以计算出车辆的绝对位置了。After restoring the code, you can directly compare the tag information database to find the absolute position of the corresponding tag, and then calculate the absolute position of the vehicle based on the relative position between the vehicle and the tag.

由于编码是人为设定的,所以自然界中的巷道壁很难出现能被识别并匹配的情况(那样就要求巷道壁平面平整地出现高-低-高-低-…这样的情形,可见这几乎是不可能的),基本上可以认定只有对应的编码式信息标签才能满足上述匹配。而且具体的扫描测量过程也可以有D、ε1、ε2、ε3多个数值来进行调整,以满足不同应用需要。Since the code is artificially set, it is difficult for the roadway wall in nature to be identified and matched (that requires the roadway wall plane to appear high-low-high-low-... such a situation, it can be seen that this is almost is impossible), basically it can be determined that only the corresponding coded information label can satisfy the above matching. Moreover, the specific scanning measurement process can also be adjusted with multiple values of D, ε1, ε2, and ε3 to meet different application needs.

以上就是该装置的具体工作流程,该装置具有上文已经叙述过的有益效果,可以实现无轨车辆在井下行驶时的全局坐标的方便获取。The above is the specific working process of the device. The device has the beneficial effects described above, and can realize the convenient acquisition of the global coordinates of the trackless vehicle when it is driving underground.

总体来说,本发明针对井下巷道特殊的环境,提出一种适用于井下无轨车辆的的定位方法,利用该方法可以方便的获取车辆在井下的全局坐标,该方法所涉及的工作系统结构简单,工作稳定可靠,同时还满足井下无轨车辆自主行使控制过程中对定位的精度要求。Generally speaking, the present invention proposes a positioning method suitable for underground trackless vehicles for the special environment of underground roadways. By using this method, the global coordinates of vehicles in the underground can be easily obtained. The structure of the working system involved in this method is simple. The work is stable and reliable, and at the same time, it also meets the accuracy requirements for positioning during the autonomous exercise control process of underground trackless vehicles.

需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。It should be noted that in this article, relational terms such as first and second are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply that there is a relationship between these entities or operations. There is no such actual relationship or order between them. Furthermore, the term "comprises", "comprises" or any other variation thereof is intended to cover a non-exclusive inclusion such that a process, method, article or apparatus comprising a set of elements includes not only those elements, but also includes elements not expressly listed. other elements of or also include elements inherent in such a process, method, article, or device. Without further limitations, an element defined by the phrase "comprising a ..." does not exclude the presence of additional identical elements in the process, method, article or apparatus comprising said element.

以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。The above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: it can still be described in the foregoing embodiments Modifications are made to the recorded technical solutions, or equivalent replacements are made to some of the technical features; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims (8)

1. a localization method for underground trackless vehicle, is characterized in that, the method comprises:
Choose along trackless vehicle travel direction the label position that several spacing are no more than predetermined value in down-hole;
The wall of each described label position arranges the information labels of corresponding coding, and its corresponding relation is stored in tag information base;
Trackless vehicle in traveling is by the described information labels of scanning, from described tag information base, obtaining the positional information of this information labels according to the correspondence coding obtained, and obtaining the positional information of this moment trackless vehicle relative to this information labels by measuring with the distance of described information labels;
In conjunction with the positional information of this information labels described and this moment trackless vehicle described its position residing for this moment of positional information calculation relative to this information labels;
Wherein, described calculating comprises carries out the position calculation of this moment trackless vehicle relative to this information labels from this moment trackless vehicle described relative to choosing data the positional information of this information labels by different way, and statistical average is carried out to the multiple result of calculations obtained, using the result after statistical average as the position calculation result of this moment trackless vehicle relative to this information labels.
2. method according to claim 1, it is characterized in that, described information labels is a hollow slab outside surface having strip reflector space and strip void region are alternately arranged by coded sequence, when the surfaces externally and internally of described hollow slab can reflect described scanning and described measurement time the signal launched, each described strip reflector space and strip void region have fixing size respectively.
3. method according to claim 1, is characterized in that, described scanning and described measurement are all carried out in laser scanning and ranging mode simultaneously.
4. method according to claim 1, it is characterized in that, carry out in a described scanning and described measurement predetermined level all only under trackless vehicle local Coordinate System, the wall that the described information labels arranging corresponding coding in the wall of each described label position is included in each described label position is arranged the information labels of corresponding coding with reference to the height at described predetermined level place.
5. a positioning system for underground trackless vehicle, is characterized in that, this system comprises:
Coding type information labels module, for choosing along trackless vehicle travel direction the label position that several spacing are no more than predetermined value in down-hole, and the information labels of corresponding coding is set in the wall of each described label position, and its corresponding relation is stored in tag information base;
Scan-type distance detection module, the described information labels of scanning is passed through for the trackless vehicle in travelling, from described tag information base, obtaining the positional information of this information labels according to the correspondence coding obtained, and obtaining the positional information of this moment trackless vehicle relative to this information labels by measuring with the distance of described information labels;
Position information process module, for combining the positional information of this information labels described and this moment trackless vehicle described its position residing for this moment of positional information calculation relative to this information labels;
Wherein, described position information process module comprises: data decimation module, for carrying out the position calculation of this moment trackless vehicle relative to this information labels from this moment trackless vehicle described relative to choosing data in the positional information of this information labels by different way; Statistical average module, carries out statistical average for the multiple result of calculations calculated data decimation module, using the result after statistical average as the position calculation result of this moment trackless vehicle relative to this information labels.
6. system according to claim 5, it is characterized in that, described coding type information labels module comprises the hollow slab that an outside surface has strip reflector space and strip void region to be alternately arranged by coded sequence, when the surfaces externally and internally of described hollow slab can reflect described scanning and described measurement time the signal launched, each described strip reflector space and strip void region have fixing size respectively.
7. system according to claim 5, is characterized in that, described scan-type distance detection module comprises the instrument for laser scanning and ranging.
8. system according to claim 5, is characterized in that, described scan-type distance detection module comprises horizontal scanning formula distance detection module, for carrying out described scanning and described measurement in the predetermined level of under trackless vehicle local Coordinate System; Described coding type information labels module comprises information labels height and arranges module, arranges the information labels of corresponding coding in the wall at each described label position with reference to the height at described predetermined level place.
CN201410052500.XA 2014-02-14 2014-02-14 Method and system for positioning underground trackless vehicle Active CN103869283B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410052500.XA CN103869283B (en) 2014-02-14 2014-02-14 Method and system for positioning underground trackless vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410052500.XA CN103869283B (en) 2014-02-14 2014-02-14 Method and system for positioning underground trackless vehicle

Publications (2)

Publication Number Publication Date
CN103869283A CN103869283A (en) 2014-06-18
CN103869283B true CN103869283B (en) 2016-03-30

Family

ID=50908022

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410052500.XA Active CN103869283B (en) 2014-02-14 2014-02-14 Method and system for positioning underground trackless vehicle

Country Status (1)

Country Link
CN (1) CN103869283B (en)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104731100B (en) * 2015-03-31 2018-04-27 北京矿冶研究总院 Unmanned control method and system for underground scraper
CN104950288B (en) * 2015-04-30 2017-12-12 成都恒高科技有限公司 Tunnel environmental positioning method, apparatus, system and positioning label card
US10599157B2 (en) * 2015-06-10 2020-03-24 Doog Inc. Autonomous movement system
CN105022404A (en) * 2015-06-18 2015-11-04 北京矿冶研究总院 Underground unmanned scraper running positioning system and method
CN108181609B (en) * 2017-12-12 2020-12-08 深圳市易成自动驾驶技术有限公司 Vehicle positioning method and device and computer readable storage medium
CN109164412A (en) * 2018-07-06 2019-01-08 北京矿冶科技集团有限公司 A kind of assisted location method based on beacon identification
DE102018130720A1 (en) * 2018-12-03 2020-06-04 Ima Schelling Deutschland Gmbh Infrastructure system
JP7441843B2 (en) * 2018-12-18 2024-03-01 ボルボトラックコーポレーション How to determine vehicle coordinates
CN111897320B (en) * 2020-06-19 2023-06-09 中国煤炭科工集团太原研究院有限公司 Underground unmanned material transporting vehicle control system
CN111854730A (en) * 2020-06-19 2020-10-30 中国煤炭科工集团太原研究院有限公司 Positioning method and system for unmanned light trackless rubber-tyred passenger car and freight car
CN111791214A (en) * 2020-07-03 2020-10-20 北京海益同展信息科技有限公司 Inspection robot and inspection system for inspecting construction tunnel
CN113236358A (en) * 2021-04-24 2021-08-10 中国煤炭科工集团太原研究院有限公司 Automatic drainage robot for mine
CN113701754B (en) * 2021-09-06 2023-05-12 中国矿业大学(北京) Underground three-dimensional accurate positioning system
CN114485615A (en) * 2022-01-05 2022-05-13 中国煤炭科工集团太原研究院有限公司 Downhole positioning system and downhole positioning method
CN114279461B (en) * 2022-03-02 2022-07-08 中科开创(广州)智能科技发展有限公司 Mileage positioning method, unit, device, equipment and storage medium of robot
CN116117121B (en) * 2023-04-07 2023-06-27 秦皇岛泰科科技开发有限公司 Intelligent fixed-point flexible connection magnetic attraction type torpedo tank car cover adding and uncovering system and method

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4023861A (en) * 1974-12-11 1977-05-17 Gebr. Eickhoff, Maschinenfabrik Und Eisengiesserei M.B.H. Method and apparatus for controlling a tunneling machine
US4884847A (en) * 1988-02-19 1989-12-05 Consolidation Coal Co. Apparatus and method for mapping entry conditions in remote mining systems
CN1233706A (en) * 1998-04-24 1999-11-03 英科有限公司 Automated guided apparatus suitable for toping applications
EP1176393A3 (en) * 2000-07-17 2010-04-21 CVRD Inco Limited Self-contained mapping and positioning system utilizing point cloud data
CN102053249A (en) * 2009-10-30 2011-05-11 吴立新 Underground space high-precision positioning method based on laser scanning and sequence encoded graphics

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4023861A (en) * 1974-12-11 1977-05-17 Gebr. Eickhoff, Maschinenfabrik Und Eisengiesserei M.B.H. Method and apparatus for controlling a tunneling machine
US4884847A (en) * 1988-02-19 1989-12-05 Consolidation Coal Co. Apparatus and method for mapping entry conditions in remote mining systems
CN1233706A (en) * 1998-04-24 1999-11-03 英科有限公司 Automated guided apparatus suitable for toping applications
EP1176393A3 (en) * 2000-07-17 2010-04-21 CVRD Inco Limited Self-contained mapping and positioning system utilizing point cloud data
CN102053249A (en) * 2009-10-30 2011-05-11 吴立新 Underground space high-precision positioning method based on laser scanning and sequence encoded graphics

Also Published As

Publication number Publication date
CN103869283A (en) 2014-06-18

Similar Documents

Publication Publication Date Title
CN103869283B (en) Method and system for positioning underground trackless vehicle
US12151685B2 (en) Road vector fields
Guan et al. Use of mobile LiDAR in road information inventory: A review
Brenner Extraction of features from mobile laser scanning data for future driver assistance systems
CN108776487A (en) A kind of mining rail formula crusing robot and its localization method
CN102053249B (en) Underground space high-precision positioning method based on laser scanning and sequence encoded graphics
CN109416256B (en) Travel lane estimation system
KR100946935B1 (en) Position detecting device of moving object
Chi et al. Automatic guidance of underground mining vehicles using laser sensors
US12005940B2 (en) Systems and methods for route mapping
EP2306150B1 (en) Method of transmitting position information of digital map and apparatus utilized for the method
CN103674015B (en) Trackless positioning navigation method and device
CN104024880A (en) Methods and systems for precise vehicle localization using radar maps
US20140095062A1 (en) Road Maps from Clusters of Line Segments of Multiple Sources
US20080243378A1 (en) System and method for vehicle navigation and piloting including absolute and relative coordinates
CN107053219A (en) A kind of method for positioning mobile robot based on laser scanner Yu strong reflecting sign
JP2015004814A (en) Lane map generation device and program
WO2013059553A1 (en) System for the navigation of oversized vehicles
CN105882659A (en) Driving lane detection device and driving lane detection method
Raval et al. A preliminary investigation of mobile mapping technology for underground mining
Kumar et al. A survey on localization for autonomous vehicles
CN109937342B (en) Method, device and system for locating moving object
JP2019219348A (en) Moisture ratio mapping method, and moisture ratio mapping device
CN111929693B (en) Underground positioning method based on laser point cloud distance sequence
WO2024217426A1 (en) Vehicle positioning method based on multi-source information fusion

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant