CN117570972A - Vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint - Google Patents
Vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint Download PDFInfo
- Publication number
- CN117570972A CN117570972A CN202311550029.2A CN202311550029A CN117570972A CN 117570972 A CN117570972 A CN 117570972A CN 202311550029 A CN202311550029 A CN 202311550029A CN 117570972 A CN117570972 A CN 117570972A
- Authority
- CN
- China
- Prior art keywords
- data
- pos
- rtk
- optimization
- point cloud
- 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.)
- Granted
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 50
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000012937 correction Methods 0.000 claims abstract description 126
- 238000005457 optimization Methods 0.000 claims abstract description 95
- 238000001914 filtration Methods 0.000 claims description 50
- 238000012545 processing Methods 0.000 abstract description 4
- CLOMYZFHNHFSIQ-UHFFFAOYSA-N clonixin Chemical compound CC1=C(Cl)C=CC=C1NC1=NC=CC=C1C(O)=O CLOMYZFHNHFSIQ-UHFFFAOYSA-N 0.000 description 10
- 238000004364 calculation method Methods 0.000 description 6
- 238000011156 evaluation Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- 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/42—Determining position
- G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
The invention relates to the technical field of point cloud data processing, in particular to a vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint. Acquiring RTK data, POS data and original point cloud data through a vehicle-mounted mobile measurement system, and sequentially carrying out RTK correction on the POS data by using the RTK data to acquire first POS optimization data; correcting the control point of the first POS optimization data by using an external control point to obtain second POS optimization data; and correcting the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data. Thus, through three times of precision correction, the precision of POS data is greatly improved, and the centimeter-level requirements of actual demands are met.
Description
Technical Field
The invention relates to the technical field of point cloud data processing, in particular to a vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint.
Background
The vehicle-mounted mobile measurement system can rapidly acquire three-dimensional point cloud and image information of roads and surrounding environments, is a brand-new high-resolution earth observation technical means, and is widely applied to the aspects of novel basic mapping, digital city construction, automatic driving high-precision map production and the like. However, in practical engineering application of the vehicle-mounted mobile measurement system, the accuracy of the point cloud data is difficult to meet the requirements of centimeter level, and even reach decimeter level or meter level in a signal unlocking area, and the practical requirements are difficult to meet due to the comprehensive influence of factors such as positioning error of a global satellite navigation positioning system, attitude determination error of an inertial navigation system, distance measurement and angle measurement error of a scanner, time synchronization and calibration error of a sensor, data calculation error and the like.
In the prior art, point cloud data is generally utilized to correct POS data, for example, in the patent "laser point cloud adjustment method combining point cloud matching and sensor data" (publication No. CN 115752448A), an adjustment equation is listed according to the combination of an unmanned plane LiDAR positioning principle formula and original LiDAR information of an approximate homonymy point pair, and then a sensor parameter correction value is calculated by least square solution, so as to correct the point cloud original POS data. Such a method has limited precision improvement of the point cloud data, and further methods for improving the precision are needed.
Disclosure of Invention
Aiming at the defects in the prior art, the invention provides a vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint, which greatly improve the precision of point cloud data so as to meet the actual demands.
In a first aspect, the invention provides a vehicle-mounted mobile measurement point cloud precision improving method based on multi-condition constraint.
In a first implementation manner, a vehicle-mounted mobile measurement point cloud precision improving method based on multi-condition constraint comprises the following steps:
acquiring vehicle-mounted mobile measurement data; the vehicle-mounted mobile measurement data comprise RTK data, POS data and original point cloud data;
RTK correction is carried out on the POS data by using the RTK data, so that first POS optimization data are obtained;
correcting the control point of the first POS optimization data by using an external control point to obtain second POS optimization data;
and correcting the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data.
With reference to the first implementation manner, in a second implementation manner, acquiring vehicle-mounted mobile measurement data includes:
acquiring initial acquisition data of a vehicle-mounted mobile measurement system; the initial acquisition data comprises RTK data, laser ranging data, IMU data and GNSS data;
generating POS data according to the IMU data and the GNSS data;
and generating an original point cloud according to the POS data and the laser ranging data.
With reference to the first implementation manner, in a third implementation manner, performing RTK correction on POS data using the RTK data to obtain first POS optimization data, including:
filtering the RTK data by using the POS data to obtain RTK filtering data;
acquiring RTK control points according to the RTK filtering data;
and carrying out RTK correction on the POS data according to the RTK control point to obtain first POS optimization data.
With reference to the third implementation manner, in a fourth implementation manner, filtering the RTK data with the POS data to obtain RTK filtered data includes:
searching POS data at the same acquisition time as each RTK data;
subtracting the POS data and the RTK data at the same acquisition time to obtain an original offset;
taking a preset time interval before and after the RTK data acquisition time as a sliding window, and performing window sliding on the RTK data to obtain a plane filtering weight and an elevation filtering weight;
carrying out weighted filtering treatment on the original offset according to the plane filtering weight and the elevation filtering weight to obtain a filtering offset;
and correcting the RTK data according to the filtering offset to obtain RTK filtering data.
With reference to the fourth implementation manner, in a fifth implementation manner, performing RTK correction on POS data according to an RTK control point to obtain first POS optimization data, including:
if the RTK control point with the same acquisition time as the POS data exists, acquiring a coordinate correction value of the POS data by adopting a first RTK correction formula; if the RTK control point with the same acquisition time as the POS data does not exist, acquiring a coordinate correction value of the POS data by adopting a second RTK correction formula;
and correcting the POS data by using the coordinate correction value to obtain first POS optimization data.
In combination with the first implementation manner, in a sixth implementation manner, performing control point correction on the first POS optimization data by using an external control point to obtain second POS optimization data, including:
determining a plurality of external control points;
determining point cloud data points and POS data corresponding to external control points;
acquiring a first forward correction value, a first transverse correction value and a first Gao Chengjiu positive value of POS data according to the external control point and the corresponding point cloud data point;
acquiring a first correction value of the POS data in X, Y and Z directions according to the first forward correction value, the first transverse correction value and the first elevation correction value;
and correcting the POS data according to the first correction values of the POS data in the X, Y and Z directions to obtain second POS optimization data.
With reference to the sixth implementation manner, in a seventh implementation manner, acquiring the first forward correction value of the POS data includes:
acquiring XY plane offset between an advance control point and a corresponding point cloud data point;
acquiring the forward projection quantity of the XY plane offset in the forward direction;
and acquiring a first forward correction value according to the forward projection quantity.
With reference to the seventh implementation manner, in an eighth implementation manner, the obtaining a first forward correction value according to the forward projection amount includes:
in the above, TP i For POS data POS i Collecting time; TC (TC) s 、TC e Respectively collecting moments of a starting forward control point and an ending forward control point; ΔTC ext For forward correction of the epitaxial time range, generally 30s are taken; ΔDC_J s 、ΔDC_J e Respectively a pair of a start forward control point and an end forward control pointPOS correction value at the moment; ΔTC is For TP i With TC s A time interval therebetween; ΔTC ei For TC e With TP i A time interval therebetween; ΔDC_J 12 Representation when TP i Acquisition time TC located at two adjacent forward control points 1 With TC 2 A first forward correction value in between.
In combination with the first implementation manner, in a ninth implementation manner, performing feature point correction on the second POS optimization data according to the original point cloud data to obtain final POS optimization data, including:
extracting characteristic points of the point cloud data to obtain homonymous characteristic points;
dividing the homonymous feature points into forward feature points, transverse feature points and elevation feature points according to the spatial features;
obtaining the plane precision standard deviation of the forward characteristic points and the transverse characteristic points, and obtaining the elevation precision standard deviation of the elevation characteristic points;
acquiring X coordinates, Y coordinates and Z coordinates of the feature points according to the plane precision standard deviation and the elevation precision standard deviation;
and correcting the second POS optimization data according to the X coordinate, the Y coordinate and the Z coordinate of the feature point to obtain final POS optimization data.
In a first aspect, the invention provides a vehicle-mounted mobile measurement point cloud precision improving device based on multi-condition constraint.
In a tenth implementation manner, a vehicle-mounted mobile measurement point cloud precision improving device based on multi-condition constraint includes:
the vehicle-mounted mobile measurement data acquisition module is configured to acquire vehicle-mounted mobile measurement data; the vehicle-mounted mobile measurement data comprise RTK data, POS data and original point cloud data;
the first POS optimization data acquisition module is configured to carry out RTK correction on POS data by using the RTK data to acquire first POS optimization data;
the second POS optimization data acquisition module is configured to correct the control point of the first POS optimization data by utilizing an external control point to acquire second POS optimization data;
and the final POS optimization data acquisition module is configured to correct the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data.
According to the technical scheme, the beneficial technical effects of the invention are as follows:
1. acquiring RTK data, POS data and original point cloud data through a vehicle-mounted mobile measurement system, and sequentially carrying out RTK correction on the POS data by using the RTK data to acquire first POS optimization data; correcting the control point of the first POS optimization data by using an external control point to obtain second POS optimization data; and correcting the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data. Thus, through three times of precision correction, the precision of POS data is greatly improved, and the centimeter-level requirements of actual demands are met.
2. RTK (Real time kinematic, carrier phase difference technology) data are synchronously acquired in the scanning process of the vehicle-mounted mobile measurement system, RTK data are filtered by utilizing the characteristic that POS data are relatively high in precision in a short time, the precision of the RTK data is improved, and then the filtered RTK data, high-precision external control points and homonymous characteristic points extracted from original point cloud data are sequentially utilized to correct the POS data, so that the point cloud data precision is greatly improved.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below. Like elements or portions are generally identified by like reference numerals throughout the several figures. In the drawings, elements or portions thereof are not necessarily drawn to scale.
Fig. 1 is a schematic diagram of a vehicle-mounted mobile measurement point cloud precision improving method based on multi-condition constraint provided in this embodiment;
fig. 2 is a flowchart of a vehicle-mounted mobile measurement point cloud precision improving method based on multi-condition constraint provided in this embodiment;
fig. 3 is a schematic structural diagram of a vehicle-mounted mobile measurement point cloud precision lifting device based on multi-condition constraint according to the present embodiment.
Detailed Description
Embodiments of the technical scheme of the present invention will be described in detail below with reference to the accompanying drawings. The following examples are only for more clearly illustrating the technical aspects of the present invention, and thus are merely examples, and are not intended to limit the scope of the present invention.
It is noted that unless otherwise indicated, technical or scientific terms used herein should be given the ordinary meaning as understood by one of ordinary skill in the art to which this invention pertains. The terms first, second and the like in the description and in the claims of the embodiments of the disclosure and in the above-described figures are used for distinguishing between similar objects and not necessarily for describing a particular sequential or chronological order. It is to be understood that the data so used may be interchanged where appropriate in order to implement the embodiments of the disclosure described herein. Furthermore, the terms "comprise" and "have," as well as any variations thereof, are intended to cover a non-exclusive inclusion. The term "plurality" means two or more, unless otherwise indicated. In the embodiment of the present disclosure, the character "/" indicates that the front and rear objects are an or relationship. For example, A/B represents: a or B. The term "and/or" is an associative relationship that describes an object, meaning that there may be three relationships. For example, a and/or B, represent: a or B, or, A and B. The term "corresponding" may refer to an association or binding relationship, and the correspondence between a and B refers to an association or binding relationship between a and B.
Referring to fig. 1, this embodiment provides a vehicle-mounted mobile measurement point cloud precision improving method based on multi-condition constraint, including:
acquiring vehicle-mounted mobile measurement data; the vehicle-mounted mobile measurement data comprise RTK data, POS data and original point cloud data;
RTK correction is carried out on the POS data by using the RTK data, so that first POS optimization data are obtained;
correcting the control point of the first POS optimization data by using an external control point to obtain second POS optimization data;
and correcting the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data.
Optionally, acquiring the vehicle-mounted mobile measurement data includes: acquiring initial acquisition data of a vehicle-mounted mobile measurement system; the initial acquisition data comprises RTK data, laser ranging data, IMU data and GNSS data; generating POS data according to the IMU data and the GNSS data; and generating an original point cloud according to the POS data and the laser ranging data.
In some embodiments, POS (position and attitude system, position and orientation system) data is generated by resolving IMU (Inertial Measurement Unit ) data and GNSS data, the POS data content comprising: time T, three-dimensional coordinates (X, Y, Z), heading angle, pitch angle, roll angle. And generating an original point cloud by carrying out point cloud calculation on the POS data and the laser ranging data.
Optionally, the initial acquisition data also includes odometry data, and the like.
Optionally, the vehicle-mounted mobile measurement system is integrated with an RTK device, during operation, RTK data are synchronously collected, the collection frequency is 1Hz-10Hz, and the RTK data include: time T, three-dimensional coordinates (X, Y, Z), in-plane error HRMS, gao Chengzhong error VRMS. Because the coordinate data measured by the RTK is the antenna phase center coordinate, the RTK coordinate data is required to be converted into a system center according to the parameters of the vehicle-mounted mobile measurement system.
Optionally, performing RTK correction on the POS data using the RTK data to obtain first POS optimization data, including: filtering the RTK data by using the POS data to obtain RTK filtering data; acquiring RTK control points according to the RTK filtering data; and carrying out RTK correction on the POS data according to the RTK control point to obtain first POS optimization data.
Optionally, filtering the RTK data with the POS data to obtain RTK filtered data, including: searching POS data at the same acquisition time as each RTK data; subtracting the POS data and the RTK data at the same acquisition time to obtain an original offset; taking a preset time interval before and after the RTK data acquisition time as a sliding window, and performing window sliding on the RTK data to obtain a plane filtering weight and an elevation filtering weight; carrying out weighted filtering treatment on the original offset according to the plane filtering weight and the elevation filtering weight to obtain a filtering offset; and correcting the RTK data according to the filtering offset to obtain RTK filtering data.
In some embodiments, the specific step of filtering the RTK data with POS data includes: (1) based on each RTK data RTK i Corresponding POS data POS is searched for at the acquisition moment of (a) i The original offset DeltaR is calculated according to the formula (1) i The method comprises the steps of carrying out a first treatment on the surface of the (2) With data RTK i Delta T is taken before and after the acquisition time w The time interval is used as a sliding window, RTK data is processed by the sliding window, and the offset is weighted and filtered according to the formula (2) and the formula (3) to obtain the filtered offset(3) With filtered offset->Correcting the RTK data according to formula (4) to obtain filtered RTK data +.>Because the RTK data has random errors and the accuracy of the POS data in a short time is very high, the accuracy of the RTK data is improved by performing sliding window filtering processing on the RTK data through the POS data in the short time.
Optionally, subtracting the RTK data from POS data at the same acquisition time to obtain an original offset, including:
in the above formula, deltaR i To acquire the original offset at time i, POS i To acquire POS data at time i, RTK i To acquire RTK data for time i.
Optionally, the plane filtering weights and the elevation filtering weights are obtained by the following formula:
in the above formula, HW ij Represents DeltaR j For DeltaR i Plane filtering weights of (a); VW (VW) ij Represents DeltaR j For DeltaR i Is the elevation filtering weight of (1), n is RTK i The total number of data corresponding to the window; deltaR j Representing data RTK j Is the original offset of (1); deltaR i Representing data RTK i Is the original offset of (1); delta T ij For the time interval between data j and data i, deltaT w HW 'is half the total time interval of the sliding window' ik For the plane intermediate weight value, VW' ik Is an elevation intermediate weight value; HRMS (high-resolution ms) j 、VRMS j Respectively data RTK j And Gao Chengzhong errors.
Optionally, a planar intermediate weight value HW' ik And an intermediate weight VW 'for elevation' ik Obtained by calculation by the following formula:
in the above formula, deltaT ik HRMS for the time interval between data k and data i k 、VRMS k Respectively data RTK k And Gao Chengzhong errors.
Optionally, performing weighted filtering processing on the original offset according to the plane filtering weight and the elevation filtering weight, including:
in the above formula, n is RTK i The total number of data corresponding to the window; deltaR j Representing data RTK j Is the original offset of (1); deltaR' i For filtering the offset.
Optionally, correcting the RTK data according to the filtering offset to obtain RTK filtered data, including:
in the above formula, RTK i For acquisition of RTK data at time i, ΔR' i To acquire the filtered offset at time i, RTK' i The data is filtered for the RTK at acquisition time i.
Optionally, acquiring the RTK control point according to the RTK filtered data includes: segmenting RTK filtered data according to a preset distance to obtain a plurality of RTK filtered data segments; from each RTK filtering data segment, selecting an RTK data point with optimal plane precision as an RTK plane control point, and selecting an RTK data point with optimal elevation precision as an RTK elevation control point.
In some embodiments, the predetermined distance is 50m, and the RTK filtered data is segmented at 50 meters intervals.
Optionally, performing RTK correction on the POS data according to the RTK control point to obtain first POS optimization data, including: if the RTK control point with the same acquisition time as the POS data exists, acquiring a coordinate correction value of the POS data by adopting a first RTK correction formula; if the RTK control point with the same acquisition time as the POS data does not exist, acquiring a coordinate correction value of the POS data by adopting a second RTK correction formula; and correcting the POS data by using the coordinate correction value to obtain first POS optimization data.
Optionally, the first RTK correction formula includes Δpr i =RTK′ i -POS i The method comprises the steps of carrying out a first treatment on the surface of the Wherein POS i To acquire POS data at time i, RTK' i For POS i RTK data at the same acquisition time, i.e. POS i Corresponding RTK control point, deltaPR i Is a coordinate correction value.
Optionally, in the second RTK correction formula, the X-coordinate correction value is as follows:
in the above, TP i For POS data POS i Collecting time; TR (TR) s 、TR e Respectively starting and ending the RTK control point acquisition time; ΔTR ext Correcting the epitaxial time range for the RTK, wherein the time range is generally 30s; ΔPR of s .X、ΔPR e X is an X coordinate correction value at the moment corresponding to the start RTK control point and the end RTK control point respectively; ΔTR is For TP i With TR s A time interval therebetween; ΔTR ei Is TR e With TP i A time interval therebetween; ΔTR 1i 、ΔTR i2 、ΔTR 12 Respectively indicate when TP i Acquisition time TR at two adjacent RTK control points 1 With TR 2 Between them, TR 1 With TP i 、TP i With TR 2 、TR 1 With TR 2 Time interval between; ΔPR of 1 .X、ΔPR 2 X is TR respectively 1 With TR 2 And correcting the X coordinate corresponding to the moment.
Optionally, in the second RTK correction formula, the Y-coordinate correction value and the Z-coordinate correction value are calculated in the same manner as the X-coordinate correction value.
Optionally, correcting the POS data with the coordinate correction value to obtain first POS optimization data, including:
in the above, POS i To acquire POS data at time i, ΔPR i For acquiring the coordinate correction value corresponding to the moment i, POSR i And optimizing data for the first POS corresponding to the acquisition time i.
Optionally, performing control point correction on the first POS optimization data by using an external control point to obtain second POS optimization data, including: determining a plurality of external control points; determining point cloud data points and POS data corresponding to external control points; acquiring a first forward correction value, a first transverse correction value and a first Gao Chengjiu positive value of POS data according to the external control point and the corresponding point cloud data point; acquiring a first correction value of the POS data in X, Y and Z directions according to the first forward correction value, the first transverse correction value and the first elevation correction value; and correcting the POS data according to the first correction values of the POS data in the X, Y and Z directions to obtain second POS optimization data.
Optionally, the external control points are classified into: an advance control point, a transverse control point and a height control point. The forward control point, the transverse control point and the elevation control point are respectively used for correcting errors in the forward direction, the vertical direction and the elevation direction of the POS. The same control point may be used as both an approach, lateral and elevation control point.
In some embodiments, the point cloud data points and POS data corresponding to each control point are found by manual or automatic matching.
Optionally, acquiring the first forward correction value of the POS data according to the external control point and the corresponding point cloud data point includes: determining all forward control points: determining point cloud data points and POS data corresponding to the forward control points; acquiring XY plane offset between an advance control point and a corresponding point cloud data point; acquiring the forward projection quantity of the XY plane offset in the forward direction; and acquiring a first forward correction value according to the forward projection quantity.
Optionally, acquiring the first lateral correction value of the POS data according to the external control point and the corresponding point cloud data point includes: all lateral control points are determined: determining point cloud data points and POS data corresponding to the transverse control points; acquiring XZ plane offset between a transverse control point and a corresponding point cloud data point; acquiring the transverse projection quantity of the XZ plane offset in the transverse direction; and acquiring a first transverse correction value according to the transverse projection amount.
Optionally, acquiring the first Gao Chengjiu positive value of the POS data according to the external control point and the corresponding point cloud data point includes: all elevation control points are determined: determining point cloud data points and POS data corresponding to elevation control points; acquiring YZ plane offset between an elevation control point and a corresponding point cloud data point; acquiring elevation projection quantity of YZ plane offset on an elevation; and acquiring a first Gao Chengjiu positive value according to the elevation projection quantity.
Alternatively, the XY plane offset is obtained by the following formula:
in the above, CP i Plane coordinates of the forward control point; DP (DP) i Is CP i Corresponding point cloud data point plane coordinates; ΔDC i Is offset from the XY plane of the point cloud data point for the forward control point.
Optionally, the forward projection amount of the XY plane offset in the forward direction is obtained by the following formula:
ΔDC_J i =ΔDC i .X*VJ i .X+ΔDC i .Y*VJ i .Y
in the above formula, VJ i Vector of forward unit direction of POS data corresponding to forward control point, ΔDC_J i Is the forward projection quantity.
Optionally, the first forward correction value Δpc_j is obtained from the forward projection amount i Comprising:
in the above, TP i For POS data POS i Collecting time; TC (TC) s 、TC e Respectively collecting moments of a starting forward control point and an ending forward control point; ΔTC ext For forward correction of the epitaxial time range, generally 30s are taken; ΔDC_J s 、ΔDC_J e POS correction values at corresponding moments of the initial forward control point and the final forward control point respectively; ΔTC is For TP i With TC s A time interval therebetween; ΔTC ei For TC e With TP i A time interval therebetween; ΔDC_J 12 Representation when TP i Acquisition time TC located at two adjacent forward control points 1 With TC 2 A first forward correction value in between.
Alternatively, when TP i Acquisition time TC located at two adjacent forward control points 1 With TC 2 First direction correction in the middlePositive value ΔDC_J 12 The method is calculated and obtained according to the following mode:
in the above formula, ΔDC J1 、ΔDC J2 TC respectively 1 、TC 2 A corresponding first heading correction value;
ΔTC 1i 、ΔTC i2 、ΔTR 12 respectively represent TC 1 With TP i 、TP i With TC 2 、TC 1 With TC 2 Time interval between; ΔTC max To correct the time frame towards the control point, 30s is typically taken.
Optionally, the first lateral correction value and the first elevation correction value are calculated according to a calculation mode of the first heading correction value.
Optionally, obtaining the first correction value of the POS data in the X, Y and Z directions according to the first forward correction value, the first lateral correction value, and the first elevation correction value includes:
in the above formula, ΔPC i .X、ΔPC i Y and ΔPC i Z is X, Y and the first correction value in Z direction, ΔPC_J i For the first forward correction value ΔPC_H i For the first lateral correction value ΔPC_Z i Is a first Gao Chengjiu positive value, θ ji For the angle theta between the POS data forward vector and the X axis hi Is the angle between the lateral vector of the POS data and the X axis.
Optionally, correcting the POS data according to the first correction value of the POS data in the X, Y and Z directions to obtain second POS optimization data, including:
at the upper partWherein POSR i Optimizing data for a first POS, ΔPC i POSC is a direction correction value i The data is optimized for the second POS.
Optionally, performing feature point correction on the second POS optimization data according to the original point cloud data to obtain final POS optimization data, including: extracting characteristic points of the point cloud data to obtain homonymous characteristic points; dividing the homonymous feature points into forward feature points, transverse feature points and elevation feature points according to the spatial features; obtaining the plane precision standard deviation of the forward characteristic points and the transverse characteristic points and obtaining the elevation precision standard deviation of the elevation characteristic points; acquiring X coordinates, Y coordinates and Z coordinates of the feature points according to the plane precision standard deviation and the elevation precision standard deviation; and correcting the second POS optimization data according to the X coordinate, the Y coordinate and the Z coordinate of the feature point to obtain final POS optimization data.
In some embodiments, the original point cloud data is used to correct the POS data, and the specific steps are as follows: (1) extracting homonymy feature points from original point cloud data in a manual or algorithm identification mode, wherein one homonymy feature point has at least two point cloud data points acquired at different moments; (2) dividing homonymous feature points into forward feature points, transverse feature points and elevation feature points according to spatial features, and correcting errors in the advancing direction, the perpendicular advancing direction and the elevation direction of the POS respectively; (3) traversing all point cloud data points corresponding to the same-name feature points, and calculating the plane precision standard deviation Std of the forward feature points and the transverse feature points hrms Standard deviation Std of elevation precision of elevation feature point vrms The method comprises the steps of carrying out a first treatment on the surface of the (4) According to the standard deviation of the precision, calculating the X coordinate IP of the forward characteristic point and the transverse characteristic point according to the formula (5) i X, calculating Y coordinates IP of the forward feature point and the transverse feature point according to the formula (6) i Y, and calculating Z coordinate IP of elevation feature point according to (7) i Z; (5) correcting the first optimized POS data by referring to the external control point, and correcting the second optimized POS data by utilizing the characteristic point to obtain final optimized POS data.
Optionally, the X-coordinate of the feature point is obtained by the following formula, including:
in the above formula, m is the number of point cloud points corresponding to the homonymous feature points; CP (control program) j X is the X coordinate of the point cloud point j; HRMS (high-resolution ms) j The error in the POS data plane corresponding to the point cloud point j; CP (control program) min X is the X coordinate of the point with the minimum error in the plane of m points cloud points; std (Std) hrms_i Is the standard deviation of plane precision; std (Std) hrms_max Is the maximum threshold of the plane precision standard deviation.
Optionally, obtaining the Y coordinate of the feature point by the following formula includes:
in the above formula, m is the number of point cloud points corresponding to the homonymous feature points; CP (control program) j Y is the Y coordinate of the point cloud point j; HRMS (high-resolution ms) j The error in the POS data plane corresponding to the point cloud point j; CP (control program) min Y is the Y coordinate of the point with the minimum error in the plane of the m point cloud points; std (Std) hrms_i Is the standard deviation of plane precision; std (Std) hrms_max Is the maximum threshold of the plane precision standard deviation.
Optionally, obtaining the Z coordinate of the feature point by the following formula includes:
in the above formula, m is the number of point cloud points corresponding to the homonymous feature points; CP (control program) j Z is the Z coordinate of the point cloud point j; CP (control program) min Z is the Z coordinate of the point with the minimum error in the plane of the point cloud point; std (Std) hrms_i Is the standard deviation of plane precision; std (Std) hrms_max Is the maximum threshold of the plane precision standard deviation.
Optionally, the correcting step of the POS data according to the external control point also corrects the POS data by using the feature point, including: determining point cloud data points and POS data corresponding to the feature points; acquiring a second forward correction value, a second transverse correction value and a second Gao Chengjiu positive value of the POS data according to the characteristic points and the corresponding point cloud data points; acquiring a second correction value of the POS data in X, Y and Z directions according to the second forward correction value, the second transverse correction value and the second elevation correction value; and correcting the POS data according to the second correction values of the POS data in the X, Y and Z directions to obtain final POS optimization data.
Optionally, performing feature point correction on the second POS optimization data according to the original point cloud data, and performing precision evaluation on the final POS optimization data after obtaining the final POS optimization data, if the precision evaluation meets the requirement, outputting the final POS optimization data, otherwise, continuing performing RTK correction, control point correction and feature point correction until the final POS optimization data meets the precision requirement.
In some embodiments, the accuracy requirement is at least in the order of centimeters, and the final POS optimization data is evaluated for accuracy to ensure that the final POS optimization data meets the actual requirement.
In some embodiments, the error propagation law is used to calculate the error of the final POS optimization data, if the error meets the accuracy requirement, the final POS optimization data is output, and if not, the RTK correction, the control point correction, and the feature point correction are continued until the error of the final POS optimization data meets the accuracy requirement.
Referring to fig. 2, the overall flow of the vehicle-mounted mobile measurement point cloud precision improving method based on the multi-condition constraint includes: 1. acquiring laser ranging data, POS data and RTK data by using a vehicle-mounted mobile measurement system; the method specifically comprises the following steps: and synchronously acquiring RTK data in the scanning process of the mobile measurement system, and generating POS data through the calculation of the IMU and the GNSS data. 2. Filtering the RTK data by using the POS data to obtain RTK filtering data; 3. screening optimal RTK data at certain intervals based on RTK precision indexes, and determining the optimal RTK data as an RTK control point; 4. RTK correction is performed on the POS data by using an RTK control point. 5. Adding high-precision external control points: 6. correcting the control point of the POS data by using an external control point; 7. performing point cloud calculation through POS data and laser ranging data to generate an original point cloud, 8, extracting feature points from the original point cloud data to obtain homonymous feature points; 9. correcting the feature points of the POS data by using the feature points with the same name; 10. and (3) carrying out precision evaluation on the corrected POS data, outputting the corrected POS data if the precision requirement is met, and otherwise, returning to the RTK correction step of the 4 th step for correction.
Referring to fig. 3, a vehicle-mounted mobile measurement point cloud precision improving device based on multi-condition constraint includes: a vehicle-mounted mobile measurement data acquisition module 101 configured to acquire vehicle-mounted mobile measurement data; the vehicle-mounted mobile measurement data comprise RTK data, POS data and original point cloud data; a first POS optimization data acquisition module 102 configured to perform RTK correction on POS data using the RTK data to obtain first POS optimization data; a second POS optimization data obtaining module 103 configured to perform control point correction on the first POS optimization data using an external control point to obtain second POS optimization data; the final POS optimization data obtaining module 104 is configured to perform feature point correction on the second POS optimization data according to the original point cloud data, so as to obtain final POS optimization data.
Finally, it should be noted that: the above embodiments are only for illustrating the technical solution of the present invention, and are not limiting; although the invention has been described in detail with reference to the foregoing embodiments, it will be understood by those of ordinary skill in the art that: the technical scheme described in the foregoing embodiments can be modified or some or all of the technical features thereof can be replaced by equivalents; such modifications and substitutions do not depart from the spirit of the invention, and are intended to be included within the scope of the appended claims and description.
Claims (10)
1. A vehicle-mounted mobile measurement point cloud precision improving method based on multi-condition constraint is characterized by comprising the following steps:
acquiring vehicle-mounted mobile measurement data; the vehicle-mounted mobile measurement data comprise RTK data, POS data and original point cloud data;
RTK correction is carried out on the POS data by using the RTK data, so that first POS optimization data are obtained;
correcting the control point of the first POS optimization data by using an external control point to obtain second POS optimization data;
and correcting the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data.
2. The method of claim 1, wherein obtaining vehicle-mounted movement measurement data comprises:
acquiring initial acquisition data of a vehicle-mounted mobile measurement system; the initial acquisition data comprises RTK data, laser ranging data, IMU data and GNSS data;
generating POS data according to the IMU data and the GNSS data;
and generating an original point cloud according to the POS data and the laser ranging data.
3. The method of claim 1, wherein performing RTK correction on the POS data using the RTK data to obtain first POS optimization data comprises:
filtering the RTK data by using the POS data to obtain RTK filtering data;
acquiring RTK control points according to the RTK filtering data;
and carrying out RTK correction on the POS data according to the RTK control point to obtain first POS optimization data.
4. The method of claim 3, wherein filtering the RTK data with the POS data to obtain RTK filtered data comprises:
searching POS data at the same acquisition time as each RTK data;
subtracting the POS data and the RTK data at the same acquisition time to obtain an original offset;
taking a preset time interval before and after the RTK data acquisition time as a sliding window, and performing window sliding on the RTK data to obtain a plane filtering weight and an elevation filtering weight;
carrying out weighted filtering treatment on the original offset according to the plane filtering weight and the elevation filtering weight to obtain a filtering offset;
and correcting the RTK data according to the filtering offset to obtain RTK filtering data.
5. The method of claim 4, wherein performing RTK correction on POS data based on the RTK control point to obtain first POS optimization data comprises:
if the RTK control point with the same acquisition time as the POS data exists, acquiring a coordinate correction value of the POS data by adopting a first RTK correction formula; if the RTK control point with the same acquisition time as the POS data does not exist, acquiring a coordinate correction value of the POS data by adopting a second RTK correction formula;
and correcting the POS data by using the coordinate correction value to obtain first POS optimization data.
6. The method of claim 1, wherein performing control point correction on the first POS optimization data using the external control point to obtain second POS optimization data, comprising:
determining a plurality of external control points;
determining point cloud data points and POS data corresponding to external control points;
acquiring a first forward correction value, a first transverse correction value and a first Gao Chengjiu positive value of POS data according to the external control point and the corresponding point cloud data point;
acquiring a first correction value of the POS data in X, Y and Z directions according to the first forward correction value, the first transverse correction value and the first elevation correction value;
and correcting the POS data according to the first correction values of the POS data in the X, Y and Z directions to obtain second POS optimization data.
7. The method of claim 6, wherein obtaining a first heading correction value for POS data comprises:
acquiring XY plane offset between an advance control point and a corresponding point cloud data point;
acquiring the forward projection quantity of the XY plane offset in the forward direction;
and acquiring a first forward correction value according to the forward projection quantity.
8. The method of claim 7, wherein obtaining a first forward correction value based on the forward projection amount comprises:
in the above, TP i For POS data POS i Collecting time; TC (TC) s 、TC e Respectively collecting moments of a starting forward control point and an ending forward control point; ΔTC ext For forward correction of the epitaxial time range, generally 30s are taken; ΔDC_J s 、ΔDC_J e POS correction values at corresponding moments of the initial forward control point and the final forward control point respectively; ΔTC is For TP i With TC s A time interval therebetween; ΔTC ei For TC e With TP i A time interval therebetween; ΔDC_J 12 Representation when TP i Acquisition time TC located at two adjacent forward control points 1 With TC 2 A first forward correction value in between.
9. The method of claim 1, wherein performing feature point correction on the second POS optimization data based on the original point cloud data to obtain final POS optimization data, comprises:
extracting characteristic points of the point cloud data to obtain homonymous characteristic points;
dividing the homonymous feature points into forward feature points, transverse feature points and elevation feature points according to the spatial features;
obtaining the plane precision standard deviation of the forward characteristic points and the transverse characteristic points, and obtaining the elevation precision standard deviation of the elevation characteristic points;
acquiring X coordinates, Y coordinates and Z coordinates of the feature points according to the plane precision standard deviation and the elevation precision standard deviation;
and correcting the second POS optimization data according to the X coordinate, the Y coordinate and the Z coordinate of the feature point to obtain final POS optimization data.
10. Vehicle-mounted mobile measurement point cloud precision lifting device based on multi-condition constraint is characterized by comprising:
the vehicle-mounted mobile measurement data acquisition module is configured to acquire vehicle-mounted mobile measurement data; the vehicle-mounted mobile measurement data comprise RTK data, POS data and original point cloud data;
the first POS optimization data acquisition module is configured to carry out RTK correction on POS data by using the RTK data to acquire first POS optimization data;
the second POS optimization data acquisition module is configured to correct the control point of the first POS optimization data by utilizing an external control point to acquire second POS optimization data;
and the final POS optimization data acquisition module is configured to correct the characteristic points of the second POS optimization data according to the original point cloud data to obtain final POS optimization data.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311550029.2A CN117570972B (en) | 2023-11-20 | 2023-11-20 | Vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311550029.2A CN117570972B (en) | 2023-11-20 | 2023-11-20 | Vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117570972A true CN117570972A (en) | 2024-02-20 |
CN117570972B CN117570972B (en) | 2024-06-28 |
Family
ID=89893084
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311550029.2A Active CN117570972B (en) | 2023-11-20 | 2023-11-20 | Vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117570972B (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019071840A1 (en) * | 2017-10-13 | 2019-04-18 | 重庆市勘测院 | Method and device for acquiring point cloud data in the absence of gnss signal |
CN109975848A (en) * | 2019-04-19 | 2019-07-05 | 重庆市勘测院 | Traverse measurement system accuracy optimization method based on RTK technology |
CN111007530A (en) * | 2019-12-16 | 2020-04-14 | 武汉汉宁轨道交通技术有限公司 | Laser point cloud data processing method, device and system |
CN116485821A (en) * | 2023-04-23 | 2023-07-25 | 重庆市测绘科学技术研究院(重庆市地图编制中心) | Building point cloud segmentation and vector contour line extraction method and device |
-
2023
- 2023-11-20 CN CN202311550029.2A patent/CN117570972B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019071840A1 (en) * | 2017-10-13 | 2019-04-18 | 重庆市勘测院 | Method and device for acquiring point cloud data in the absence of gnss signal |
CN109975848A (en) * | 2019-04-19 | 2019-07-05 | 重庆市勘测院 | Traverse measurement system accuracy optimization method based on RTK technology |
CN111007530A (en) * | 2019-12-16 | 2020-04-14 | 武汉汉宁轨道交通技术有限公司 | Laser point cloud data processing method, device and system |
CN116485821A (en) * | 2023-04-23 | 2023-07-25 | 重庆市测绘科学技术研究院(重庆市地图编制中心) | Building point cloud segmentation and vector contour line extraction method and device |
Also Published As
Publication number | Publication date |
---|---|
CN117570972B (en) | 2024-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109696663B (en) | Vehicle-mounted three-dimensional laser radar calibration method and system | |
RU2727164C1 (en) | Method and apparatus for correcting map data | |
WO2022127532A1 (en) | Method and apparatus for calibrating external parameter of laser radar and imu, and device | |
JP2022113746A (en) | Determination device | |
CN112904395B (en) | Mining vehicle positioning system and method | |
US10996072B2 (en) | Systems and methods for updating a high-definition map | |
CN112731440B (en) | High-speed railway slope deformation detection method and device | |
CN115407357B (en) | Low-harness laser radar-IMU-RTK positioning mapping algorithm based on large scene | |
CN108345008A (en) | A kind of target object detecting method, point cloud data extracting method and device | |
JP5028662B2 (en) | Road white line detection method, road white line detection program, and road white line detection device | |
CN102224523B (en) | Stereo matching process system, stereo matching process method, and recording medium | |
JP2022031266A (en) | Self-position estimation device, control method, program, and storage medium | |
KR101255461B1 (en) | Position Measuring Method for street facility | |
CN115127543A (en) | Method and system for eliminating abnormal edges in laser mapping optimization | |
CN109975848B (en) | Precision optimization method of mobile measurement system based on RTK technology | |
CN112801983A (en) | Slope global settlement detection method and system based on photogrammetry | |
WO2020209144A1 (en) | Position estimating device, estimating device, control method, program, and storage medium | |
CN114396943A (en) | Fusion positioning method and terminal | |
CN114485654A (en) | Multi-sensor fusion positioning method and device based on high-precision map | |
CN102620745B (en) | Airborne inertial measurement unite (IMU) collimation axis error calibration method | |
WO2020113425A1 (en) | Systems and methods for constructing high-definition map | |
CN117570972B (en) | Vehicle-mounted mobile measurement point cloud precision improving method and device based on multi-condition constraint | |
CN116929336A (en) | Minimum error-based laser reflection column SLAM (selective laser absorption) mapping method | |
CN115375861A (en) | Three-dimensional mapping method, device and storage medium for unmanned mining area | |
CN110544201A (en) | Large-range splicing method and device for vehicle-mounted laser scanning point cloud |
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 | ||
CB02 | Change of applicant information |
Country or region after: China Address after: 401120 No. 6, Qingzhu East Road, Dazhulin, Yubei District, Chongqing Applicant after: Chongqing Institute of Surveying and Mapping Science and Technology Address before: 401120 No. 6, Qingzhu East Road, Dazhulin, Yubei District, Chongqing Applicant before: Chongqing Institute of Surveying and Mapping Science and Technology (Chongqing Map Compilation Center) Country or region before: China |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |