CN110926406B - Initial orientation method for hole-exploring robot - Google Patents
Initial orientation method for hole-exploring robot Download PDFInfo
- Publication number
- CN110926406B CN110926406B CN201911298858.XA CN201911298858A CN110926406B CN 110926406 B CN110926406 B CN 110926406B CN 201911298858 A CN201911298858 A CN 201911298858A CN 110926406 B CN110926406 B CN 110926406B
- Authority
- CN
- China
- Prior art keywords
- robot
- exploring
- hole
- point
- initial orientation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000005259 measurement Methods 0.000 claims abstract description 26
- 238000010276 construction Methods 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 abstract description 3
- 238000012423 maintenance Methods 0.000 abstract description 2
- 230000000052 comparative effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- VCMMXZQDRFWYSE-UHFFFAOYSA-N plumbagin Chemical compound C1=CC=C2C(=O)C(C)=CC(=O)C2=C1O VCMMXZQDRFWYSE-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/40—Correcting position, velocity or attitude
- G01S19/41—Differential correction, e.g. DGPS [differential GPS]
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manipulator (AREA)
- Geophysics And Detection Of Objects (AREA)
Abstract
The invention discloses a method for initially positioning a hole-exploring robot, which comprises the following steps: acquiring a fixed point on an axis in the robot; acquiring at least one measuring point on an axis in the robot; calculating the azimuth angle alphan(ii) a Calculating initial positioning direction angle of hole-exploring robot
The method for obtaining the initial positioning direction angle of the tunnel-exploring robot by carrying out weighted average on the base length and the PDOP value can effectively weaken the influence of RTK measurement errors on the positioning accuracy, obtain the initial positioning direction angle of the tunnel-exploring robot with high accuracy, improve the effectiveness of the whole detection process, and facilitate the guidance of actual working conditions such as construction, maintenance and the like.
Description
Technical Field
The invention relates to the field of surveying and mapping, in particular to an initial orientation method of a hole-exploring robot.
Background
When the exploratory hole robot is used for exploration, the coordinates and the azimuth angle of the robot in the plane coordinates need to be confirmed firstly, the coordinate measurement can be carried out at the center position of the robot by using RTK (carrier-phase differential technology), and the error is negligible relative to the exploration distance. But the initial azimuth of the robot has a large influence on the overall detection result.
Due to the actual situation at the project site, it is common to measure two points P (x) on the axis of the robot using RTK1,y1) And Q (x)2,y2) By the expression
An initial azimuth angle may be calculated.
However, because RTK has a measurement error, an error also exists in the calculated initial azimuth angle, and the initial orientation accuracy of the exploratory hole robot is not high.
Therefore, the technology for designing the initial orientation of the high-precision tunnel-exploring robot is of great significance.
Disclosure of Invention
In order to reduce the measurement error of an initial azimuth angle as much as possible and improve the initial orientation precision of the tunnel-exploring robot, the invention provides an initial orientation method of the tunnel-exploring robot, and the specific technical scheme is as follows:
a method for initially orienting a hole-exploring robot comprises the following steps:
obtaining a fixed point P on the axis of the robot0The coordinate is (x)0,y0)；
Acquiring at least one measuring point P on the axis of the robotiThe coordinate is (x)i,yi) Wherein i is a natural number which is greater than or equal to 2 and less than or equal to n, and n is the number of the measuring points;
calculating the azimuth angle alpha by adopting the expression 3)i：
Obtaining the initial positioning direction angle of the hole-exploring robot by adopting an expression 4)
Wherein: PDOPiFor the ith measurement point PiThe strength and the weakness of the position precision during measurement are generally obtained by the square sum of errors such as latitude, longitude and elevation and the like; l isiFor the ith measurement point PiTo a fixed point P0Base length of (i.e. measuring point P)iTo a fixed point P0The distance of (d); alpha is alphaiIs composed of the ith measuring point PiThe calculated azimuth angle.
Preferably, in the above technical solution, the measurement point PiThe number of (B) is 3 to 50, preferably 3 to 15, and further preferably 3 to 10. The number of measuring points is too small, and the larger the measuring error is, the lower the precision is; too many measurement numbers, too many repeated measurement points and long calculation time.
Preferably, in the above technical solution, the plane error of the measuring point is in centimeter level.
Preferably, in the above technical solution, the PDOP data is obtained from an RTK handbook, and the value range thereof is 0.5 to 99.9, preferably 1 to 50.
The method for obtaining the initial positioning direction angle of the hole-exploring robot by carrying out weighted average on the base length and the PDOP value
The influence of RTK measurement errors on the orientation precision can be effectively weakened, the initial positioning direction angle of the tunnel-exploring robot with high precision is obtained, the effectiveness of the whole detection process is improved, and the guidance of actual working conditions such as construction and maintenance is facilitated.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this application, are included to provide a further understanding of the invention, and are incorporated in and constitute a part of this specification. In the drawings:
FIG. 1 is a schematic view of a robot orientation in an embodiment of the present invention;
fig. 2 is a schematic diagram of an analysis of orientation errors due to RTK measurement errors in the prior art.
Detailed Description
Embodiments of the present patent are described in detail below with reference to the drawings, but the present patent can be implemented in many different ways as defined and covered by the claims.
Comparative example:
comparative examples RTK measurements using the prior art, details are as follows:
two points P (x) on the axis of the RTK measuring robot are adopted1,y1) And Q (x)2,y2) Calculating an initial azimuth angle by expression 1):
due to the measurement error of RTK, as can be seen from fig. 2, the maximum angular deviation β of the initial orientation can be calculated by expression 2):
wherein R is the positioning error of RTK, L is P0With other measuring points PnThe distance between them.
When R is 4cm and L is 80cm, there are:
Example (b):
the embodiment discloses a method for initially orienting a hole-exploring robot, which comprises the following steps:
firstly, acquiring a fixed point P on an axis in the robot0The coordinate is (x)0,y0) See table 1 for details.
Secondly, at least one measuring point P on the central axis of the robot is obtainediThe coordinate is (x)i,yi) Wherein i is a natural number greater than or equal to 2 and less than or equal to n, and n is the total number of measurement points;
preferred measurement points PiThe number of the measuring points is 3-50, 4 are selected in the embodiment, the detailed figure 1 shows, and the plane error of the measuring points is preferably in centimeter level, and the plane measuring error is preferably 4 cm.
Thirdly, calculating the azimuth angle alpha by adopting the expression 3)i：
The data are detailed in table 1.
Fourthly, obtaining the initial positioning direction angle of the hole-exploring robot by adopting an expression 4)
Wherein: PDOPiFor the ith measurement point PiThe strength of position precision during measurement; l isiFor the ith measurement point PiTo a fixed point P0Base length of (i.e. measuring point P)iTo a fixed point P0The distance of (d); alpha is alphaiIs composed of the ith measuring point PiThe calculated azimuth angle.
TABLE 1 parameter table in the course of actually measuring the initial orientation angle of the exploratory tunnel robot
The true azimuth angle is set to 45 DEG, and the fixed point P0Measurement point PiCoordinate of (a), initial orientation azimuth alpha of the exploratory tunnel robot calculated by the prior art (comparative example) and initial orientation azimuth alpha of the exploratory tunnel robot calculated by the scheme (embodiment) of the invention
As in table 1. The general measuring path is from the initial end to the end, the fixed point P0At the initial end, measuring point PiLocated on the path from the initial end to the final end.
As can be seen from Table 1, the method of the invention, combined with the baseline length and the PDOP value to perform the weighted average acquisition method to obtain the initial positioning direction angle of the tunnel-exploring robot which is closer to the true angle, can effectively weaken the influence of the RTK measurement error on the positioning accuracy, obviously reduce the initial positioning azimuth error, can obtain the initial positioning direction angle of the tunnel-exploring robot with high accuracy, and is convenient for guiding the construction.
The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (6)
1. A method for initially orienting a hole-exploring robot is characterized by comprising the following steps:
obtaining a fixed point P on the axis of the robot0The coordinate is (x)0,y0)；
Acquiring at least one measuring point P on the axis of the robotiThe coordinate is (x)i,yi) Wherein i is a natural number greater than or equal to 2 and less than or equal to n, and n is the total number of the measurement points;
calculating the azimuth angle alpha by adopting the expression 3)i：
Obtaining the initial positioning direction angle of the hole-exploring robot by adopting an expression 4)
Wherein: PDOPiFor the ith measurement point PiThe strength of the position precision during measurement; l isiFor the ith measurement point PiTo a fixed point P0Base length of (i.e. measuring point P)iTo a fixed point P0The distance of (d); alpha is alphaiIs composed of the ith measuring point PiThe calculated azimuth angle.
2. The method of initial orientation of a cave-exploring robot of claim 1, wherein: measurement point PiThe number of (2) is 3-50.
3. The method of initial orientation of a cave-exploring robot of claim 2, wherein: measuring pointPiThe number of (2) is 3-15.
4. The method of initial orientation of a cave-exploring robot of claim 2, wherein: the plane error of the measuring point is in centimeter level.
5. A method of initial orientation of a exploratory hole robot as claimed in any one of claims 1-3, wherein: the PDOP data is obtained through an RTK handbook, and the value range of the PDOP data is 0.5-99.9.
6. The method of initial orientation of a cave-exploring robot of claim 5, wherein: the PDOPiThe value range of (A) is 1 to 50.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911298858.XA CN110926406B (en) | 2019-12-17 | 2019-12-17 | Initial orientation method for hole-exploring robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911298858.XA CN110926406B (en) | 2019-12-17 | 2019-12-17 | Initial orientation method for hole-exploring robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110926406A CN110926406A (en) | 2020-03-27 |
| CN110926406B true CN110926406B (en) | 2021-11-09 |
Family
ID=69862821
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911298858.XA Active CN110926406B (en) | 2019-12-17 | 2019-12-17 | Initial orientation method for hole-exploring robot |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110926406B (en) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5512904A (en) * | 1994-06-13 | 1996-04-30 | Andrew Corporation | Method and apparatus of establishing a vehicle azimuth |
| JPH1195837A (en) * | 1997-09-19 | 1999-04-09 | Sumitomo Heavy Ind Ltd | Method for determining initial truck position and attitude angle of gyro guide type automated guided vehicle, and method for improving travel stability at position correction |
| CN101846734A (en) * | 2009-03-26 | 2010-09-29 | 中国农业大学 | Agricultural machinery navigation and position method and system and agricultural machinery industrial personal computer |
| CN102278970A (en) * | 2011-06-14 | 2011-12-14 | 北京林业大学 | Technique for monitoring positioning and deformation based on angular distance difference of total station |
| CN107655485A (en) * | 2017-09-25 | 2018-02-02 | 北京理工大学 | A kind of cruise section independent navigation position deviation modification method |
| CN108680183A (en) * | 2018-03-29 | 2018-10-19 | 中国有色金属长沙勘察设计研究院有限公司 | A kind of appraisal procedure of navigation and positioning accuracy |
| CN108802788A (en) * | 2018-04-10 | 2018-11-13 | 拓攻（南京）机器人有限公司 | A kind of determination method, apparatus, equipment and the storage medium of course deviation |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8843290B2 (en) * | 2010-07-22 | 2014-09-23 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
-
2019
- 2019-12-17 CN CN201911298858.XA patent/CN110926406B/en active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5512904A (en) * | 1994-06-13 | 1996-04-30 | Andrew Corporation | Method and apparatus of establishing a vehicle azimuth |
| JPH1195837A (en) * | 1997-09-19 | 1999-04-09 | Sumitomo Heavy Ind Ltd | Method for determining initial truck position and attitude angle of gyro guide type automated guided vehicle, and method for improving travel stability at position correction |
| CN101846734A (en) * | 2009-03-26 | 2010-09-29 | 中国农业大学 | Agricultural machinery navigation and position method and system and agricultural machinery industrial personal computer |
| CN102278970A (en) * | 2011-06-14 | 2011-12-14 | 北京林业大学 | Technique for monitoring positioning and deformation based on angular distance difference of total station |
| CN107655485A (en) * | 2017-09-25 | 2018-02-02 | 北京理工大学 | A kind of cruise section independent navigation position deviation modification method |
| CN108680183A (en) * | 2018-03-29 | 2018-10-19 | 中国有色金属长沙勘察设计研究院有限公司 | A kind of appraisal procedure of navigation and positioning accuracy |
| CN108802788A (en) * | 2018-04-10 | 2018-11-13 | 拓攻（南京）机器人有限公司 | A kind of determination method, apparatus, equipment and the storage medium of course deviation |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110926406A (en) | 2020-03-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110196016B (en) | A system for measuring the position and orientation of an assembly machine segment and a method of using the same | |
| CN106643613B (en) | A kind of location error scaling method in aspherical detection in place | |
| CN108413988A (en) | Robot end's theodolite coordinate system quick calibrating method | |
| CN105388494B (en) | A laser ranging and positioning method applied to RTK receiver | |
| CN115127588B (en) | A dynamic calibration method for local datum of a ship | |
| CN103759743B (en) | When inertial measuring unit azimuth reference transfer device and high inclination-angle, orientation determines method | |
| CN104483891A (en) | Method for improving machine tool space movement precision | |
| CN104408320A (en) | Method for determining center deviation of circular cylinder building structure by plane coordinate method | |
| EP3524931A1 (en) | Method for verifying accuracy of rtk tilt compensation measurement | |
| CN105973212A (en) | Ship body measurement auxiliary tool and measurement method | |
| CN108775899B (en) | Deep mining well up-down coordinate system connection method based on pseudolite and inertia information | |
| CN107436138A (en) | A kind of tunnel deformation automatic monitoring method | |
| CN110275139A (en) | An ultra-short baseline positioning system and method based on rotating primitive multiplexing | |
| CN110926406B (en) | Initial orientation method for hole-exploring robot | |
| CN113405570B (en) | A method for measuring the alignment error of a total station | |
| CN111076705A (en) | Method for optimizing triangulation elevation measurement by using total station | |
| CN111947648B (en) | A Correction Method for Pointing Error of Two-Axis Rotary System with Zenith Blind Area | |
| CN219736337U (en) | Portable height detection device | |
| Milovzorov et al. | Angular installation options errors correction for three-component vector-measuring transducers with accelerometer at calibration phase | |
| CN104792339B (en) | The calibration method of optic fiber gyroscope inclinometer | |
| CN216049921U (en) | High-precision large-water-depth underwater engineering positioning system | |
| CN106767677B (en) | A kind of measurement method examined for microwave guidance device orientation angle | |
| CN105926663B (en) | Positioning and mounting method for annular foundation bolt group | |
| CN104330078A (en) | A joint measurement method based on three-point resection model | |
| CN109581454B (en) | Dual-combination locator measuring method |
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 |