WO2020151213A1 - Air and ground combined intertidal zone integrated mapping method - Google Patents
Air and ground combined intertidal zone integrated mapping method Download PDFInfo
- Publication number
- WO2020151213A1 WO2020151213A1 PCT/CN2019/098770 CN2019098770W WO2020151213A1 WO 2020151213 A1 WO2020151213 A1 WO 2020151213A1 CN 2019098770 W CN2019098770 W CN 2019098770W WO 2020151213 A1 WO2020151213 A1 WO 2020151213A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- coordinate system
- axis
- point cloud
- data
- plane
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
Definitions
- the invention belongs to the technical field of marine surveying and mapping, and particularly relates to a surveying and mapping method for rapidly acquiring water and underwater topography in an intertidal zone area in an air-ground combination.
- the intertidal zone is a part of the coastal zone and is susceptible to the influence of tides, and the measurement conditions are more difficult.
- coastal surveying and mapping technologies mainly include manual field surveys, shipborne surveys, and aerial surveys and remote sensing.
- Natural coastal zones usually have special geographical environments such as reefs, tidal flats, wetlands, etc. It is difficult to perform operations efficiently with traditional manual field surveys and shipborne surveys, and there are even operational risks that endanger personal safety, and it is impossible to ensure the rapid update of basic geographic information in the coastal zone.
- Aerial survey and remote sensing technology has the advantages of wide range, high frequency and real-time. It is widely used in marine surveying and mapping.
- Airborne LiDAR technology has the characteristics of high convenience, no control, high precision, high density, high efficiency, high resolution, multiple echoes, etc. It has been widely recognized as a tool for accurately and quickly acquiring 3D ground data. Due to the particular terrain of the interzone, the laser signal is affected by the obstruction of ground objects and the reflection on the water surface, and measurement "blind areas" will also appear.
- the present invention proposes an integrated air-ground surveying and mapping method for intertidal zones.
- the airborne laser detection and measurement system is combined with the towing integrated measurement system, which solves the common measurement problems in the intertidal zone. good effect.
- An air-ground integrated intertidal zone surveying and mapping method includes a measuring device.
- the measuring device includes an unmanned aerial vehicle and a carrier vehicle.
- the unmanned aerial vehicle is equipped with a laser detection and measurement system.
- the carrier vehicle is equipped with a laser scanner and single beam sounding Instrument, inertial navigation system and satellite positioning system;
- the surveying method includes the following steps:
- Step 1 After the original data is collected and downloaded, check the completeness and correctness of the observation data of each measuring instrument, convert the format of the observation data file, perform high-precision time synchronization of each measuring instrument, and integrate the time and space of the data of each measuring instrument. Point cloud data preprocessing to form standard LAS data files;
- Step 2 Perform point cloud space-time fusion and complete the conversion from the instrument coordinate system to the geocentric ground-fixed coordinate system;
- Step 3 Establish the correspondence relationship between the single-beam point cloud and the laser scanner point cloud, the laser scanner point cloud and the airborne LIDAR point cloud data, such as geometric features such as points, lines, and surfaces, and solve the rotation matrix and translation amount Perform point cloud matching.
- the step 1 includes the following sub-steps:
- Step 1.1 Use the hardware synchronization controller to synchronize the high-precision time of each measuring instrument, the time and space of the data of each measuring instrument are integrated, and the time of the hardware synchronization controller is synchronized with the time of the satellite positioning system; the hardware synchronization controller controls each measuring instrument Trigger and monitor its feedback signal, signal transmission adopts differential mode;
- Step 1.2 Use IE to settle the data of base station and rover, and output POS data
- Step 1.3 Use VsursPROCESS software to preprocess point cloud data to form a standard LAS data file.
- the step 2 includes the following sub-steps:
- Step 2.1 Convert from the laser scanner coordinate system to the carrier coordinate system
- l x , l y , and l z are the translational amounts of the point coordinates along the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
- ⁇ , ⁇ is the rotation angle of the point coordinate around the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
- R x ( ⁇ ) Represents the rotation matrix transformed from the laser scanner coordinate system to the carrier coordinate system
- R z ( ⁇ ) is the rotation matrix rotating around the x-axis, y-axis, and z-axis of the carrier coordinate system
- Step 2.2 Convert from the carrier coordinate system to the station center coordinate system
- the forward direction of the inertial navigation coordinate system is the y-axis, the right is the x-axis, and the upward is the z-axis;
- Inertial navigation records the attitude angle: roll angle Roll, pitch angle Pitch, yaw angle Heading;
- Roll angle Roll the angle between the x-axis of the inertial navigation and the horizontal direction, the right side of the carrier downwards is positive;
- Pitch angle the angle between the y-axis of the inertial navigation and the horizontal direction, the carrier is positive upward;
- Heading the heading direction of the inertial navigation, that is, the angle between the xy plane and the true north direction, clockwise is positive;
- R x (p), R y (r), R z (y) are the rotations around the station center coordinate system x axis, y axis, and z axis respectively matrix;
- Step 2.3 Transform from the station center coordinate system to the geocentric ground-fixed coordinate system
- the latitude and longitude of the origin of the station center coordinate system under WGS84 are L and B respectively;
- N represents the radius of curvature of the unitary circle
- h represents the height of the earth
- a and b represent the length and short radius of the ellipsoid
- the step 3 includes:
- (a′ b′ c′) represents the cosine of the direction perpendicular to the plane and away from the coordinate origin;
- d represents the vertical distance between the plane and the origin of the coordinate
- the idea of the least squares method is to estimate an optimal mathematical model, and obtain the optimal model parameters to minimize the sum of squares of the difference between the estimated model point value and the actual observation value;
- the plane fitting algorithm based on the least squares method is a fitting algorithm based on three-dimensional point cloud data.
- Formula (6) is used as the three-dimensional model to determine the four parameters a′, b′, c′, and d to make the three-dimensional model
- the sum of squares of the difference between the estimated value and the measured value of E 2 is the smallest; since E 2 is a non-negative number, it has a minimum value.
- the partial derivative of E 2 for each parameter is zero.
- An equation constructed with a partial derivative of zero The group can solve for a′, b′, c′, d, and minimize the sum of squared differences E 2 between the estimated value and the measured value;
- the measured value z should be p+qx i +ry i , but because of the error, the measured value z is z i , then the i-th
- the measurement error of the point is:
- the corresponding plane feature pairs are parallel to each other, find more than one pair of feature points in two pieces of point cloud data, or use the difference between the centroid coordinates of the corresponding planes, Calculate the translation amount of point cloud data:
- the invention provides an integrated air-ground intertidal zone surveying and mapping method, which integrates an airborne laser detection and measurement system and a towed measurement system, can obtain underwater topography and water topography data in the intertidal zone, and solves the problem of intertidal zone Topographic survey problems.
- the two can perfectly cover the measurement "blind zone", and realize the integrated seamless measurement of the intertidal zone.
- Figure 1 is a flow chart of the field collection of intertidal carrier vehicles provided by the present invention.
- Fig. 2 is a flow chart of field collection of the airborne laser detection and measurement system provided by the present invention.
- Fig. 3 is a flow chart of single-beam data format conversion provided by the present invention.
- Figure 4 is a flow chart of data solution provided by the present invention.
- Fig. 5 is a flow chart of spatial integration of single-beam sounder data, laser scanner data, and airborne laser detection and measurement system data provided by the present invention.
- an integrated air-to-ground intertidal zone surveying and mapping method includes a measuring device.
- the measuring device includes a UAV and a carrier vehicle.
- the UAV is equipped with a laser detection and measurement system
- the carrier vehicle is equipped with a laser.
- the surveying method includes the following steps:
- Step 1 After the original data is collected and downloaded, check the completeness and correctness of the observation data of each measuring instrument, convert the format of the observation data file, perform high-precision time synchronization of each measuring instrument, and integrate the time and space of the data of each measuring instrument. Point cloud data preprocessing to form standard LAS data files.
- the observation data of each measuring instrument includes laser scanner data, laser detection and measurement system data, single beam echo sounder data, inertial navigation system data and satellite positioning system data.
- step 1 includes the following sub-steps:
- Step 1.1 As shown in Figure 1 and Figure 2, the data acquisition flow chart of the carrier vehicle and the airborne laser detection and measurement system are respectively.
- Figure 3 is a flow chart of single-beam data format conversion.
- the hardware synchronization controller is used to synchronize the high-precision time of each measuring instrument, and the time and space of the data of each measuring instrument are integrated. Its function is to provide the corresponding synchronization signal for the laser scanner, single beam sounder and other instruments in the system, and record it The corresponding time provides a time synchronization benchmark for later data processing.
- the time of the hardware synchronization controller is kept synchronized with the time of the satellite positioning system; the hardware synchronization controller controls the triggering of each measuring instrument and monitors its feedback signals, taking environmental factors into account Complex, in order to ensure the high reliability of the system, the signal transmission adopts the differential mode;
- Step 1.2 As shown in Figure 4, use IE to settle the data of the base station and the rover, and output the POS data;
- Step 1.3 Use VsursPROCESS software to preprocess point cloud data to form a standard LAS data file.
- Step 2 Perform point cloud space-time fusion to complete the conversion from the instrument coordinate system to the geocentric ground-fixed coordinate system.
- Step 2 includes the following sub-steps:
- Step 2.1 Convert from the laser scanner coordinate system to the carrier coordinate system
- l x , l y , l z are the translational amount of point coordinates along the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
- ⁇ , ⁇ is the rotation angle of the point coordinate around the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
- R x ( ⁇ ) Represents the rotation matrix transformed from the laser scanner coordinate system to the carrier coordinate system
- R z ( ⁇ ) is the rotation matrix rotating around the x-axis, y-axis, and z-axis of the carrier coordinate system.
- Step 2.2 Convert from the carrier coordinate system to the station center coordinate system
- the forward direction of the inertial navigation coordinate system is the y-axis, the right is the x-axis, and the upward is the z-axis;
- the inertial navigation records the attitude angle: roll angle Roll, pitch angle Pitch, yaw angle Heading.
- Roll angle Roll the angle between the x-axis of the inertial navigation and the horizontal direction, the right side of the carrier downwards is positive;
- Pitch angle the angle between the y-axis of the inertial navigation and the horizontal direction, the carrier is positive upward;
- Heading the heading direction of the inertial navigation, that is, the angle between the xy plane and the true north direction, clockwise is positive;
- R x (p), R y (r), R z (y) are the rotations around the station center coordinate system x axis, y axis, and z axis respectively matrix.
- Step 2.3 Transform from the station center coordinate system to the geocentric ground-fixed coordinate system
- the latitude and longitude of the origin of the station center coordinate system under WGS84 are L and B respectively;
- N represents the radius of curvature of the unitary circle
- h represents the height of the earth
- a and b represent the long and short radii of the ellipsoid.
- Step 3 Establish the correspondence relationship between the single-beam point cloud and the laser scanner point cloud, the laser scanner point cloud and the airborne LIDAR point cloud data, such as geometric features such as points, lines, and surfaces, and solve the rotation matrix and translation amount Perform point cloud matching.
- Step 3 includes:
- d represents the vertical distance between the plane and the origin of the coordinate.
- the idea of the least square method is to estimate an optimal mathematical model, and obtain the optimal model parameters to minimize the sum of squares of the difference between the estimated model point value and the actual observation value;
- the plane fitting algorithm based on the least squares method is a fitting algorithm based on three-dimensional point cloud data.
- Formula (6) is used as the three-dimensional model to determine the four parameters a′, b′, c′, and d to make the three-dimensional model
- the sum of squares of the difference between the estimated value and the measured value of E 2 is the smallest; since E 2 is a non-negative number, it has a minimum value.
- the partial derivative of E 2 for each parameter is zero.
- An equation constructed with a partial derivative of zero The group can solve for a′, b′, c′, d, and minimize the sum of squared differences E 2 between the estimated value and the measured value;
- the measured value z should be p+qx i +ry i , but because of the error, the measured value z is z i , then the i-th
- the measurement error of the point is:
- the corresponding plane feature pairs are parallel to each other, find more than one pair of feature points in two pieces of point cloud data, or use the difference between the centroid coordinates of the corresponding planes, Calculate the translation amount of point cloud data:
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
An air and ground combined intertidal zone integrated mapping method. After original data is acquired and downloaded, point cloud spatiotemporal fusion is performed to complete transformation from an instrument coordinate system to an earth-centered earth-fixed coordinate system; a correspondence is established by obtaining point, line, plane and other geometric characteristics between single beam point cloud and laser scanner point cloud data and between laser scanner point cloud and airborne laser detection and measurement system point cloud data, so as to solve a rotation matrix and a translation amount for point cloud matching. An airborne laser detection and measurement system is integrated with a towing measurement system, and thus underwater topography and overwater topography data of an intertidal zone can be obtained, thereby solving the problem of intertidal zone topography measurement. The two systems can perfectly cover a measurement blind area, so as to achieve integrated and seamless intertidal zone measurement.
Description
本发明属于海洋测绘技术领域,具体涉及以一种空地结合的方式进行潮间带区域水上和水下地形快速获取的测绘方法。The invention belongs to the technical field of marine surveying and mapping, and particularly relates to a surveying and mapping method for rapidly acquiring water and underwater topography in an intertidal zone area in an air-ground combination.
潮间带属于海岸带的一部分,易受到潮汐的影响,测量条件比较困难。当前,海岸带测绘技术主要有人工实地测量、船载测量和航测遥感等方式。自然海岸带通常存在礁石、滩涂、湿地等特殊地理环境,以传统人工实地测量和船载测量方式难以高效地进行作业,甚至存在危及人身安全的作业风险,无法保障海岸带基础地理信息的快速更新。航测遥感技术手段具有范围广、频度高和实时的优点,被广泛应用于海洋测绘,但是由于受到卫星重复周期、海岸带云雨天气、分辨率低等影响,难以满足动态监测和水下地形的高精度测量需求,对潮水覆盖区域尤其是大面积浅滩和宽阔滩涂区域无能为力。The intertidal zone is a part of the coastal zone and is susceptible to the influence of tides, and the measurement conditions are more difficult. Currently, coastal surveying and mapping technologies mainly include manual field surveys, shipborne surveys, and aerial surveys and remote sensing. Natural coastal zones usually have special geographical environments such as reefs, tidal flats, wetlands, etc. It is difficult to perform operations efficiently with traditional manual field surveys and shipborne surveys, and there are even operational risks that endanger personal safety, and it is impossible to ensure the rapid update of basic geographic information in the coastal zone. . Aerial survey and remote sensing technology has the advantages of wide range, high frequency and real-time. It is widely used in marine surveying and mapping. However, it is difficult to meet the requirements of dynamic monitoring and underwater terrain due to satellite repetition cycles, coastal cloud and rain weather, and low resolution. The demand for high-precision measurement is powerless for areas covered by tidal water, especially large shoals and wide tidal flat areas.
船载多传感器水岸一体化综合测量技术的发展,为海岸带一体化测量提供了依据。但当海岸带地形以滩涂为主且潮差较小时,由于测量船和测深仪存在吃水问题使得基于船载激光测量无法对潮间带进行扫测,出现潮间带的测量“盲区”。The development of ship-borne multi-sensor integrated water-shore integrated measurement technology provides a basis for integrated coastal measurement. However, when the topography of the coastal zone is dominated by tidal flats and the tidal range is small, due to the draught problem of the survey ship and the echo sounder, it is impossible to scan the intertidal zone based on the shipborne laser measurement, and the measurement "blind zone" of the intertidal zone appears.
机载LiDAR技术具有高便捷、无控制、高精度、高密集、高效率、高分辨率、多回波等特点,作为精确、快速地获取地面三维数据的工具已得到广泛的认同,但由于潮间带地形特殊性,激光信号受地物遮挡、水面反射等影响,也会出现测量“盲区”。Airborne LiDAR technology has the characteristics of high convenience, no control, high precision, high density, high efficiency, high resolution, multiple echoes, etc. It has been widely recognized as a tool for accurately and quickly acquiring 3D ground data. Due to the particular terrain of the interzone, the laser signal is affected by the obstruction of ground objects and the reflection on the water surface, and measurement "blind areas" will also appear.
发明内容Summary of the invention
针对现有方法中存在的问题,本发明提出一种空地结合的潮间带一体化测绘方法,机载激光探测与测量***结合拖曳一体化测量***,解决了潮间带常见的测量问题,具有良好的效果。In view of the problems existing in the existing methods, the present invention proposes an integrated air-ground surveying and mapping method for intertidal zones. The airborne laser detection and measurement system is combined with the towing integrated measurement system, which solves the common measurement problems in the intertidal zone. good effect.
本发明采用以下的技术方案:The present invention adopts the following technical solutions:
一种空地结合的潮间带一体化测绘方法,包括测量装置,测量装置包括无人机和载体车,无人机上搭载激光探测与测量***,载体车上设置有激光扫描仪、单波束测深仪、惯性导航***和卫星定位***;An air-ground integrated intertidal zone surveying and mapping method includes a measuring device. The measuring device includes an unmanned aerial vehicle and a carrier vehicle. The unmanned aerial vehicle is equipped with a laser detection and measurement system. The carrier vehicle is equipped with a laser scanner and single beam sounding Instrument, inertial navigation system and satellite positioning system;
测绘方法包括以下步骤:The surveying method includes the following steps:
步骤1:原始数据采集下载后,检查各测量仪器观测数据的完整性、正确性,进行观测数据文件的格式转换,进行各测量仪器高精度时间同步,各测量仪器数据的时、空融合,通过点云数据预处理,形成标准LAS数据文件;Step 1: After the original data is collected and downloaded, check the completeness and correctness of the observation data of each measuring instrument, convert the format of the observation data file, perform high-precision time synchronization of each measuring instrument, and integrate the time and space of the data of each measuring instrument. Point cloud data preprocessing to form standard LAS data files;
步骤2:进行点云时空融合,完成从仪器坐标系到地心地固坐标系的转换;Step 2: Perform point cloud space-time fusion and complete the conversion from the instrument coordinate system to the geocentric ground-fixed coordinate system;
步骤3:通过获取单波束点云与激光扫描仪点云、激光扫描仪点云与机载LIDAR点云数据之间的点、线、面等几何特征来建立对应关系,求解旋转矩阵和平移量进行点云匹配。Step 3: Establish the correspondence relationship between the single-beam point cloud and the laser scanner point cloud, the laser scanner point cloud and the airborne LIDAR point cloud data, such as geometric features such as points, lines, and surfaces, and solve the rotation matrix and translation amount Perform point cloud matching.
优选地,所述步骤1包括以下子步骤:Preferably, the step 1 includes the following sub-steps:
步骤1.1:利用硬件同步控制器进行各测量仪器高精度时间同步,各测量仪器数据的时、空融合,硬件同步控制器的时间保持与卫星定位***的时间同步;硬件同步控制器控制各测量仪器的触发及监测其反馈信号,信号的传输都采用差分方式;Step 1.1: Use the hardware synchronization controller to synchronize the high-precision time of each measuring instrument, the time and space of the data of each measuring instrument are integrated, and the time of the hardware synchronization controller is synchronized with the time of the satellite positioning system; the hardware synchronization controller controls each measuring instrument Trigger and monitor its feedback signal, signal transmission adopts differential mode;
步骤1.2:利用IE进行基准站和流动站数据结算,输出POS数据;Step 1.2: Use IE to settle the data of base station and rover, and output POS data;
步骤1.3:利用VSursPROCESS软件进行点云数据预处理,形成标准LAS数据文件。Step 1.3: Use VsursPROCESS software to preprocess point cloud data to form a standard LAS data file.
优选地,所述步骤2包括以下子步骤:Preferably, the step 2 includes the following sub-steps:
步骤2.1:从激光扫描仪坐标系到载体坐标系转换;Step 2.1: Convert from the laser scanner coordinate system to the carrier coordinate system;
根据标定的公共点计算坐标系转换需要的的6参数:l
x、l
y、l
z、ω、
κ;
Calculate the 6 parameters needed for coordinate system conversion according to the calibrated common point: l x , l y , l z , ω, κ;
l
x、l
y、l
z分别为坐标转换过程中点坐标沿载体坐标系x轴、y轴、z轴的平移量;
l x , l y , and l z are the translational amounts of the point coordinates along the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
ω、
κ分别为坐标转换过程中点坐标绕载体坐标系x轴、y轴、z轴的旋转角度;
ω, κ is the rotation angle of the point coordinate around the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
设激光扫描仪坐标系下点坐标为
在载体坐标系下的坐标为
则有,
Let the coordinates of the point in the laser scanner coordinate system be The coordinates in the carrier coordinate system are Then there is,
其中,
代表从激光扫描仪坐标系到载体坐标系转换的旋转矩阵,R
x(ω)、
R
z(κ)分别为绕载体坐标系x轴、y轴、z轴旋转的旋转矩阵;
among them, Represents the rotation matrix transformed from the laser scanner coordinate system to the carrier coordinate system, R x (ω), R z (κ) is the rotation matrix rotating around the x-axis, y-axis, and z-axis of the carrier coordinate system;
步骤2.2:从载体坐标系到站心坐标系转换;Step 2.2: Convert from the carrier coordinate system to the station center coordinate system;
惯导坐标系前进方向为y轴、向右为x轴、向上为z轴;The forward direction of the inertial navigation coordinate system is the y-axis, the right is the x-axis, and the upward is the z-axis;
惯导记录姿态角:侧滚角Roll、俯仰角Pitch、偏航角Heading;Inertial navigation records the attitude angle: roll angle Roll, pitch angle Pitch, yaw angle Heading;
侧滚角Roll:惯导x轴与水平方向之间的夹角,载体右侧向下为正;Roll angle Roll: the angle between the x-axis of the inertial navigation and the horizontal direction, the right side of the carrier downwards is positive;
俯仰角Pitch:惯导y轴与水平方向之间的夹角,载体向上为正;Pitch angle: the angle between the y-axis of the inertial navigation and the horizontal direction, the carrier is positive upward;
偏航角Heading:惯导前进方向,即xy平面与正北方向之间的夹角,顺时针为正;Heading: the heading direction of the inertial navigation, that is, the angle between the xy plane and the true north direction, clockwise is positive;
设Roll、Pitch、Heading分别为r、p、y;设点在站心坐标系下的坐标为
载体坐标系下坐标向站心坐标系转换;
Let Roll, Pitch, Heading be r, p, y respectively; let the coordinates of the point in the station center coordinate system be Conversion of coordinates under the carrier coordinate system to the station center coordinate system;
①先绕z轴旋转y;① Rotate y around the z axis first;
②再绕x轴旋转p;② Then rotate p around the x axis;
③最后绕y轴旋转r;③Finally rotate r around the y axis;
则有,Then there is,
其中,
代表从载体坐标系到站心坐标系转换的旋转矩阵,R
x(p)、R
y(r)、R
z(y)分别为绕站心坐标系x轴、y轴、z轴旋转的旋转矩阵;
among them, Represents the rotation matrix converted from the carrier coordinate system to the station center coordinate system, R x (p), R y (r), R z (y) are the rotations around the station center coordinate system x axis, y axis, and z axis respectively matrix;
步骤2.3:从站心坐标系到地心地固坐标系转换;Step 2.3: Transform from the station center coordinate system to the geocentric ground-fixed coordinate system;
站心坐标系原点在WGS84下的经纬度分别为L和B;The latitude and longitude of the origin of the station center coordinate system under WGS84 are L and B respectively;
设扫描点在地心地固坐标系下的坐标为
站心坐标系下的坐标转换为WGS84坐标系下的坐标:
Suppose the coordinates of the scanning point in the geocentric and ground-fixed coordinate system are The coordinates in the station center coordinate system are converted to the coordinates in the WGS84 coordinate system:
③最后将站心坐标系原点平移到WGS84坐标系原点;③ Finally, the origin of the station center coordinate system is translated to the origin of the WGS84 coordinate system;
则有,Then there is,
其中,
代表从站心坐标系到地心地固坐标系转换的旋转矩阵;
among them, Represents the rotation matrix transformed from the station-centered coordinate system to the earth-centered ground-fixed coordinate system;
其中,N代表卯酉圈曲率半径,h代表大地高,a、b代表椭球长、短半径;Among them, N represents the radius of curvature of the unitary circle, h represents the height of the earth, and a and b represent the length and short radius of the ellipsoid;
得Get
为站心坐标系原点在地心地固坐标系下的空间直角坐标;
It is the spatial rectangular coordinates of the origin of the station center coordinate system in the geocentric ground-fixed coordinate system;
最后得,Finally,
优选地,所述步骤3包括:Preferably, the step 3 includes:
首先介绍一下所需要的理论基础:First introduce the required theoretical basis:
平面拟合原理Plane fitting principle
已知平面方程:a′x+b′y+c′z=d (6)Known plane equation: a′x+b′y+c′z=d (6)
且a′
2+b′
2+c′
2=1,d≥0,(x y z)是平面上的任意点;
And a′ 2 +b′ 2 +c′ 2 =1, d≥0, (x y z) is any point on the plane;
其中,(a′ b′ c′)代表垂直于平面且远离坐标原点方向的方向余弦;Among them, (a′ b′ c′) represents the cosine of the direction perpendicular to the plane and away from the coordinate origin;
同样的,它也表示垂直于平面远离坐标原点的单位法向量的分量;Similarly, it also represents the component of the unit normal vector perpendicular to the plane away from the origin of the coordinate;
d表示了平面和坐标原点间的垂直距离;d represents the vertical distance between the plane and the origin of the coordinate;
最小二乘算法基本原理The basic principle of least squares algorithm
最小二乘法的思想就是估算一个最佳数学模型,求得最佳模型参数使估算模型点的值和实际观察值的差值的平方和最小;The idea of the least squares method is to estimate an optimal mathematical model, and obtain the optimal model parameters to minimize the sum of squares of the difference between the estimated model point value and the actual observation value;
在二维数据中,假设给出模型函数g(x
i),g(x
i)与真实值(x
i,y
i)的误差可用三种形式表述:
In two-dimensional data, assuming that the model function g(x i ) is given, the error between g(x i ) and the true value (x i , y i ) can be expressed in three forms:
最小二乘算法的原理便是寻找一个最佳参数模型,对于给定的数据(x
i,y
i)(i=0,1...n),误差平方和
最小;
The principle of the least squares algorithm is to find an optimal parameter model. For a given data (x i , y i ) (i=0, 1...n), the sum of squared errors The smallest
最小二乘平面拟合算法Least squares plane fitting algorithm
基于最小二乘法的平面拟合算法是在三维点云数据的基础上进行的拟合算法,以公式(6)为三维模型,确定a′,b′,c′,d四个参数使三维模型的估算值和测量值之间的差值平方和E
2最小;由于E
2是非负数,因此它存在极小值,E
2对每个参数的偏导数为零,利用偏导数为零构建的方程组便可求解出a′,b′,c′,d,并使估算值和测量值之间的差值平方和E
2最小;
The plane fitting algorithm based on the least squares method is a fitting algorithm based on three-dimensional point cloud data. Formula (6) is used as the three-dimensional model to determine the four parameters a′, b′, c′, and d to make the three-dimensional model The sum of squares of the difference between the estimated value and the measured value of E 2 is the smallest; since E 2 is a non-negative number, it has a minimum value. The partial derivative of E 2 for each parameter is zero. An equation constructed with a partial derivative of zero The group can solve for a′, b′, c′, d, and minimize the sum of squared differences E 2 between the estimated value and the measured value;
假设点云数据的点集为{p
i|p
i∈oxyz,i=1,2,3...,N},其中x
i和y
i设为无误差变化的自变量,z
i是包含误差的因变量,则z和x、y的函数相关性可以假设为函数表达式:
Suppose the point set of the point cloud data is {p i |p i ∈ oxyz,i=1, 2, 3...,N}, where x i and y i are set as independent variables without error change, and z i is the inclusion The dependent variable of the error, the functional correlation between z and x and y can be assumed as a functional expression:
z=f(x,y;p,q,r)=p+qx+ry (7)z=f(x,y;p,q,r)=p+qx+ry (7)
且其中的p,q,r可以通过最小二乘算法得到;And the p, q, r can be obtained by the least square algorithm;
根据公式(6)、(7),令d=c′p,a′=-qc′,b′=-rc′且
则公式(7)可以描述为平面方程;
According to formulas (6) and (7), let d=c′p, a′=-qc′, b′=-rc′ and Then formula (7) can be described as a plane equation;
根据上述定义f函数的公式,假如自变量的值为x
i和y
i,被测量值z应该为p+qx
i+ry
i,然而因为误差的存在测量值z为z
i,则第i个点的测量误差为:
According to the above formula defining the f function, if the values of the independent variables are x i and y i , the measured value z should be p+qx i +ry i , but because of the error, the measured value z is z i , then the i-th The measurement error of the point is:
e
i=f(x
i,
i;p,q,r)-z
i (8)
e i =f(x i , i ; p,q,r)-z i (8)
根据最小二乘的原理,p,q,r应该满足公式(8)的平方和最小,即E
2最小:
According to the principle of least squares, p, q, r should satisfy the minimum sum of squares of formula (8), that is, E 2 is minimum:
若使得E
2最小,应满足:
If E 2 is minimized, it should satisfy:
即:which is:
有:Have:
根据公式(11)可以求解出p,q,r,同样的,公式(6)中a′,b′,c′,d四个参数也就可通过d=c′p,a′=-qc′,b′=-rc′,
求出;
According to formula (11), p, q, r can be solved. Similarly, the four parameters of a′, b′, c′, d in formula (6) can also be solved by d=c′p, a′=-qc ′, b′=-rc′, Find out
求解旋转矩阵Solve the rotation matrix
在上述算法的计算过程中,提取3对以上对应的平面特征量后,需要求取其各自的平面法向量;In the calculation process of the above algorithm, after extracting more than 3 pairs of corresponding plane feature quantities, it is required to take their respective plane normal vectors;
假设求解的一对平面为a
1x+b
1y+z=d
1和a
2x+b
2y+z=d
2,则其法向量对可表示为P=(a
1,b
1,-1)、Q=(a
2,b
2,-1),法向量的旋转矩阵R满足P=RQ,采用罗德里格旋转法求解;上述P,Q矩阵,其夹角为:
Assuming that a pair of planes to be solved is a 1 x+b 1 y+z=d 1 and a 2 x+b 2 y+z=d 2 , the normal vector pair can be expressed as P=(a 1 ,b 1 , -1), Q=(a 2 ,b 2 ,-1), the rotation matrix R of the normal vector satisfies P=RQ and is solved by the Rodrigue rotation method; the above P and Q matrix, the included angle is:
P,Q矩阵的叉乘为:The cross product of P and Q matrices is:
若已知单位向量
利用法向量将其旋转θ角度后,根据罗德里格旋转法求解其三维旋转矩阵为:
If the unit vector is known After the normal vector is used to rotate it by the angle θ, the three-dimensional rotation matrix is solved according to the Rodrigue rotation method as:
求解平移量Solve for translation
利用三维变换矩阵C
1可以对点云数据进行旋转,相应的平面特征量对相互平行,在两片点云数据中寻找一对以上的特征点,或利用对应面的的质心坐标的差值,计算点云数据的平移量即:
Using the three-dimensional transformation matrix C 1 to rotate the point cloud data, the corresponding plane feature pairs are parallel to each other, find more than one pair of feature points in two pieces of point cloud data, or use the difference between the centroid coordinates of the corresponding planes, Calculate the translation amount of point cloud data:
本发明具有的有益效果是:The beneficial effects of the present invention are:
本发明提供的一种空地结合的潮间带一体化测绘方法,集成了机载激光探测与测量***和拖曳测量***,可以获取潮间带区域水下地形和水上地形数据,解决了潮间带地形测量问题。两者能完美覆盖测量“盲区”,实现潮间带区域一体化无缝测量。The invention provides an integrated air-ground intertidal zone surveying and mapping method, which integrates an airborne laser detection and measurement system and a towed measurement system, can obtain underwater topography and water topography data in the intertidal zone, and solves the problem of intertidal zone Topographic survey problems. The two can perfectly cover the measurement "blind zone", and realize the integrated seamless measurement of the intertidal zone.
图1为本发明提供的潮间带载体车外业采集流程图。Figure 1 is a flow chart of the field collection of intertidal carrier vehicles provided by the present invention.
图2为本发明提供的机载激光探测与测量***外业采集流程图。Fig. 2 is a flow chart of field collection of the airborne laser detection and measurement system provided by the present invention.
图3为本发明提供的单波束数据格式转换流程图。Fig. 3 is a flow chart of single-beam data format conversion provided by the present invention.
图4为本发明提供的数据解算流程图。Figure 4 is a flow chart of data solution provided by the present invention.
图5为本发明提供的单波束测深仪数据、激光扫描仪数据、机载激光探测与测量***数据空间整合流程图。Fig. 5 is a flow chart of spatial integration of single-beam sounder data, laser scanner data, and airborne laser detection and measurement system data provided by the present invention.
下面结合附图和具体实施例对本发明的具体实施方式做进一步说明:The specific implementation of the present invention will be further described below in conjunction with the drawings and specific embodiments:
结合图1至图5,一种空地结合的潮间带一体化测绘方法,包括测量装置,测量装置包括无人机和载体车,无人机上搭载激光探测与测量***,载体车上设置有激光扫描仪、单波束测深仪、惯性导航***和卫星定位***。With reference to Figures 1 to 5, an integrated air-to-ground intertidal zone surveying and mapping method includes a measuring device. The measuring device includes a UAV and a carrier vehicle. The UAV is equipped with a laser detection and measurement system, and the carrier vehicle is equipped with a laser. Scanner, single beam sounder, inertial navigation system and satellite positioning system.
测绘方法包括以下步骤:The surveying method includes the following steps:
步骤1:原始数据采集下载后,检查各测量仪器观测数据的完整性、正确性,进行观测数据文件的格式转换,进行各测量仪器高精度时间同步,各测量仪器数据的时、空融合,通过点云数据预处理,形成标准LAS数据文件。Step 1: After the original data is collected and downloaded, check the completeness and correctness of the observation data of each measuring instrument, convert the format of the observation data file, perform high-precision time synchronization of each measuring instrument, and integrate the time and space of the data of each measuring instrument. Point cloud data preprocessing to form standard LAS data files.
各测量仪器观测数据包括激光扫描仪数据、激光探测与测量***数据、单波束测深仪数据、惯性导航***数据和卫星定位***数据等。The observation data of each measuring instrument includes laser scanner data, laser detection and measurement system data, single beam echo sounder data, inertial navigation system data and satellite positioning system data.
具体的,步骤1包括以下子步骤:Specifically, step 1 includes the following sub-steps:
步骤1.1:如图1和图2所示,分别为载体车和机载激光探测与测量***数据采集流程图。图3为单波束数据格式转换流程图。Step 1.1: As shown in Figure 1 and Figure 2, the data acquisition flow chart of the carrier vehicle and the airborne laser detection and measurement system are respectively. Figure 3 is a flow chart of single-beam data format conversion.
利用硬件同步控制器进行各测量仪器高精度时间同步,各测量仪器数据的时、空融合,它作用是为***中的激光扫描仪、单波束测深仪等仪器提供相应的同步信号,并记录相应的时间,为后期的数据处理提供一个时间同步基准,硬件同步控制器的时间保持与卫星定位***的时间同步;硬件同步控制器控制各测量仪器的触发及监测其反馈信号,考虑到环境因素 复杂,为保证***的高可靠性,信号的传输都采用差分方式;The hardware synchronization controller is used to synchronize the high-precision time of each measuring instrument, and the time and space of the data of each measuring instrument are integrated. Its function is to provide the corresponding synchronization signal for the laser scanner, single beam sounder and other instruments in the system, and record it The corresponding time provides a time synchronization benchmark for later data processing. The time of the hardware synchronization controller is kept synchronized with the time of the satellite positioning system; the hardware synchronization controller controls the triggering of each measuring instrument and monitors its feedback signals, taking environmental factors into account Complex, in order to ensure the high reliability of the system, the signal transmission adopts the differential mode;
步骤1.2:如图4所示,利用IE进行基准站和流动站数据结算,输出POS数据;Step 1.2: As shown in Figure 4, use IE to settle the data of the base station and the rover, and output the POS data;
步骤1.3:利用VSursPROCESS软件进行点云数据预处理,形成标准LAS数据文件。Step 1.3: Use VsursPROCESS software to preprocess point cloud data to form a standard LAS data file.
步骤2:进行点云时空融合,完成从仪器坐标系到地心地固坐标系的转换。Step 2: Perform point cloud space-time fusion to complete the conversion from the instrument coordinate system to the geocentric ground-fixed coordinate system.
步骤2包括以下子步骤:Step 2 includes the following sub-steps:
步骤2.1:从激光扫描仪坐标系到载体坐标系转换;Step 2.1: Convert from the laser scanner coordinate system to the carrier coordinate system;
根据标定的公共点计算坐标系转换需要的的6参数:l
x、l
y、l
z、ω、
κ;
Calculate the 6 parameters needed for coordinate system conversion according to the calibrated common point: l x , l y , l z , ω, κ;
l
x、l
y、l
z为坐标转换过程中点坐标沿载体坐标系x轴、y轴、z轴的平移量;
l x , l y , l z are the translational amount of point coordinates along the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
ω、
κ为坐标转换过程中点坐标绕载体坐标系x轴、y轴、z轴的旋转角度;
ω, κ is the rotation angle of the point coordinate around the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;
设激光扫描仪坐标系下点坐标为
在载体坐标系下的坐标为
则有,
Let the coordinates of the point in the laser scanner coordinate system be The coordinates in the carrier coordinate system are Then there is,
其中,
代表从激光扫描仪坐标系到载体坐标系转换的旋转矩阵,R
x(ω)、
R
z(κ)分别为绕载体坐标系x轴、y轴、z轴旋转的旋转矩阵。
among them, Represents the rotation matrix transformed from the laser scanner coordinate system to the carrier coordinate system, R x (ω), R z (κ) is the rotation matrix rotating around the x-axis, y-axis, and z-axis of the carrier coordinate system.
步骤2.2:从载体坐标系到站心坐标系转换;Step 2.2: Convert from the carrier coordinate system to the station center coordinate system;
惯导坐标系前进方向为y轴、向右为x轴、向上为z轴;The forward direction of the inertial navigation coordinate system is the y-axis, the right is the x-axis, and the upward is the z-axis;
惯导记录姿态角:侧滚角Roll、俯仰角Pitch、偏航角Heading。The inertial navigation records the attitude angle: roll angle Roll, pitch angle Pitch, yaw angle Heading.
侧滚角Roll:惯导x轴与水平方向之间的夹角,载体右侧向下为正;Roll angle Roll: the angle between the x-axis of the inertial navigation and the horizontal direction, the right side of the carrier downwards is positive;
俯仰角Pitch:惯导y轴与水平方向之间的夹角,载体向上为正;Pitch angle: the angle between the y-axis of the inertial navigation and the horizontal direction, the carrier is positive upward;
偏航角Heading:惯导前进方向,即xy平面与正北方向之间的夹角,顺时针为正;Heading: the heading direction of the inertial navigation, that is, the angle between the xy plane and the true north direction, clockwise is positive;
设Roll、Pitch、Heading分别为r、p、y;设点在站心坐标系下的坐标为
载体坐标系下坐标向站心坐标系转换;
Let Roll, Pitch, Heading be r, p, y respectively; let the coordinates of the point in the station center coordinate system be Conversion of coordinates under the carrier coordinate system to the station center coordinate system;
①先绕z轴旋转y;① Rotate y around the z axis first;
②再绕x轴旋转p;② Then rotate p around the x axis;
③最后绕y轴旋转r;③Finally rotate r around the y axis;
则有,Then there is,
其中,
代表从载体坐标系到站心坐标系转换的旋转矩阵,R
x(p)、R
y(r)、R
z(y)分别为绕站心坐标系x轴、y轴、z轴旋转的旋转矩阵。
among them, Represents the rotation matrix converted from the carrier coordinate system to the station center coordinate system, R x (p), R y (r), R z (y) are the rotations around the station center coordinate system x axis, y axis, and z axis respectively matrix.
步骤2.3:从站心坐标系到地心地固坐标系转换;Step 2.3: Transform from the station center coordinate system to the geocentric ground-fixed coordinate system;
站心坐标系原点在WGS84下的经纬度分别为L和B;The latitude and longitude of the origin of the station center coordinate system under WGS84 are L and B respectively;
设扫描点在地心地固坐标系下的坐标为
站心坐标系下的坐标转换为WGS84坐标系下的坐标:
Suppose the coordinates of the scanning point in the geocentric and ground-fixed coordinate system are The coordinates in the station center coordinate system are converted to the coordinates in the WGS84 coordinate system:
③最后将站心坐标系原点平移到WGS84坐标系原点;③ Finally, the origin of the station center coordinate system is translated to the origin of the WGS84 coordinate system;
则有,Then there is,
代表从站心坐标系到地心地固坐标系转换的旋转矩阵。
Represents the rotation matrix transformed from the station-centered coordinate system to the earth-centered ground-fixed coordinate system.
其中,N代表卯酉圈曲率半径,h代表大地高,a、b代表椭球长、短半径。Among them, N represents the radius of curvature of the unitary circle, h represents the height of the earth, and a and b represent the long and short radii of the ellipsoid.
得Get
为站心坐标系原点在地心地固坐标系下的空间直角坐标;
It is the spatial rectangular coordinates of the origin of the station center coordinate system in the geocentric ground-fixed coordinate system;
最后得,Finally,
步骤3:通过获取单波束点云与激光扫描仪点云、激光扫描仪点云与机载LIDAR点云数据之间的点、线、面等几何特征来建立对应关系,求解旋转矩阵和平移量进行点云匹配。Step 3: Establish the correspondence relationship between the single-beam point cloud and the laser scanner point cloud, the laser scanner point cloud and the airborne LIDAR point cloud data, such as geometric features such as points, lines, and surfaces, and solve the rotation matrix and translation amount Perform point cloud matching.
步骤3包括:Step 3 includes:
首先介绍一下所需要的理论基础:First introduce the required theoretical basis:
平面拟合原理Plane fitting principle
已知平面方程:Known plane equation:
a′x+b′y+c′z=d (6)a′x+b′y+c′z=d (6)
且a′
2+b′
2+c′
2=1,d≥0,(x y z)是平面上的任意点;
And a′ 2 +b′ 2 +c′ 2 =1, d≥0, (x y z) is any point on the plane;
其中(a′ b′ c′)代表垂直于平面且远离坐标原点方向的方向余弦;Where (a′ b′ c′) represents the cosine of the direction perpendicular to the plane and away from the origin of the coordinates;
同样的,它也表示垂直于平面远离坐标原点的单位法向量的分量;Similarly, it also represents the component of the unit normal vector perpendicular to the plane away from the origin of the coordinate;
d表示了平面和坐标原点间的垂直距离。d represents the vertical distance between the plane and the origin of the coordinate.
最小二乘算法基本原理The basic principle of least squares algorithm
最小二乘法的思想就是估算一个最佳数学模型,求得最佳模型参数使估算模型点的值和 实际观察值的差值的平方和最小;The idea of the least square method is to estimate an optimal mathematical model, and obtain the optimal model parameters to minimize the sum of squares of the difference between the estimated model point value and the actual observation value;
在二维数据中,假设给出模型函数g(x
i),g(x
i)与真实值(x
i,y
i)的误差可用三种形式表述:
In two-dimensional data, assuming that the model function g(x i ) is given, the error between g(x i ) and the true value (x i , y i ) can be expressed in three forms:
最小二乘算法的原理便是寻找一个最佳参数模型,对于给定的数据(x
i,y
i)(i=0,1...n),误差平方和
最小;
The principle of the least squares algorithm is to find an optimal parameter model. For a given data (x i , y i ) (i=0, 1...n), the sum of squared errors The smallest
最小二乘平面拟合算法Least squares plane fitting algorithm
基于最小二乘法的平面拟合算法是在三维点云数据的基础上进行的拟合算法,以公式(6)为三维模型,确定a′,b′,c′,d四个参数使三维模型的估算值和测量值之间的差值平方和E
2最小;由于E
2是非负数,因此它存在极小值,E
2对每个参数的偏导数为零,利用偏导数为零构建的方程组便可求解出a′,b′,c′,d,并使估算值和测量值之间的差值平方和E
2最小;
The plane fitting algorithm based on the least squares method is a fitting algorithm based on three-dimensional point cloud data. Formula (6) is used as the three-dimensional model to determine the four parameters a′, b′, c′, and d to make the three-dimensional model The sum of squares of the difference between the estimated value and the measured value of E 2 is the smallest; since E 2 is a non-negative number, it has a minimum value. The partial derivative of E 2 for each parameter is zero. An equation constructed with a partial derivative of zero The group can solve for a′, b′, c′, d, and minimize the sum of squared differences E 2 between the estimated value and the measured value;
假设点云数据的点集为{p
i|p
i∈oxyz,i=1,2,3...,N},其中x
i和y
i设为无误差变化的自变量,z
i是包含误差的因变量,则z和x、y的函数相关性可以假设为函数表达式:
Suppose the point set of the point cloud data is {p i |p i ∈ oxyz,i=1, 2, 3...,N}, where x i and y i are set as independent variables without error change, and z i is the inclusion The dependent variable of the error, the functional correlation between z and x and y can be assumed as a functional expression:
z=f(x,y;p,q,r)=p+qx+ry (7)z=f(x,y;p,q,r)=p+qx+ry (7)
且其中的p,q,r可以通过最小二乘算法得到;And the p, q, r can be obtained by the least square algorithm;
根据公式(6)、(7),令d=c′p,a′=-qc′,b′=-rc′且
则公式(7)可以描述为平面方程;
According to formulas (6) and (7), let d=c′p, a′=-qc′, b′=-rc′ and Then formula (7) can be described as a plane equation;
根据上述定义f函数的公式,假如自变量的值为x
i和y
i,被测量值z应该为p+qx
i+ry
i,然而因为误差的存在测量值z为z
i,则第i个点的测量误差为:
According to the above formula defining the f function, if the values of the independent variables are x i and y i , the measured value z should be p+qx i +ry i , but because of the error, the measured value z is z i , then the i-th The measurement error of the point is:
e
i=f(x
i,y
i;p,q,r)-z
i (8)
e i =f(x i ,y i ; p,q,r)-z i (8)
根据最小二乘的原理,p,q,r应该满足公式(8)的平方和最小,即E
2最小:
According to the principle of least squares, p, q, r should satisfy the minimum sum of squares of formula (8), that is, E 2 is minimum:
若使得E
2最小,应满足:
If E 2 is minimized, it should satisfy:
即:which is:
有:Have:
根据公式(11)可以求解出p,q,r,同样的,公式(6)中a′,b′,c′,d四个参数也就可通过d=c′p,a′=-qc′,b′=-rc′,
求出。
According to formula (11), p, q, r can be solved. Similarly, the four parameters of a′, b′, c′, d in formula (6) can also be solved by d=c′p, a′=-qc ′, b′=-rc′, Find out.
求解旋转矩阵Solve the rotation matrix
在上述算法的计算过程中,提取3对以上对应的平面特征量后,需要求取其各自的平面法向量;In the calculation process of the above algorithm, after extracting more than 3 pairs of corresponding plane feature quantities, it is required to take their respective plane normal vectors;
假设求解的一对平面为a
1x+b
1y+z=d
1和a
2x+b
2y+z=d
2,则其法向量对可表示为P=(a
1,b
1,-1)、Q=(a
2,b
2,-1),法向量的旋转矩阵R满足P=RQ,采用罗德里格旋转法求解;上述P,Q矩阵,其夹角为:
Assuming that a pair of planes to be solved is a 1 x+b 1 y+z=d 1 and a 2 x+b 2 y+z=d 2 , the normal vector pair can be expressed as P=(a 1 ,b 1 , -1), Q=(a 2 ,b 2 ,-1), the rotation matrix R of the normal vector satisfies P=RQ and is solved by the Rodrigue rotation method; the above P and Q matrix, the included angle is:
P,Q矩阵的叉乘为:The cross product of P and Q matrices is:
若已知单位向量
利用法向量将其旋转θ角度后,根据罗德里格旋转法求解其三维旋转矩阵为:
If the unit vector is known After the normal vector is used to rotate it by the angle θ, the three-dimensional rotation matrix is solved according to the Rodrigue rotation method as:
求解平移量Solve for translation
利用三维变换矩阵C
1可以对点云数据进行旋转,相应的平面特征量对相互平行,在两片点云数据中寻找一对以上的特征点,或利用对应面的的质心坐标的差值,计算点云数据的平移量即:
Using the three-dimensional transformation matrix C 1 to rotate the point cloud data, the corresponding plane feature pairs are parallel to each other, find more than one pair of feature points in two pieces of point cloud data, or use the difference between the centroid coordinates of the corresponding planes, Calculate the translation amount of point cloud data:
当然,上述说明并非是对本发明的限制,本发明也并不仅限于上述举例,本技术领域的技术人员在本发明的实质范围内所做出的变化、改型、添加或替换,也应属于本发明的保护范围。Of course, the above description is not a limitation of the present invention, and the present invention is not limited to the above examples. Changes, modifications, additions or substitutions made by those skilled in the art within the essential scope of the present invention shall also belong to the present invention. The scope of protection of the invention.
Claims (4)
- 一种空地结合的潮间带一体化测绘方法,其特征在于,包括测量装置,测量装置包括无人机和载体车,无人机上搭载激光探测与测量***,载体车上设置有激光扫描仪、单波束测深仪、惯性导航***和卫星定位***;An air-ground integrated intertidal zone surveying and mapping method is characterized by comprising a measuring device, the measuring device includes an unmanned aerial vehicle and a carrier vehicle, the unmanned aerial vehicle is equipped with a laser detection and measurement system, and the carrier vehicle is equipped with a laser scanner, Single beam depth sounder, inertial navigation system and satellite positioning system;测绘方法包括以下步骤:The surveying method includes the following steps:步骤1:原始数据采集下载后,检查各测量仪器观测数据的完整性、正确性,进行观测数据文件的格式转换,进行各测量仪器高精度时间同步,各测量仪器数据的时、空融合,通过点云数据预处理,形成标准LAS数据文件;Step 1: After the original data is collected and downloaded, check the completeness and correctness of the observation data of each measuring instrument, convert the format of the observation data file, perform high-precision time synchronization of each measuring instrument, and integrate the time and space of the data of each measuring instrument. Point cloud data preprocessing to form standard LAS data files;步骤2:进行点云时空融合,完成从仪器坐标系到地心地固坐标系的转换;Step 2: Perform point cloud space-time fusion and complete the conversion from the instrument coordinate system to the geocentric ground-fixed coordinate system;步骤3:通过获取单波束点云与激光扫描仪点云、激光扫描仪点云与机载LIDAR点云数据之间的点、线、面等几何特征来建立对应关系,求解旋转矩阵和平移量进行点云匹配。Step 3: Establish the correspondence relationship between the single-beam point cloud and the laser scanner point cloud, the laser scanner point cloud and the airborne LIDAR point cloud data, such as geometric features such as points, lines, and surfaces, and solve the rotation matrix and translation amount Perform point cloud matching.
- 根据权利要求1所述的一种空地结合的潮间带一体化测绘方法,其特征在于,所述步骤1包括以下子步骤:The method for integrated surveying and mapping of the intertidal zone combined with air and ground according to claim 1, wherein said step 1 comprises the following sub-steps:步骤1.1:利用硬件同步控制器进行各测量仪器高精度时间同步,各测量仪器数据的时、空融合,硬件同步控制器的时间保持与卫星定位***的时间同步;硬件同步控制器控制各测量仪器的触发及监测其反馈信号,信号的传输都采用差分方式;Step 1.1: Use the hardware synchronization controller to synchronize the high-precision time of each measuring instrument, the time and space of the data of each measuring instrument are integrated, and the time of the hardware synchronization controller is synchronized with the time of the satellite positioning system; the hardware synchronization controller controls each measuring instrument Trigger and monitor its feedback signal, signal transmission adopts differential mode;步骤1.2:利用IE进行基准站和流动站数据结算,输出POS数据;Step 1.2: Use IE to settle the data of base station and rover, and output POS data;步骤1.3:利用VSursPROCESS软件进行点云数据预处理,形成标准LAS数据文件。Step 1.3: Use VsursPROCESS software to preprocess point cloud data to form a standard LAS data file.
- 根据权利要求1所述的一种空地结合的潮间带一体化测绘方法,其特征在于,所述步骤2包括以下子步骤:The method for integrated surveying and mapping of intertidal zone combined with air and ground according to claim 1, wherein said step 2 includes the following sub-steps:步骤2.1:从激光扫描仪坐标系到载体坐标系转换;Step 2.1: Convert from the laser scanner coordinate system to the carrier coordinate system;根据标定的公共点计算坐标系转换需要的的6参数:l x、l y、l z、ω、 κ; Calculate the 6 parameters needed for coordinate system conversion according to the calibrated common point: l x , l y , l z , ω, κ;l x、l y、l z分别为坐标转换过程中点坐标沿载体坐标系x轴、y轴、z轴的平移量; l x , l y , and l z are the translational amounts of the point coordinates along the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;ω、 κ分别为坐标转换过程中点坐标绕载体坐标系x轴、y轴、z轴的旋转角度; ω, κ is the rotation angle of the point coordinate around the x-axis, y-axis and z-axis of the carrier coordinate system during the coordinate conversion process;设激光扫描仪坐标系下点坐标为 在载体坐标系下的坐标为 则有, Let the coordinates of the point in the laser scanner coordinate system be The coordinates in the carrier coordinate system are Then there is,其中, 代表从激光扫描仪坐标系到载体坐标系转换的旋转矩阵,R x(ω)、 R z(κ)分别为绕载体坐标系x轴、y轴、z轴旋转的旋转矩阵; among them, Represents the rotation matrix transformed from the laser scanner coordinate system to the carrier coordinate system, R x (ω), R z (κ) is the rotation matrix rotating around the x-axis, y-axis, and z-axis of the carrier coordinate system;步骤2.2:从载体坐标系到站心坐标系转换;Step 2.2: Convert from the carrier coordinate system to the station center coordinate system;惯导坐标系前进方向为y轴、向右为x轴、向上为z轴;The forward direction of the inertial navigation coordinate system is the y-axis, the right is the x-axis, and the upward is the z-axis;惯导记录姿态角:侧滚角Roll、俯仰角Pitch、偏航角Heading;Inertial navigation records the attitude angle: roll angle Roll, pitch angle Pitch, yaw angle Heading;侧滚角Roll:惯导x轴与水平方向之间的夹角,载体右侧向下为正;Roll angle Roll: the angle between the x-axis of the inertial navigation and the horizontal direction, the right side of the carrier downwards is positive;俯仰角Pitch:惯导y轴与水平方向之间的夹角,载体向上为正;Pitch angle: the angle between the y-axis of the inertial navigation and the horizontal direction, the carrier is positive upward;偏航角Heading:惯导前进方向,即xy平面与正北方向之间的夹角,顺时针为正;Heading: the heading direction of the inertial navigation, that is, the angle between the xy plane and the true north direction, clockwise is positive;设Roll、Pitch、Heading分别为r、p、y;设点在站心坐标系下的坐标为 载体坐标系下坐标向站心坐标系转换; Let Roll, Pitch, Heading be r, p, y respectively; let the coordinates of the point in the station center coordinate system be Conversion of coordinates under the carrier coordinate system to the station center coordinate system;①先绕z轴旋转y;① Rotate y around the z axis first;②再绕x轴旋转p;② Then rotate p around the x axis;③最后绕y轴旋转r;③Finally rotate r around the y axis;则有,Then there is,其中, 代表从载体坐标系到站心坐标系转换的旋转矩阵,R x(p)、R y(r)、R z(y)分别为绕站心坐标系x轴、y轴、z轴旋转的旋转矩阵; among them, Represents the rotation matrix converted from the carrier coordinate system to the station center coordinate system, R x (p), R y (r), R z (y) are the rotations around the station center coordinate system x axis, y axis, and z axis respectively matrix;步骤2.3:从站心坐标系到地心地固坐标系转换;Step 2.3: Transform from the station center coordinate system to the geocentric ground-fixed coordinate system;站心坐标系原点在WGS84下的经纬度分别为L和B;The latitude and longitude of the origin of the station center coordinate system under WGS84 are L and B respectively;设扫描点在地心地固坐标系下的坐标为 站心坐标系下的坐标转换为WGS84坐标系下的坐标: Suppose the coordinates of the scanning point in the geocentric and ground-fixed coordinate system are The coordinates in the station center coordinate system are converted to the coordinates in the WGS84 coordinate system:③最后将站心坐标系原点平移到WGS84坐标系原点;③ Finally, the origin of the station center coordinate system is translated to the origin of the WGS84 coordinate system;则有,Then there is,其中, 代表从站心坐标系到地心地固坐标系转换的旋转矩阵; among them, Represents the rotation matrix transformed from the station-centered coordinate system to the earth-centered ground-fixed coordinate system;其中,N代表卯酉圈曲率半径,h代表大地高,a、b代表椭球长、短半径;Among them, N represents the radius of curvature of the unitary circle, h represents the height of the earth, and a and b represent the length and short radius of the ellipsoid;得Get为站心坐标系原点在地心地固坐标系下的空间直角坐标; It is the spatial rectangular coordinates of the origin of the station center coordinate system in the geocentric ground-fixed coordinate system;最后得,Finally,
- 根据权利要求1所述的一种空地结合的潮间带一体化测绘方法,其特征在于,所述步骤3包括:The method for integrated surveying and mapping of intertidal zone combined with air and ground according to claim 1, wherein the step 3 comprises:首先介绍一下所需要的理论基础:First introduce the required theoretical basis:平面拟合原理Plane fitting principle已知平面方程:a′x+b′y+c′z=d (6)Known plane equation: a′x+b′y+c′z=d (6)且a′ 2+b′ 2+c′ 2=1,d≥0,(x y z)是平面上的任意点; And a′ 2 +b′ 2 +c′ 2 =1, d≥0, (x y z) is any point on the plane;其中,(a′ b′ c′)代表垂直于平面且远离坐标原点方向的方向余弦;Among them, (a′ b′ c′) represents the cosine of the direction perpendicular to the plane and away from the coordinate origin;同样的,它也表示垂直于平面远离坐标原点的单位法向量的分量;Similarly, it also represents the component of the unit normal vector perpendicular to the plane away from the origin of the coordinate;d表示了平面和坐标原点间的垂直距离;d represents the vertical distance between the plane and the origin of the coordinate;最小二乘算法基本原理The basic principle of least squares algorithm最小二乘法的思想就是估算一个最佳数学模型,求得最佳模型参数使估算模型点的值和实际观察值的差值的平方和最小;The idea of the least squares method is to estimate an optimal mathematical model, and obtain the optimal model parameters to minimize the sum of squares of the difference between the estimated model point value and the actual observation value;在二维数据中,假设给出模型函数g(x i),g(x i)与真实值(x i,y i)的误差可用三种形式表述: In two-dimensional data, assuming that the model function g(x i ) is given, the error between g(x i ) and the true value (x i , y i ) can be expressed in three forms:最小二乘算法的原理便是寻找一个最佳参数模型,对于给定的数据(x i,y i)(i=0,1…n),误差平方和 最小; The principle of the least squares algorithm is to find an optimal parameter model. For a given data (x i , y i ) (i=0, 1...n), the sum of squared errors The smallest最小二乘平面拟合算法Least squares plane fitting algorithm基于最小二乘法的平面拟合算法是在三维点云数据的基础上进行的拟合算法,以公式(6)为三维模型,确定a′,b′,c′,d四个参数使三维模型的估算值和测量值之间的差值平方和E 2最小;由于E 2是非负数,因此它存在极小值,E 2对每个参数的偏导数为零,利用偏导数为零构建的方程组便可求解出a′,b′,c′,d,并使估算值和测量值之间的差值平方和E 2最小; The plane fitting algorithm based on the least squares method is a fitting algorithm based on three-dimensional point cloud data. Formula (6) is used as the three-dimensional model to determine the four parameters a′, b′, c′, and d to make the three-dimensional model The sum of squares of the difference between the estimated value and the measured value of E 2 is the smallest; since E 2 is a non-negative number, it has a minimum value. The partial derivative of E 2 for each parameter is zero. An equation constructed with a partial derivative of zero The group can solve for a′, b′, c′, d, and minimize the sum of squared differences E 2 between the estimated value and the measured value;假设点云数据的点集为{p i|p i∈oxyz,i=1,2,3...,N},其中x i和y i设为无误差变化的自变量,z i是包含误差的因变量,则z和x、y的函数相关性可以假设为函数表达式: Suppose the point set of the point cloud data is {p i |p i ∈ oxyz,i=1, 2, 3...,N}, where x i and y i are set as independent variables without error change, and z i is the inclusion The dependent variable of the error, the functional correlation between z and x and y can be assumed as a functional expression:z=f(x,y;p,q,r)=p+qx+ry (7)z=f(x,y;p,q,r)=p+qx+ry (7)且其中的p,q,r可以通过最小二乘算法得到;And the p, q, r can be obtained by the least square algorithm;根据公式(6)、(7),令d=c′p,a′=-qc′,b′=-rc′且 则公式(7) 可以描述为平面方程; According to formulas (6) and (7), let d=c′p, a′=-qc′, b′=-rc′ and Then formula (7) can be described as a plane equation;根据上述定义f函数的公式,假如自变量的值为x i和y i,被测量值z应该为p+qx i+ry i,然而因为误差的存在测量值z为z i,则第i个点的测量误差为: According to the above formula defining the f function, if the values of the independent variables are x i and y i , the measured value z should be p+qx i +ry i , but because of the error, the measured value z is z i , then the i-th The measurement error of the point is:e i=f(x i,y i;p,q,r)-z i (8) e i =f(x i ,y i ; p,q,r)-z i (8)根据最小二乘的原理,p,q,r应该满足公式(8)的平方和最小,即E 2最小: According to the principle of least squares, p, q, r should satisfy the minimum sum of squares of formula (8), that is, E 2 is minimum:若使得E 2最小,应满足: If E 2 is minimized, it should satisfy:即:which is:有:Have:根据公式(11)可以求解出p,q,r,同样的,公式(6)中a′,b′,c′,d四个参数也就可通过d=c′p,a′=-qc′,b′=-rc′, 求出; According to formula (11), p, q, r can be solved. Similarly, the four parameters of a′, b′, c′, d in formula (6) can also be solved by d=c′p, a′=-qc ′, b′=-rc′, Find out求解旋转矩阵Solve the rotation matrix在上述算法的计算过程中,提取3对以上对应的平面特征量后,需要求取其各自的平面法向量;In the calculation process of the above algorithm, after extracting more than 3 pairs of corresponding plane feature quantities, it is required to take their respective plane normal vectors;假设求解的一对平面为a 1x+b 1y+z=d 1和a 2x+b 2y+z=d 2,则其法向量对可表示为P=(a 1,b 1,-1)、Q=(a 2,b 2,-1),法向量的旋转矩阵R满足P=RQ,采用罗德里格旋转法求解;上述P,Q矩阵,其夹角为: Assuming that a pair of planes to be solved is a 1 x+b 1 y+z=d 1 and a 2 x+b 2 y+z=d 2 , the normal vector pair can be expressed as P=(a 1 ,b 1 , -1), Q=(a 2 ,b 2 ,-1), the rotation matrix R of the normal vector satisfies P=RQ and is solved by the Rodrigue rotation method; the above P and Q matrix, the included angle is:P,Q矩阵的叉乘为:The cross product of P and Q matrices is:若已知单位向量 利用法向量将其旋转θ角度后,根据罗德里格旋转法求解其三维旋转矩阵为: If the unit vector is known After the normal vector is used to rotate it by the angle θ, the three-dimensional rotation matrix is solved according to the Rodrigue rotation method as:求解平移量Solve for translation利用三维变换矩阵C 1可以对点云数据进行旋转,相应的平面特征量对相互平行,在两片点云数据中寻找一对以上的特征点,或利用对应面的的质心坐标的差值,计算点云数据的平移量即: Using the three-dimensional transformation matrix C 1 to rotate the point cloud data, the corresponding plane feature pairs are parallel to each other, find more than one pair of feature points in two pieces of point cloud data, or use the difference between the centroid coordinates of the corresponding planes, Calculate the translation amount of point cloud data:
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910056969.3A CN109631863A (en) | 2019-01-22 | 2019-01-22 | A kind of intertidal zone integration mapping method that vacant lot combines |
CN201910056969.3 | 2019-01-22 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020151213A1 true WO2020151213A1 (en) | 2020-07-30 |
Family
ID=66062911
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2019/098770 WO2020151213A1 (en) | 2019-01-22 | 2019-08-01 | Air and ground combined intertidal zone integrated mapping method |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109631863A (en) |
WO (1) | WO2020151213A1 (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110046211A (en) * | 2019-04-16 | 2019-07-23 | 重庆市地理信息中心 | Surveying and mapping result catalogue based on semantic integrity automaticly inspects and storage dissemination method |
CN110516304B (en) * | 2019-07-26 | 2023-05-02 | 同济大学 | Indoor space modeling method |
CN114018293B (en) * | 2021-11-19 | 2024-03-15 | 中交第一航务工程局有限公司 | Precision detection method of multi-beam sounding system |
CN114018230B (en) * | 2021-12-15 | 2022-07-05 | 山东柏远复合材料科技股份有限公司 | Air-ground integrated three-dimensional surveying and mapping device |
CN114739369B (en) * | 2022-03-09 | 2023-05-23 | 中铁大桥勘测设计院集团有限公司 | Beach mapping method and equipment based on unmanned aerial vehicle aerial survey and sounding instrument underwater measurement |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5467122A (en) * | 1991-10-21 | 1995-11-14 | Arete Associates | Underwater imaging in real time, using substantially direct depth-to-display-height lidar streak mapping |
US20120020527A1 (en) * | 2010-07-21 | 2012-01-26 | Ron Abileah | Methods for mapping depth and surface current |
CN103711050A (en) * | 2013-12-31 | 2014-04-09 | 中交第二公路勘察设计研究院有限公司 | Laser radar road reconstruction and expansion exploratory survey design method |
CN105352476A (en) * | 2015-11-23 | 2016-02-24 | 青岛秀山移动测量有限公司 | Shipborne water bank line overwater and underwater integrated measurement system integrated method |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8089390B2 (en) * | 2006-05-16 | 2012-01-03 | Underground Imaging Technologies, Inc. | Sensor cart positioning system and method |
JP2012032273A (en) * | 2010-07-30 | 2012-02-16 | Ministry Of Land Infrastructure & Transport Hokkaido Regional Development Bureau | Harbor structure measuring device |
CN104050474A (en) * | 2014-06-10 | 2014-09-17 | 上海海洋大学 | Method for automatically extracting island shoreline based on LiDAR data |
CN106643671B (en) * | 2016-12-01 | 2019-04-09 | 江苏省测绘工程院 | A kind of underwater cloud denoising method based on airborne LiDAR sounding system |
CN108120987A (en) * | 2017-12-21 | 2018-06-05 | 云南大学 | The underwater river topography measuring device and measuring method of a kind of great rivers |
CN108919274B (en) * | 2018-04-11 | 2022-06-14 | 华南理工大学 | Shallow water wave following scanning detection system based on single wave beam and working method thereof |
-
2019
- 2019-01-22 CN CN201910056969.3A patent/CN109631863A/en active Pending
- 2019-08-01 WO PCT/CN2019/098770 patent/WO2020151213A1/en active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5467122A (en) * | 1991-10-21 | 1995-11-14 | Arete Associates | Underwater imaging in real time, using substantially direct depth-to-display-height lidar streak mapping |
US20120020527A1 (en) * | 2010-07-21 | 2012-01-26 | Ron Abileah | Methods for mapping depth and surface current |
CN103711050A (en) * | 2013-12-31 | 2014-04-09 | 中交第二公路勘察设计研究院有限公司 | Laser radar road reconstruction and expansion exploratory survey design method |
CN105352476A (en) * | 2015-11-23 | 2016-02-24 | 青岛秀山移动测量有限公司 | Shipborne water bank line overwater and underwater integrated measurement system integrated method |
Also Published As
Publication number | Publication date |
---|---|
CN109631863A (en) | 2019-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020151213A1 (en) | Air and ground combined intertidal zone integrated mapping method | |
CN107167786B (en) | Method for auxiliary extraction of elevation control points from satellite laser height measurement data | |
CN101551455B (en) | 3D terrain imaging system of interferometric synthetic aperture radar and elevation mapping method thereof | |
Singh et al. | Microbathymetric mapping from underwater vehicles in the deep ocean | |
CN108983232B (en) | InSAR two-dimensional surface deformation monitoring method based on adjacent rail data | |
CN105352476A (en) | Shipborne water bank line overwater and underwater integrated measurement system integrated method | |
CN111522005A (en) | Deformation monitoring and terrain reconstruction method | |
CN114689015B (en) | Method for improving elevation precision of optical satellite stereoscopic image DSM | |
CN111694012A (en) | Three-dimensional terrain online generation method and system based on airborne laser radar | |
Fabris et al. | High resolution topographic model of Panarea Island by fusion of photogrammetric, lidar and bathymetric digital terrain models | |
CN105488852A (en) | Three-dimensional image splicing method based on geography coding and multidimensional calibration | |
CN115755071A (en) | Deep sea in-situ fine detection frame design method based on acousto-optic remote sensing and VR technology | |
CN112050793A (en) | WorldView-2 three-dimensional double-medium water depth detection method | |
CN116027349A (en) | Coral reef substrate classification method based on laser radar and side scan sonar data fusion | |
CN111487621A (en) | Sea surface flow field inversion method based on radar image and electronic equipment | |
CN114234932A (en) | Underwater conductor measuring method and device for obtaining data of subsea control point | |
Li et al. | Improve the ZY-3 height accuracy using ICESat/GLAS laser altimeter data | |
CN117538873A (en) | SAR (synthetic aperture radar) offshore target positioning method and system based on Doppler displacement estimation | |
CN116105685A (en) | Intertidal zone topography seamless integrated measurement method based on acousto-optic remote sensing and rollers | |
Kuang et al. | Robust constrained Kalman filter algorithm considering time registration for GNSS/acoustic joint positioning | |
CN116106925A (en) | Method for calculating underwater sounding point coordinates of laser radar by using rigorous photon counting mechanism | |
Prempraneerach et al. | Hydrographical survey using point cloud data from laser scanner and echo sounder | |
CN111856464B (en) | DEM extraction method of vehicle-mounted SAR (synthetic aperture radar) based on single control point information | |
CN113238202A (en) | Coordinate system point cloud computing method of photon laser three-dimensional imaging system and application thereof | |
Dowman | The geometry of SAR images for geocoding and stereo applications |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 19911215 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 19911215 Country of ref document: EP Kind code of ref document: A1 |