[go: up one dir, main page]

CN111156975B - Position and attitude data measuring system and method for development machine - Google Patents

Position and attitude data measuring system and method for development machine Download PDF

Info

Publication number
CN111156975B
CN111156975B CN202010086857.5A CN202010086857A CN111156975B CN 111156975 B CN111156975 B CN 111156975B CN 202010086857 A CN202010086857 A CN 202010086857A CN 111156975 B CN111156975 B CN 111156975B
Authority
CN
China
Prior art keywords
roadheader
laser
horizontally moving
microcontroller
data
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
CN202010086857.5A
Other languages
Chinese (zh)
Other versions
CN111156975A (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 ELINKCS SCIENCE AND TECHNOLOGY CO LTD
Beijing Jiaotong University
Original Assignee
BEIJING ELINKCS SCIENCE AND TECHNOLOGY CO LTD
Beijing Jiaotong University
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 ELINKCS SCIENCE AND TECHNOLOGY CO LTD, Beijing Jiaotong University filed Critical BEIJING ELINKCS SCIENCE AND TECHNOLOGY CO LTD
Priority to CN202010086857.5A priority Critical patent/CN111156975B/en
Publication of CN111156975A publication Critical patent/CN111156975A/en
Application granted granted Critical
Publication of CN111156975B publication Critical patent/CN111156975B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • G01C15/002Active optical surveying means
    • G01C15/008Active optical surveying means combined with inclination sensor

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Excavating Of Shafts Or Tunnels (AREA)

Abstract

本发明一种基于水平移动标靶的掘进机位姿数据测量系统及其测量方法,属于掘进机位姿数据测量技术领域;所要解决的技术问题为:提供一种基于水平移动标靶的掘进机位姿数据测量系统硬件结构及其测量方法的改进;解决该技术问题采用的技术方案为:包括掘进机和活动设置在掘进巷道顶板上的激光指向仪,激光指向仪设置在掘进机的后侧,掘进机的机身上侧平行设置有一对水平移动标靶,水平移动标靶包括检测靶,检测靶通过靶座滑块设置在由步进电机驱动的滑轨上,两个水平移动标靶的滑轨相互平行设置在掘进机机身上侧,步进电机设置在掘进机机身侧壁上;掘进机的内部还设置有控制电路板和倾角传感器;本发明应用于掘进机位姿数据测量场所。

Figure 202010086857

The present invention is a roadheader position and attitude data measurement system and a measurement method based on a horizontally moving target, belonging to the technical field of roadheader position and attitude data measurement; the technical problem to be solved is: to provide a roadheader based on a horizontally moving target The improvement of the hardware structure of the pose data measurement system and its measurement method; the technical solution adopted to solve the technical problem is: including a roadheader and a laser pointer movably arranged on the roof of the roadway, and the laser pointer is arranged on the back side of the roadheader , A pair of horizontal moving targets are arranged in parallel on the upper side of the fuselage of the roadheader. The horizontal moving targets include detection targets. The detection targets are set on the slide rail driven by the stepping motor through the target base slider. The sliding rails are arranged parallel to each other on the upper side of the roadheader body, and the stepping motor is arranged on the sidewall of the roadheader body; the interior of the roadheader is also provided with a control circuit board and an inclination sensor; the present invention is applied to the roadheader posture data measurement site.

Figure 202010086857

Description

Position and attitude data measuring system and method for development machine
Technical Field
The invention discloses a heading machine position and attitude data measuring system based on a horizontal moving target and a measuring method thereof, and belongs to the technical field of heading machine position and attitude data measurement.
Background
The development machine is a combined unit capable of realizing cutting, loading and transporting functions, and a cantilever type tunnel development machine is used in the coal and rock development field at present; in the using process, the orientation of the heading machine has important significance for heading the direction and the gradient of the roadway.
In the traditional tunneling process, in order to keep the tunneling equipment always in the correct tunneling direction, a driver of the tunneling machine needs to manually observe at any time and accurately follow the laser pointing point of the laser pointing instrument to perform tunneling construction; with the improvement of the quality and efficiency requirements of the mine roadway tunneling project, the automatic tunneling work of the tunneling machine is required, and the tunneling work of the tunneling machine needs to be completed by an automatic control method urgently so as to reduce the working strength of field workers and improve the tunneling efficiency.
The automatic position and orientation measurement of the heading machine is the premise of realizing the automatic control of the heading machine, in order to realize the position and orientation measurement of the heading machine, the position coordinate of the heading equipment is required to be established, and the heading direction are controlled only by the position coordinate, so that the heading machine has the automatic heading function; the existing measuring device and measuring method are influenced by factors such as complex driving terrain, harsh environment and the like, so that the measuring device is complex in structure and low in measuring precision, the defects of accumulative errors, drifting and the like which cannot be avoided exist in the process of using an inertial navigation technology for long-time work, and the accuracy is difficult to ensure in high-vibration occasions.
Disclosure of Invention
In order to overcome the defects in the prior art, the invention aims to solve the technical problems that: the hardware structure of the heading machine position and attitude data measuring system based on the horizontal moving target and the improvement of the measuring method thereof are provided.
In order to solve the technical problems, the invention adopts the technical scheme that: a position and posture data measuring system of a heading machine based on horizontal moving targets comprises the heading machine and a laser direction indicator movably arranged on a top plate of a heading tunnel, wherein the laser direction indicator is arranged at the rear side of the heading machine, a pair of horizontal moving targets are arranged on the upper side of the machine body of the heading machine in parallel, each horizontal moving target comprises a detection target, the detection target is arranged on a slide rail driven by a stepping motor through a target seat slide block, the slide rails of the two horizontal moving targets are arranged on the upper side of the machine body of the heading machine in parallel, and the stepping motor is arranged on the side wall of the machine body of the heading machine;
the interior of the development machine is also provided with a control circuit board and an inclination angle sensor, and the control circuit board is integrated with a microcontroller;
the horizontal moving target is used for receiving laser beams emitted by a laser direction indicator, and the detection target is a laser capture circuit board formed by photosensitive diodes;
the microcontroller is connected with the signal output end of the detection target through a lead;
the microcontroller is connected with the stepping motor and the inclination angle sensor through leads;
the microcontroller is also connected with a data storage module through a lead;
and the power supply input end of the microcontroller is connected with the power supply module.
The chip used by the microcontroller is a control chip U1, and the circuit structure of the microcontroller is as follows:
pins 1, 9, 24, 36 and 48 of the control chip U1 are connected with a 3.3V input power supply;
pins 2, 3, 38, 39, 45 and 46 of the control chip U1 are connected with the control end of the stepping motor;
the 4 pins of the control chip U1 are connected in series with the resistor R61 and the diode LED1 and then grounded;
the 5 pin of the control chip U1 is connected with one end of a crystal oscillator XT1 and then is connected with one end of a capacitor C16;
the pin 6 of the control chip U1 is connected with the other end of the crystal oscillator XT1 in parallel and then is connected with the other end of the capacitor C17, and the other end of the capacitor C17 is connected with the other end of the capacitor C16 in parallel and then is grounded at one end of the capacitor C14;
the other end of the capacitor C14 is connected with one end of a resistor R59 and one end of a control switch SW1 in parallel and then is connected with a pin 7 of a control chip U1;
the other end of the resistor R59 is connected with a 3.3V input power supply, and the other end of the control switch SW1 is grounded;
pins 10 to 22 of the control chip U1 are connected with the signal output end of the detection target through a multiplexer;
pins 25 to 28 of the control chip U1 are connected with a data storage module;
pins 29, 30 and 31 of the control chip U1 are connected with the signal output end of the stepping motor through a 485 transceiver;
and pins 34 and 37 of the control chip U1 are connected with the signal output end of the tilt sensor.
The model of the control chip U1 is STM32F103CBU 6;
the type of a chip used in the multiplexer is 74HC 4051;
the model of the 485 transceiver is MAX 3485;
the chip model used in the data storage module is 74HC 595;
the chip models used in the power module are a power distribution switch TPS2552 and a voltage stabilizer RT 9013.
A heading machine position and attitude data measuring method based on a horizontal moving target comprises the following steps:
the method comprises the following steps: the method comprises the following steps of arranging a tunneling machine in a roadway to be tunneled, installing a laser direction indicator on a roadway top plate on the rear side of the tunneling machine, wherein the laser direction indicator is specifically arranged at the center line position of the roadway top plate, and the laser emission angle of the laser direction indicator is consistent with the tunneling direction of the roadway;
step two: a pair of horizontal moving targets are installed on a tunneling machine body, detection targets of the horizontal moving targets are vertically installed on a target seat sliding block, the target seat sliding block is installed on a sliding rail arranged on the upper side of the tunneling machine body, and the two horizontal moving targets are arranged in parallel;
step three: controlling the heading machine to start heading operation, manually adjusting the mounting position and the laser emission angle of a laser direction indicator to enable laser beams emitted By the laser direction indicator to be capable of being shot on detection targets of two horizontal moving targets, acquiring coordinate positions of the current laser beams on the detection targets By the detection targets through a laser capture circuit board, wherein the coordinate position data comprise left and right positions (Ax, Bx) and upper and lower positions (Ay, By), and sending the coordinate position data to a microcontroller through a lead wire for further processing By the detection targets;
step four: the tilt angle sensor simultaneously acquires the current tunneling pitch angle data (Yaw) of the tunneling machine, and the tilt angle sensor sends the pitch angle data to the microcontroller through a lead for further processing;
step five: the calculation parameters of the microcontroller comprise preset distance parameters, wherein the distance from the laser beam emitted by the laser direction indicator to the first horizontal moving target is defined as L1, the distance between the two horizontal moving targets is defined as L0, and the pose measurement data of the current heading machine can be calculated and obtained by combining the received laser coordinate data:
wherein the calculation formula of the pitch angle (Yaw) is as follows:
Figure 586270DEST_PATH_IMAGE001
the heading angle (Pitch) is calculated as:
Figure DEST_PATH_IMAGE002
the Roll angle (Roll) data is the measurement data of the tilt sensor (6);
the calculation formula of the horizontal displacement (dx) is:
Figure DEST_PATH_IMAGE003
the calculation formula of the height displacement (dy) is:
Figure DEST_PATH_IMAGE004
the depth displacement (dz) is calculated as:
Figure DEST_PATH_IMAGE005
in the coordinate system of the above formula, an X axis is defined as the width of a roadway driving surface, a Y axis is defined as the height of the roadway driving surface, and a Z axis is defined as the depth of the roadway driving direction;
ax and Bx are x coordinates of the positions of the points where the laser beams strike the first and second horizontal movement targets, respectively;
ay and By are the y-coordinates of the positions of the points where the laser beams impinge on the first and second horizontal movement targets, respectively.
Compared with the prior art, the invention has the beneficial effects that: the invention provides a position and posture data measuring device of a development machine, which can be combined with the functions of the existing laser direction indicator used in coal mines to realize the real-time measurement of the position and posture data of the development machine in work; according to the invention, two horizontal moving type laser targets are additionally arranged on the heading machine body, so that the position and the posture of the current heading machine are measured in the whole time period in the working process of the heading machine, the posture state compensation of the heading machine in the working process can be realized, the posture state compensation is fed back to a monitoring computer, and the automatic heading work of the heading machine is finally realized; the invention is based on the laser direction indicator which is used at present, acquires the center line and the waist line of the tunnel in real time, has high positioning precision, can effectively improve the tunneling efficiency, is convenient for installing and debugging the whole measuring system, and can realize the requirement of accurate positioning of the tunneling machine.
Drawings
The invention is further described below with reference to the accompanying drawings:
FIG. 1 is a schematic structural view of the present invention;
FIG. 2 is a schematic structural diagram of an internal control circuit of the heading machine of the present invention;
FIG. 3 is a circuit diagram of a microcontroller according to the present invention;
FIG. 4 is a model diagram of the present invention for measuring and calculating the pitching angle of the heading machine;
FIG. 5 is a model diagram of the heading angle of the measuring and calculating heading machine of the invention;
FIG. 6 is a data processing flow chart of the position and orientation measurement of the heading machine of the present invention;
in the figure: the device comprises a laser direction indicator 1, a detection target 2, a target seat sliding block 3, a stepping motor 4, a sliding rail 5, an inclination angle sensor 6, a microcontroller 7, a data storage module 8 and a power module 9.
Detailed Description
The invention provides a position and attitude data measuring system and a position and attitude data measuring method of a heading machine based on a horizontal moving target, mainly relates to a heading machine positioning technology used for heading underground coal mine tunnels or railway and highway tunnels, comprises a corresponding position and attitude parameter measuring device and a measuring method thereof, and plays an important role in realizing automatic control of the heading machine.
The invention mainly comprises a laser direction indicator arranged on a top plate of a driving tunnel, wherein the laser direction indicator is arranged by a related measuring department and is used for indicating a central line and a waist line of the driving tunnel, and the laser direction indicator moves forwards in a manual mode at intervals and is repositioned;
as shown in fig. 1 to 3, two horizontally moving laser targets which are arranged in parallel are arranged in front of and behind the machine body of the heading machine, and when the heading machine is used, a laser beam of a laser direction indicator is required to strike the two laser targets; when a certain photosensitive diode receives illumination in a certain frequency spectrum range, the controller scans the voltage change of the diodes on ROW (ROW) and COLUMN (COLUMN) lines connected with the photosensitive diode according to different illumination intensities and different on-resistances of the diodes, and acquires the position of a laser point receiving point according to the voltage difference;
a tunneling machine controller is arranged in the tunneling machine, the controller is in bidirectional communication with the two horizontal moving laser targets through a communication wire, and the controller is also connected with the inclination angle sensor through a wire;
and the interior of the heading machine is also provided with an inclination angle sensor for measuring the roll angle of the heading machine and sending the obtained angle data to the heading machine controller through a lead.
The horizontal moving target comprises detection targets for receiving laser irradiation, each detection target consists of a photosensitive diode and a corresponding controller to form a laser capture circuit board, the detection targets are required to be arranged on a horizontal guide rail in order to ensure that laser beams are irradiated on the two detection targets in the advancing process of the heading machine, the detection targets can move on the guide rail in parallel by controlling a stepping motor, and the moving distance and the current position of the detection targets on the guide rail can be calculated and obtained by a motor encoder in the controller.
As shown in fig. 4 and 5, in order to realize the automatic cutting function of the heading machine on the roadway section and measure the heading position and the body attitude parameter of the heading machine in real time, the invention obtains the roadway center line and the waist line pointed by the laser direction indicator by additionally arranging two horizontally moving laser targets on the heading machine, analyzes and processes the acquired data by combining the body size of the heading machine and the body-mounted tilt angle sensor, and obtains the corresponding position and attitude parameter of the heading machine, thereby providing basic data for realizing the automatic control of the heading machine and improving the heading efficiency, the safety and the roadway flatness of the heading machine.
The invention provides a heading machine pose data measuring method which mainly comprises the following steps:
the method comprises the following steps: the method comprises the following steps of arranging a tunneling machine in a roadway to be tunneled, installing a laser direction indicator on a roadway top plate on the rear side of the tunneling machine, wherein the laser direction indicator is specifically arranged at the center line position of the roadway top plate, and the laser emission angle of the laser direction indicator is consistent with the tunneling direction of the roadway;
step two: a pair of horizontal moving targets are installed on a tunneling machine body, detection targets of the horizontal moving targets are vertically installed on a target seat sliding block, the target seat sliding block is installed on a sliding rail arranged on the upper side of the tunneling machine body, and the two horizontal moving targets are arranged in parallel;
step three: controlling the heading machine to start heading operation, manually adjusting the mounting position and the laser emission angle of a laser direction indicator to enable laser beams emitted By the laser direction indicator to be capable of being shot on detection targets of two horizontal moving targets, acquiring coordinate positions of the current laser beams on the detection targets By the detection targets through a laser capture circuit board, wherein the coordinate position data comprise left and right positions (Ax, Bx) and upper and lower positions (Ay, By), and sending the coordinate position data to a microcontroller through a lead wire for further processing By the detection targets;
step four: the tilt angle sensor simultaneously acquires the current tunneling pitch angle data (Yaw) of the tunneling machine, and the tilt angle sensor sends the pitch angle data to the microcontroller through a lead for further processing;
step five: the calculation parameters of the microcontroller comprise preset distance parameters, wherein the distance from the laser beam emitted by the laser direction indicator to the first horizontal moving target is defined as L1, the distance between the two horizontal moving targets is defined as L0, and the pose measurement data of the current heading machine can be calculated and obtained by combining the received laser coordinate data:
wherein the calculation formula of the pitch angle (Yaw) is as follows:
Figure 690361DEST_PATH_IMAGE001
the heading angle (Pitch) is calculated as:
Figure 470098DEST_PATH_IMAGE002
the Roll angle (Roll) data is the measurement data of the tilt sensor (6);
the calculation formula of the horizontal displacement (dx) is:
Figure 802990DEST_PATH_IMAGE003
the calculation formula of the height displacement (dy) is:
Figure 617362DEST_PATH_IMAGE004
the depth displacement (dz) is calculated as:
Figure 439825DEST_PATH_IMAGE005
in the coordinate system of the above formula, an X axis is defined as the width of a roadway driving surface, a Y axis is defined as the height of the roadway driving surface, and a Z axis is defined as the depth of the roadway driving direction;
ax and Bx are x coordinates of the positions of the points where the laser beams strike the first and second horizontal movement targets, respectively;
ay and By are the y-coordinates of the positions of the points where the laser beams impinge on the first and second horizontal movement targets, respectively.
As shown in fig. 6, the microcontroller establishes data connection with each target unit, and can determine whether the two current horizontal moving targets receive irradiation of a laser beam, after confirming that the two horizontal moving targets capture laser points, the microcontroller calculates corresponding pose data according to a preset algorithm script, and sends corresponding calculation results to a data storage module for storage, and meanwhile, the calculation data can be sent to an upper computer on the ground through an external communication bus, and managers further process the data, so that corresponding management and statistical functions can be realized.
Finally, it should be noted that: the above embodiments are only used to illustrate the technical solution of the present invention, and not to limit the same; while the invention has been described in detail and with reference to the foregoing embodiments, it will be understood by those skilled in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; and the modifications or the substitutions do not make the essence of the corresponding technical solutions depart from the scope of the technical solutions of the embodiments of the present invention.

Claims (1)

1.一种基于水平移动标靶的掘进机位姿数据测量系统,其特征在于:包括掘进机和活动设置在掘进巷道顶板上的激光指向仪(1),所述激光指向仪(1)设置在掘进机的后侧,所述掘进机的机身上侧平行设置有一对水平移动标靶,所述水平移动标靶包括检测靶(2),所述检测靶(2)通过靶座滑块(3)设置在由步进电机(4)驱动的滑轨(5)上,所述两个水平移动标靶的滑轨(5)相互平行设置在掘进机机身上侧,所述步进电机(4)设置在掘进机机身侧壁上;1. A roadheader position and attitude data measurement system based on a horizontally moving target, characterized in that it comprises a roadheader and a laser pointer (1) movably arranged on the roof of a roadway, and the laser pointer (1) is provided with On the rear side of the roadheader, a pair of horizontally moving targets are arranged in parallel on the upper side of the body of the roadheader, and the horizontally moving targets include a detection target (2), which passes through the target base slider (3) It is arranged on a slide rail (5) driven by a stepping motor (4), and the slide rails (5) of the two horizontally moving targets are arranged parallel to each other on the upper side of the roadheader body. The motor (4) is arranged on the side wall of the body of the roadheader; 所述掘进机的内部还设置有控制电路板和倾角传感器(6),所述控制电路板上集成有微控制器(7);The interior of the roadheader is further provided with a control circuit board and an inclination sensor (6), and a microcontroller (7) is integrated on the control circuit board; 所述水平移动标靶用于接收激光指向仪(1)发出的激光束,所述检测靶(2)具体为由光敏二极管组成的激光捕获电路板;The horizontally moving target is used to receive the laser beam emitted by the laser pointer (1), and the detection target (2) is specifically a laser capture circuit board composed of photodiodes; 所述微控制器(7)通过导线与检测靶(2)的信号输出端相连;The microcontroller (7) is connected to the signal output end of the detection target (2) through a wire; 所述微控制器(7)通过导线与步进电机(4)、倾角传感器(6)相连;The microcontroller (7) is connected with the stepping motor (4) and the inclination sensor (6) through wires; 所述微控制器(7)还通过导线连接有数据存储模块(8);The microcontroller (7) is also connected with a data storage module (8) through wires; 所述微控制器(7)的电源输入端与电源模块(9)相连;The power input end of the microcontroller (7) is connected to the power supply module (9); 所述微控制器(7)使用的芯片为控制芯片U1,所述微控制器(7)的电路结构为:The chip used by the microcontroller (7) is a control chip U1, and the circuit structure of the microcontroller (7) is: 所述控制芯片U1的1脚、9脚、24脚、36脚、48脚接3.3V输入电源;The 1-pin, 9-pin, 24-pin, 36-pin and 48-pin of the control chip U1 are connected to the 3.3V input power supply; 所述控制芯片U1的2脚、3脚、38脚、39脚、45脚、46脚与步进电机(4)的控制端相连;Pins 2, 3, 38, 39, 45 and 46 of the control chip U1 are connected to the control end of the stepping motor (4); 所述控制芯片U1的4脚串接电阻R61和二极管LED1后接地;The 4-pin of the control chip U1 is connected in series with the resistor R61 and the diode LED1 and then grounded; 所述控制芯片U1的5脚并接晶振XT1的一端后与电容C16的一端相连;The 5 feet of the control chip U1 are connected in parallel with one end of the crystal oscillator XT1 and then connected with one end of the capacitor C16; 所述控制芯片U1的6脚并接晶振XT1的另一端后与电容C17的另一端相连,所述电容C17的另一端并接电容C16的另一端、电容C14的一端后接地;Pin 6 of the control chip U1 is connected in parallel with the other end of the crystal oscillator XT1 and then connected with the other end of the capacitor C17, the other end of the capacitor C17 is connected in parallel with the other end of the capacitor C16, and one end of the capacitor C14 is grounded; 所述电容C14的另一端并接电阻R59的一端、控制开关SW1的一端后与控制芯片U1的7脚相连;The other end of the capacitor C14 is connected to one end of the resistor R59 in parallel, and one end of the control switch SW1 is connected to the 7-pin of the control chip U1; 所述电阻R59的另一端接3.3V输入电源,所述控制开关SW1的另一端接地;The other end of the resistor R59 is connected to the 3.3V input power supply, and the other end of the control switch SW1 is grounded; 所述控制芯片U1的10脚至22脚通过多路复用器与检测靶(2)的信号输出端相连;Pins 10 to 22 of the control chip U1 are connected to the signal output end of the detection target (2) through a multiplexer; 所述控制芯片U1的25脚至28脚与数据存储模块(8)相连;Pins 25 to 28 of the control chip U1 are connected to the data storage module (8); 所述控制芯片U1的29脚、30脚、31脚通过485收发器与步进电机(4)的信号输出端相连;Pins 29, 30 and 31 of the control chip U1 are connected to the signal output end of the stepping motor (4) through a 485 transceiver; 所述控制芯片U1的34脚、37脚与倾角传感器(6)的信号输出端相连;Pins 34 and 37 of the control chip U1 are connected to the signal output end of the inclination sensor (6); 所述控制芯片U1的型号为STM32F103CBU6;The model of the control chip U1 is STM32F103CBU6; 所述多路复用器内部使用的芯片型号为74HC4051;The chip model used inside the multiplexer is 74HC4051; 所述485收发器的型号为MAX3485;The model of the 485 transceiver is MAX3485; 所述数据存储模块(8)内部使用的芯片型号为74HC595;The chip model used inside the data storage module (8) is 74HC595; 所述电源模块(9)内部使用的芯片型号为配电开关TPS2552和稳压器RT9013;The chip models used inside the power module (9) are power distribution switch TPS2552 and voltage regulator RT9013; 基于水平移动标靶的掘进机位姿数据测量系统进行测量的方法,包括如下步骤:The method for measuring the position and attitude data measurement system of a roadheader based on a horizontally moving target includes the following steps: 步骤一:将掘进机设置在待掘进巷道中,在掘进机后侧的巷道顶板上安装激光指向仪(1),所述激光指向仪(1)具体设置在巷道顶板的中心线位置,所述激光指向仪(1)的激光发射角度与巷道的掘进方向相一致;Step 1: Set the roadheader in the roadway to be excavated, install a laser pointer (1) on the roadway roof on the rear side of the roadheader, and the laser pointer (1) is specifically set at the centerline position of the roadway roof. The laser emission angle of the laser pointer (1) is consistent with the driving direction of the roadway; 步骤二:在掘进机机身上安装一对水平移动标靶,水平移动标靶的检测靶(2)垂直安装在靶座滑块(3)上,所述靶座滑块(3)安装在掘进机机身上侧设置的滑轨(5)上,所述两个水平移动标靶相互之间平行设置;Step 2: Install a pair of horizontally moving targets on the body of the roadheader, and the detection target (2) of the horizontally moving targets is vertically installed on the target base slider (3), which is installed on the On the slide rail (5) provided on the upper side of the body of the roadheader, the two horizontal moving targets are arranged parallel to each other; 步骤三:控制掘进机开始掘进作业,通过人工调整激光指向仪(1)的安装位置和激光发射角度,使激光指向仪(1)发射的激光束可以打在两个水平移动标靶的检测靶(2)上,所述检测靶(2)通过激光捕获电路板获取到当前激光束打在检测靶(2)上的坐标位置,坐标位置数据包括左右位置(Ax,Bx)和上下位置(Ay,By),检测靶(2)将所述的坐标位置数据通过导线发送至微控制器(7)做进一步处理;Step 3: Control the tunneling machine to start the tunneling operation, and manually adjust the installation position of the laser pointer (1) and the laser emission angle, so that the laser beam emitted by the laser pointer (1) can hit the detection targets of the two horizontally moving targets. (2), the detection target (2) obtains the coordinate position of the current laser beam hitting the detection target (2) through the laser capture circuit board, and the coordinate position data includes the left and right positions (Ax, Bx) and the upper and lower positions (Ay). , By), the detection target (2) sends the coordinate position data to the microcontroller (7) through a wire for further processing; 步骤四:所述倾角传感器(6)同时采集掘进机当前的掘进俯仰角数据(Yaw),倾角传感器(6)将所述的俯仰角数据通过导线发送至微控制器(7)做进一步处理;Step 4: The inclination sensor (6) simultaneously collects the current driving pitch angle data (Yaw) of the roadheader, and the inclination sensor (6) sends the pitch angle data to the microcontroller (7) through a wire for further processing; 步骤五:所述微控制器(7)的计算参数中包括预设的距离参数,其中定义激光指向仪(1)发射激光束到达第一个水平移动标靶的距离为L1,两个水平移动标靶之间的距离为L0,结合接收到的激光坐标数据可以计算并得出当前掘进机的位姿测量数据:Step 5: The calculation parameters of the microcontroller (7) include a preset distance parameter, which defines the distance that the laser pointer (1) emits a laser beam to reach the first horizontally moving target as L1, and the two horizontally moving The distance between the targets is L0. Combined with the received laser coordinate data, the position and attitude measurement data of the current roadheader can be calculated and obtained: 其中俯仰角(Yaw)的计算公式为:The formula for calculating the pitch angle (Yaw) is:
Figure 408825DEST_PATH_IMAGE001
Figure 408825DEST_PATH_IMAGE001
;
航向角(Pitch)的计算公式为:The calculation formula of the heading angle (Pitch) is:
Figure 60386DEST_PATH_IMAGE002
Figure 60386DEST_PATH_IMAGE002
;
翻滚角(Roll)数据即为倾角传感器(6)的测量数据;The roll angle (Roll) data is the measurement data of the tilt sensor (6); 水平位移(dx)的计算公式为:The formula for calculating the horizontal displacement (dx) is:
Figure 433599DEST_PATH_IMAGE003
Figure 433599DEST_PATH_IMAGE003
;
高度位移(dy)的计算公式为:The formula for calculating height displacement (dy) is:
Figure 297650DEST_PATH_IMAGE004
Figure 297650DEST_PATH_IMAGE004
;
深度位移(dz)的计算公式为:The formula for calculating depth displacement (dz) is:
Figure 705497DEST_PATH_IMAGE005
Figure 705497DEST_PATH_IMAGE005
;
在上式的坐标系中,定义X轴为巷道掘进面的宽度,Y轴为巷道掘进面的高度,Z轴为巷道掘进方向的深度;In the coordinate system of the above formula, it is defined that the X axis is the width of the roadway excavation surface, the Y axis is the height of the roadway excavation surface, and the Z axis is the depth of the roadway excavation direction; 上述Ax和Bx分别是激光束打在第一个和第二个水平移动标靶上的点所在位置的x坐标;The above Ax and Bx are the x-coordinates of the positions where the laser beam hits the first and second horizontally moving targets respectively; 上述Ay和By分别是激光束打在第一个和第二个水平移动标靶上的点所在位置的y坐标。The above Ay and By are the y-coordinates of the positions where the laser beam hits the first and second horizontally moving targets, respectively.
CN202010086857.5A 2020-02-11 2020-02-11 Position and attitude data measuring system and method for development machine Active CN111156975B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010086857.5A CN111156975B (en) 2020-02-11 2020-02-11 Position and attitude data measuring system and method for development machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010086857.5A CN111156975B (en) 2020-02-11 2020-02-11 Position and attitude data measuring system and method for development machine

Publications (2)

Publication Number Publication Date
CN111156975A CN111156975A (en) 2020-05-15
CN111156975B true CN111156975B (en) 2022-03-29

Family

ID=70565474

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010086857.5A Active CN111156975B (en) 2020-02-11 2020-02-11 Position and attitude data measuring system and method for development machine

Country Status (1)

Country Link
CN (1) CN111156975B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112050732B (en) * 2020-08-21 2022-03-15 西安科技大学 Method and system for automatically detecting spatial pose of cantilever type heading machine
CN114322956A (en) * 2022-01-05 2022-04-12 山西潞安集团余吾煤业有限责任公司 Tunnel excavation laser pointing measurement system and measurement method
CN117804341B (en) * 2024-01-03 2024-08-02 山西易联智控科技有限公司 Heading machine pose measuring device and method based on laser positioning

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6016455A (en) * 1997-11-10 2000-01-18 Kabushiki Kaisha Topcon Automatic control system for construction machinery
CN101629807A (en) * 2009-08-20 2010-01-20 中国矿业大学(北京) Position and attitude parameter measurement system of machine body of boring machine and method thereof
CN102589514A (en) * 2011-01-15 2012-07-18 毛君 Heading machine pose parameter measuring device and method thereof
CN102878976A (en) * 2012-09-26 2013-01-16 三一重型装备有限公司 Heading machine position and posture detecting system and heading machine
CN110700840A (en) * 2019-10-21 2020-01-17 北京易联创安科技发展有限公司 Heading machine pose measuring device based on laser target positioning and measuring method thereof

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6016455A (en) * 1997-11-10 2000-01-18 Kabushiki Kaisha Topcon Automatic control system for construction machinery
CN101629807A (en) * 2009-08-20 2010-01-20 中国矿业大学(北京) Position and attitude parameter measurement system of machine body of boring machine and method thereof
CN102589514A (en) * 2011-01-15 2012-07-18 毛君 Heading machine pose parameter measuring device and method thereof
CN102878976A (en) * 2012-09-26 2013-01-16 三一重型装备有限公司 Heading machine position and posture detecting system and heading machine
CN110700840A (en) * 2019-10-21 2020-01-17 北京易联创安科技发展有限公司 Heading machine pose measuring device based on laser target positioning and measuring method thereof

Also Published As

Publication number Publication date
CN111156975A (en) 2020-05-15

Similar Documents

Publication Publication Date Title
CN111156976B (en) Position and attitude data measuring system and method for development machine
CN111156975B (en) Position and attitude data measuring system and method for development machine
CN110700839B (en) Heading machine pose measuring device based on laser scanner and measuring method thereof
CN111380522B (en) Navigation positioning and automatic cutting method of cantilever type tunneling machine
CN102322857B (en) Position and posture measuring system and method for mechanical equipment
CN101629807B (en) Position and attitude parameter measurement system of machine body of boring machine and method thereof
CN104536008B (en) A Laser Range Measurement and Positioning Method for Blasting Hole of Rock Drilling Rig
CN109882221B (en) Automatic positioning system and method for anchor rod drilling machine of excavating and supporting combined unit
CN109974715B (en) Tunneling machine autonomous navigation system and method combining strapdown inertial navigation and light spot identification
CN104776843A (en) Boom-type roadheader body and cutting head pose detection method
CN111412911A (en) Multi-sensor combined navigation system of coal mine underground continuous coal mining robot
CN111156974B (en) Heading machine pose measurement system based on laser target
CN108398955B (en) A system and method for attitude control of roadheader
CN111878173B (en) Automatic positioning device for rock roadway blasting blast holes
CN112068543B (en) Accurate positioning method for drilling of coal mine drilling and anchoring robot based on vision calibration
CN201031704Y (en) Tunnel wireless laser stakeout device
CN112012759A (en) A tunnelling is equipped with navigation positioning system for coal mine tunnel
CN112278011B (en) Robotic device and comprehensive detection method for crane rails
CN117470127B (en) Unmanned aerial vehicle building wall surface detection system and method based on coordinate correction
CN112114327A (en) Coal mine tunnel drilling and anchoring robot precise positioning method and system based on multi-sensor fusion
CN113970329A (en) Strapdown inertial navigation and laser sensing combined heading machine pose detection system and method
CN102829727B (en) Line structured light based device and line structured light based method for automatic detection of level difference of cutting head of boom-type roadheader
CN209523764U (en) A kind of anchor combined unit jumbolter automatic station-keeping system of pick branch
JPH07173987A (en) Method for displaying hole position on tunnel face and hole position display system used therefor
JP2001248376A (en) Device for setting reference position and direction of drill

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
GR01 Patent grant
GR01 Patent grant