CN113959437A - 一种用于移动测量设备的测量方法及系统 - Google Patents

一种用于移动测量设备的测量方法及系统 Download PDF

Info

Publication number
CN113959437A
CN113959437A CN202111200112.8A CN202111200112A CN113959437A CN 113959437 A CN113959437 A CN 113959437A CN 202111200112 A CN202111200112 A CN 202111200112A CN 113959437 A CN113959437 A CN 113959437A
Authority
CN
China
Prior art keywords
data
point cloud
cloud data
imu
gnss
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.)
Pending
Application number
CN202111200112.8A
Other languages
English (en)
Inventor
黄志�
向煜
罗再谦
罗斌
李奎君
刘寓
张俊
朱勃
张彦
王军涛
王翔
陈汉
黄令
唐时荞
何波
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
CHONGQING CYBERCITY SCI-TECH CO LTD
Original Assignee
CHONGQING CYBERCITY SCI-TECH CO LTD
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by CHONGQING CYBERCITY SCI-TECH CO LTD filed Critical CHONGQING CYBERCITY SCI-TECH CO LTD
Priority to CN202111200112.8A priority Critical patent/CN113959437A/zh
Publication of CN113959437A publication Critical patent/CN113959437A/zh
Pending legal-status Critical Current

Links

Images

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/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
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
    • 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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
    • G06T17/05—Geographic models
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T5/00—Image enhancement or restoration
    • G06T5/20—Image enhancement or restoration using local operators
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T5/00—Image enhancement or restoration
    • G06T5/70—Denoising; Smoothing
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/30—Determination of transform parameters for the alignment of images, i.e. image registration
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/10—Image acquisition modality
    • G06T2207/10028—Range image; Depth image; 3D point clouds

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Theoretical Computer Science (AREA)
  • Software Systems (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Mathematical Physics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Data Mining & Analysis (AREA)
  • Electromagnetism (AREA)
  • Computational Mathematics (AREA)
  • Geometry (AREA)
  • Mathematical Analysis (AREA)
  • Computing Systems (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Computer Graphics (AREA)
  • Algebra (AREA)
  • Automation & Control Theory (AREA)
  • Databases & Information Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Traffic Control Systems (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本发明涉及移动测量技术领域，具体涉及一种用于移动测量设备的测量方法及系统；该方法包括：通过激光雷达获取点云数据，对获取的点云数据进行去噪；基于GNSS传感器获取位置信息；基于IMU传感器获取的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变；采用NDT算法配准点云数据；在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标。本方法克服移动测量设备在移动或无卫星定位数据时采集的数据不精准的问题。

Description

一种用于移动测量设备的测量方法及系统
技术领域
本发明涉及移动测量技术领域，具体涉及一种用于移动测量设备的测量方法及系统。
背景技术
激光雷达是一种快速获取物体表面三维点云数据的技术，已成为高时空分辨率三维对地观测的一种主要技术手段，在基础测绘、智慧城市、资源调查、高精度地图等领域发挥越来越重要的作用。从数据获取平台而言，包括卫星平台、机载平台、车载平台、地面/背负式平台等等。
现有的激光扫描装置由于仅能扫描一个平面区域的目标区域，而不能扫描整个三维空间的区域。在应用到三维数字模型的构建系统时，需要结合全球卫星导航系统以及惯性测量单元进行集成和数据融合，而全球卫星导航系统具有信号因素的局限性，限制了其系统的使用环境，使得移动测量设备在移动以及无卫星信息时，数据采集仍存在不精准的情况。
发明内容
针对上述现有技术的不足，本发明所要解决的问题是：如何提供一种用于移动测量设备的测量方法及系统，以解决现有激光雷达在移动测量、无卫星信号时，采集数据不精准的问题。
为了解决上述问题，本发明采用了如下的技术方案：
一种用于移动测量设备的测量方法，包括
1)通过设置于移动测量设备上的GNSS天线正前方的激光雷达获取点云数据，对获取的点云数据进行去噪；
2)基于GNSS传感器获取移动测量设备的位置信息；基于设置于移动测量设备后轴上方位置的IMU传感器获取移动测量设备的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；
3)使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变；
4)采用NDT算法配准点云数据；
5)在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标。
进一步，所述步骤1)对获取的点云数据进行去噪包括：通过半径滤波器从点云数据中去除离群点；通过直通滤波器去除车身的点云数据；采用Voxel Grid体素网络滤波器进行下采样；所述采用Voxel Grid体素网络滤波器进行下采样具体步骤为：
将点云数据表示的空间划分为多个边长相等的三维立方体，使用每个体素的质心作为近似值替代所述三维立方体；若体素内总共有N个激光点，每个激光点分别使用pi＝(xi,yi,zi)表示，则近似的质心为
Figure BDA0003304593860000021
进一步，所述步骤2)中对GNSS、IMU和激光雷达传感器数据同步包括数据时间同步和数据空间同步；
所述数据时间同步包括：采用PPS+NMEZ协议进行GNSS、IMU和激光雷达传感器的时钟源同步；选用多个容器分别存储GNSS、IMU和激光雷达传感器的读取数据，并以激光雷达传感器的时间戳作为基准，GNSS、IMU传感器的读取数据根据该基准的时间戳获得该时间戳前两帧的数据，然后通过插值法对数据进行比例计算，得到相同时刻的传感器数据；
所述数据空间同步包括：将GNSS传感器数据转换到UTM坐标系下，以IMU传感器安装位置为坐标系原点，建立GNSS传感器数据和IMU传感器数据的Z轴坐标变换，再建立与激光雷达坐标系的平移变换和俯仰变换，完成数据空间同步。
进一步，所述步骤4)中采用NDT算法配准点云数据包括：
将点云数据划分为N个边长相等的立方体，通过下式计算均值μi和协方差∑i：
Figure BDA0003304593860000031
Figure BDA0003304593860000032
其中，mi为第i个立方体中数据点的数量，xij为第i个立方体中的第j点；
将变换参数p初始化为单位矩阵，将待配准点云集合中所有点按变换T进行变换，并转换到参考点云的立方体中，得到新的点云
Figure BDA0003304593860000033
根据下式计算按正太分布得到配准点经过变换后与参考点云的重合程度：
Figure BDA0003304593860000041
将所有立方体网格计算出来的概率密度相加得到配准得分，使用牛顿优化算法找到最高配准得分下的最佳变换参数p，并以最佳变换参数p进行点云数据配准。
进一步，所述步骤5)中融合IMU方法获取移动测量设备的位姿包括：使用IMU数据进行状态预测得到预测的移动测量设备位置数据位姿，在将其作为初始值输入到扫描匹配中，通过观测到的点云数据与离线地图进行配准得到观测的移动测量设备位姿，再进行状态更新，得到最优移动测量设备位姿。
本发明还提供一种用于移动测量设备的测量系统，包括
点云数据获取处理模块：用于通过设置于移动测量设备上的GNSS天线正前方的激光雷达获取点云数据，对获取的点云数据进行去噪；
信息获取同步模块，用于基于GNSS传感器获取移动测量设备的位置信息；基于设置于移动测量设备后轴上方位置的IMU传感器获取移动测量设备的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；
点云数据畸变去除模块，用于使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变；
点云数据配准模块，用于采用NDT算法配准点云数据；
点云数据绝对坐标生成模块，用于在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标。
进一步，所述点云数据获取处理模块包括离群点去除单元、车身点云数据去除单元和下采样单元；
所述离群点去除单元用于通过半径滤波器从点云数据中去除离群点；
所述车身点云数据去除单元用于通过直通滤波器去除车身的点云数据；
所述下采样单元采用Voxel Grid体素网络滤波器进行下采样，具体步骤为：
将点云数据表示的空间划分为多个边长相等的三维立方体，使用每个体素的质心作为近似值替代所述三维立方体；若体素内总共有N个激光点，每个激光点分别使用pi＝(xi,yi,zi)表示，则近似的质心为
Figure BDA0003304593860000051
进一步，所述信息获取同步模块包括数据时间同步单元和数据空间同步单元；
所述数据时间同步单元用于对GNSS、IMU和激光雷达传感器数据同步包括数据时间同步；采用PPS+NMEZ协议进行GNSS、IMU和激光雷达传感器的时钟源同步；选用多个容器分别存储GNSS、IMU和激光雷达传感器的读取数据，并以激光雷达传感器的时间戳作为基准，GNSS、IMU传感器的读取数据根据该基准的时间戳获得该时间戳前两帧的数据，然后通过插值法对数据进行比例计算，得到相同时刻的传感器数据；
所述数据空间同步单元用于对GNSS、IMU和激光雷达传感器数据同步包括数据空间同步；将GNSS传感器数据转换到UTM坐标系下，以IMU传感器安装位置为坐标系原点，建立GNSS传感器数据和IMU传感器数据的Z轴坐标变换，再建立与激光雷达坐标系的平移变换和俯仰变换，完成数据空间同步。
进一步，所述点云数据配准模块用于将点云数据划分为N个边长相等的立方体，通过下式计算均值μi和协方差∑i：
Figure BDA0003304593860000061
Figure BDA0003304593860000062
其中，mi为第i个立方体中数据点的数量，xij为第i个立方体中的第j点；
将变换参数p初始化为单位矩阵，将待配准点云集合中所有点按变换T进行变换，并转换到参考点云的立方体中，得到新的点云
Figure BDA0003304593860000063
根据下式计算按正太分布得到配准点经过变换后与参考点云的重合程度：
Figure BDA0003304593860000064
将所有立方体网格计算出来的概率密度相加得到配准得分，使用牛顿优化算法找到最高配准得分下的最佳变换参数p，并以最佳变换参数p进行点云数据配准。
进一步，所述点云数据绝对坐标生成模块包括移动测量设备位姿融合IMU方法获取单元；所述移动测量设备位姿融合IMU方法获取单元用于使用IMU数据进行状态预测得到预测的移动测量设备位置数据位姿，在将其作为初始值输入到扫描匹配中，通过观测到的点云数据与离线地图进行配准得到观测的移动测量设备位姿，再进行状态更新，得到最优移动测量设备位姿。
本发明的有益效果在于：本发明通过半径滤波器从点云数据中去除离群点；通过直通滤波器去除车身的点云数据；采用Voxel Grid体素网络滤波器进行下采样并对GNSS、IMU和激光雷达传感器数据进行同步，使得采集的数据更为精确，进一步利用离线地图与融合IMU方法对无GNSS信号时避免移动采集数据偏差的情况，生成高精点云数据，可构建三维建模以及生成点云地图，为自动采集技术打下基础。
附图说明
为了使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明作进一步的详细描述，其中：
图1为本发明一种用于移动测量设备的测量方法流程示意图；
图2为本发明一种用于移动测量设备的测量系统示意图。
具体实施方式
下面结合具体实施例对本发明作进一步的详细说明。
需要说明的是，这些实施例仅用于说明本发明，而不是对本发明的限制，在本发明的构思前提下本方法的简单改进，都属于本发明要求保护的范围。
参见图1，本发明实施例提供一种用于移动测量设备的测量方法，包括
1)通过设置于移动测量设备上的GNSS天线正前方的激光雷达获取点云数据，对获取的点云数据进行去噪；
对获取的点云数据进行去噪包括：通过半径滤波器从点云数据中去除离群点；通过直通滤波器去除车身的点云数据；采用Voxel Grid体素网络滤波器进行下采样；所述采用Voxel Grid体素网络滤波器进行下采样具体步骤为：
将点云数据表示的空间划分为多个边长相等的三维立方体，使用每个体素的质心作为近似值替代所述三维立方体；若体素内总共有N个激光点，每个激光点分别使用pi＝(xi,yi,zi)表示，则近似的质心为
Figure BDA0003304593860000081
2)基于GNSS传感器获取移动测量设备的位置信息；基于设置于移动测量设备后轴上方位置的IMU传感器获取移动测量设备的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；
对GNSS、IMU和激光雷达传感器数据同步包括数据时间同步和数据空间同步；
数据时间同步包括：采用PPS+NMEZ协议进行GNSS、IMU和激光雷达传感器的时钟源同步；选用多个容器分别存储GNSS、IMU和激光雷达传感器的读取数据，并以激光雷达传感器的时间戳作为基准，GNSS、IMU传感器的读取数据根据该基准的时间戳获得该时间戳前两帧的数据，然后通过插值法对数据进行比例计算，得到相同时刻的传感器数据；
数据空间同步包括：将GNSS传感器数据转换到UTM坐标系下，以IMU传感器安装位置为坐标系原点，建立GNSS传感器数据和IMU传感器数据的Z轴坐标变换，再建立与激光雷达坐标系的平移变换和俯仰变换，完成数据空间同步。
3)使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变。
4)采用NDT算法配准点云数据；
采用NDT算法配准点云数据包括：
将点云数据划分为N个边长相等的立方体，通过下式计算均值μi和协方差∑i：
Figure BDA0003304593860000091
Figure BDA0003304593860000092
其中，mi为第i个立方体中数据点的数量，xij为第i个立方体中的第j点；
将变换参数p初始化为单位矩阵，将待配准点云集合中所有点按变换T进行变换，并转换到参考点云的立方体中，得到新的点云
Figure BDA0003304593860000093
根据下式计算按正太分布得到配准点经过变换后与参考点云的重合程度：
Figure BDA0003304593860000101
将所有立方体网格计算出来的概率密度相加得到配准得分，使用牛顿优化算法找到最高配准得分下的最佳变换参数p，并以最佳变换参数p进行点云数据配准。
5)在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标；
融合IMU方法获取移动测量设备的位姿包括：使用IMU数据进行状态预测得到预测的移动测量设备位置数据位姿，在将其作为初始值输入到扫描匹配中，通过观测到的点云数据与离线地图进行配准得到观测的移动测量设备位姿，再进行状态更新，得到最优移动测量设备位姿。
基于本方法获得的点云数据，可进一步实现三维建模或生成点云地图，进一步可根据生成的点云地图与移动测量设备进行融合实现自动驾驶，进一步可根据移动测量设备的启停控制采集设备的运作，实现无人自动采集。
参见图2，本发明还提供一种用于移动测量设备的测量系统，包括
点云数据获取处理模,10，用于通过设置于移动测量设备上的GNSS天线正前方的激光雷达获取点云数据，对获取的点云数据进行去噪；
点云数据获取处理模块10包括离群点去除单元11、车身点云数据去除单元12和下采样单元13；
离群点去除单元11用于通过半径滤波器从点云数据中去除离群点；
车身点云数据去除单元12用于通过直通滤波器去除车身的点云数据；
下采样单元13采用Voxel Grid体素网络滤波器进行下采样，具体步骤为：
将点云数据表示的空间划分为多个边长相等的三维立方体，使用每个体素的质心作为近似值替代所述三维立方体；若体素内总共有N个激光点，每个激光点分别使用pi＝(xi,yi,zi)表示，则近似的质心为
Figure BDA0003304593860000111
信息获取同步模块20，用于基于GNSS传感器获取移动测量设备的位置信息；基于设置于移动测量设备后轴上方位置的IMU传感器获取移动测量设备的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；
信息获取同步模块20包括数据时间同步单元21和数据空间同步单元22；
数据时间同步单元21用于对GNSS、IMU和激光雷达传感器数据同步包括数据时间同步；采用PPS+NMEZ协议进行GNSS、IMU和激光雷达传感器的时钟源同步；选用多个容器分别存储GNSS、IMU和激光雷达传感器的读取数据，并以激光雷达传感器的时间戳作为基准，GNSS、IMU传感器的读取数据根据该基准的时间戳获得该时间戳前两帧的数据，然后通过插值法对数据进行比例计算，得到相同时刻的传感器数据；
数据空间同步单元22用于对GNSS、IMU和激光雷达传感器数据同步包括数据空间同步；将GNSS传感器数据转换到UTM坐标系下，以IMU传感器安装位置为坐标系原点，建立GNSS传感器数据和IMU传感器数据的Z轴坐标变换，再建立与激光雷达坐标系的平移变换和俯仰变换，完成数据空间同步。
点云数据畸变去除模块30，用于使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变；
点云数据配准模块40，用于采用NDT算法配准点云数据；
点云数据配准模块用于将点云数据划分为N个边长相等的立方体，通过下式计算均值μi和协方差∑i：
Figure BDA0003304593860000121
Figure BDA0003304593860000122
其中，mi为第i个立方体中数据点的数量，xij为第i个立方体中的第j点；
将变换参数p初始化为单位矩阵，将待配准点云集合中所有点按变换T进行变换，并转换到参考点云的立方体中，得到新的点云
Figure BDA0003304593860000131
根据下式计算按正太分布得到配准点经过变换后与参考点云的重合程度：
Figure BDA0003304593860000132
将所有立方体网格计算出来的概率密度相加得到配准得分，使用牛顿优化算法找到最高配准得分下的最佳变换参数p，并以最佳变换参数p进行点云数据配准。
点云数据绝对坐标生成模块50，用于在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标。
点云数据绝对坐标生成模块50包括移动测量设备位姿融合IMU方法获取单元51；移动测量设备位姿融合IMU方法获取单元51用于使用IMU数据进行状态预测得到预测的移动测量设备位置数据位姿，在将其作为初始值输入到扫描匹配中，通过观测到的点云数据与离线地图进行配准得到观测的移动测量设备位姿，再进行状态更新，得到最优移动测量设备位姿。
最后说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管通过参照本发明的优选实施例已经对本发明进行了描述，但本领域的普通技术人员应当理解，可以在形式上和细节上对其作出各种各样的改变，而不偏离所附权利要求书所限定的本发明的精神和范围。

Claims (10)

1.一种用于移动测量设备的测量方法，其特征在于，包括
1)通过设置于移动测量设备上的GNSS天线正前方的激光雷达获取点云数据，对获取的点云数据进行去噪；
2)基于GNSS传感器获取移动测量设备的位置信息；基于设置于移动测量备后轴上方位置的IMU传感器获取移动测量设备的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；
3)使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变；
4)采用NDT算法配准点云数据；
5)在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标。
2.根据权利要求1所述用于移动测量设备的测量方法，其特征在于，所述步骤1)对获取的点云数据进行去噪包括：通过半径滤波器从点云数据中去除离群点；通过直通滤波器去除车身的点云数据；采用Voxel Grid体素网络滤波器进行下采样；所述采用Voxel Grid体素网络滤波器进行下采样具体步骤为：
将点云数据表示的空间划分为多个边长相等的三维立方体，使用每个体素的质心作为近似值替代所述三维立方体；若体素内总共有N个激光点，每个激光点分别使用pi＝(xi,yi,zi)表示，则近似的质心为
Figure RE-FDA0003393805840000011
3.根据权利要求1所述用于移动测量设备的测量方法，其特征在于，所述步骤2)中对GNSS、IMU和激光雷达传感器数据同步包括数据时间同步和数据空间同步；
所述数据时间同步包括：采用PPS+NMEZ协议进行GNSS、IMU和激光雷达传感器的时钟源同步；选用多个容器分别存储GNSS、IMU和激光雷达传感器的读取数据，并以激光雷达传感器的时间戳作为基准，GNSS、IMU传感器的读取数据根据该基准的时间戳获得该时间戳前两帧的数据，然后通过插值法对数据进行比例计算，得到相同时刻的传感器数据；
所述数据空间同步包括：将GNSS传感器数据转换到UTM坐标系下，以IMU传感器安装位置为坐标系原点，建立GNSS传感器数据和IMU传感器数据的Z轴坐标变换，再建立与激光雷达坐标系的平移变换和俯仰变换，完成数据空间同步。
4.根据权利要求1所述用于移动测量设备的测量方法，其特征在于，所述步骤4)中采用NDT算法配准点云数据包括：
将点云数据划分为N个边长相等的立方体，通过下式计算均值μi和协方差∑i：
Figure RE-FDA0003393805840000021
Figure RE-FDA0003393805840000022
其中，mi为第i个立方体中数据点的数量，xij为第i个立方体中的第j点；
将变换参数p初始化为单位矩阵，将待配准点云集合中所有点按变换T进行变换，并转换到参考点云的立方体中，得到新的点云
Figure RE-FDA0003393805840000031
根据下式计算按正太分布得到配准点经过变换后与参考点云的重合程度：
Figure RE-FDA0003393805840000032
将所有立方体网格计算出来的概率密度相加得到配准得分，使用牛顿优化算法找到最高配准得分下的最佳变换参数p，并以最佳变换参数p进行点云数据配准。
5.根据权利要求1所述用于移动测量设备的测量方法，其特征在于，所述步骤5)中融合IMU方法获取移动测量设备的位姿包括：使用IMU数据进行状态预测得到预测的移动测量设备位置数据位姿，在将其作为初始值输入到扫描匹配中，通过观测到的点云数据与离线地图进行配准得到观测的移动测量设备位姿，再进行状态更新，得到最优移动测量设备位姿。
6.一种用于移动测量设备的测量系统，其特征在于，包括
点云数据获取处理模块，用于通过设置于移动测量设备上的GNSS天线正前方的激光雷达获取点云数据，对获取的点云数据进行去噪；
信息获取同步模块，用于基于GNSS传感器获取移动测量设备的位置信息；基于设置于移动测量设备后轴上方位置的IMU传感器获取移动测量设备的位姿信息；并对GNSS、IMU和激光雷达传感器数据同步；
点云数据畸变去除模块，用于使用高频率IMU数据对一个采集周期内的点云数据进行运动补偿去除移动测量设备在运动时点云数据的畸变；
点云数据配准模块，用于采用NDT算法配准点云数据；
点云数据绝对坐标生成模块，用于在点云数据中添加移动测量设备的GNSS位置信息、融合IMU方法获取移动测量设备的位姿，计算出最优位姿，得出点云数据绝对坐标。
7.根据权利要求6所述用于移动测量设备的测量系统，其特征在于，所述点云数据获取处理模块包括离群点去除单元、车身点云数据去除单元和下采样单元；
所述离群点去除单元用于通过半径滤波器从点云数据中去除离群点；
所述车身点云数据去除单元用于通过直通滤波器去除车身的点云数据；
所述下采样单元采用Voxel Grid体素网络滤波器进行下采样，具体步骤为：
将点云数据表示的空间划分为多个边长相等的三维立方体，使用每个体素的质心作为近似值替代所述三维立方体；若体素内总共有N个激光点，每个激光点分别使用pi＝(xi,yi,zi)表示，则近似的质心为
Figure RE-FDA0003393805840000041
8.根据权利要求6所述用于移动测量设备的测量系统，其特征在于，所述信息获取同步模块包括数据时间同步单元和数据空间同步单元；
所述数据时间同步单元用于对GNSS、IMU和激光雷达传感器数据同步包括数据时间同步；采用PPS+NMEZ协议进行GNSS、IMU和激光雷达传感器的时钟源同步；选用多个容器分别存储GNSS、IMU和激光雷达传感器的读取数据，并以激光雷达传感器的时间戳作为基准，GNSS、IMU传感器的读取数据根据该基准的时间戳获得该时间戳前两帧的数据，然后通过插值法对数据进行比例计算，得到相同时刻的传感器数据；
所述数据空间同步单元用于对GNSS、IMU和激光雷达传感器数据同步包括数据空间同步；将GNSS传感器数据转换到UTM坐标系下，以IMU传感器安装位置为坐标系原点，建立GNSS传感器数据和IMU传感器数据的Z轴坐标变换，再建立与激光雷达坐标系的平移变换和俯仰变换，完成数据空间同步。
9.根据权利要求6所述用于移动测量设备的测量系统，其特征在于，所述点云数据配准模块用于将点云数据划分为N个边长相等的立方体，通过下式计算均值μi和协方差∑i：
Figure RE-FDA0003393805840000051
Figure RE-FDA0003393805840000052
其中，mi为第i个立方体中数据点的数量，xij为第i个立方体中的第j点；
将变换参数p初始化为单位矩阵，将待配准点云集合中所有点按变换T进行变换，并转换到参考点云的立方体中，得到新的点云
Figure RE-FDA0003393805840000061
根据下式计算按正太分布得到配准点经过变换后与参考点云的重合程度：
Figure RE-FDA0003393805840000062
将所有立方体网格计算出来的概率密度相加得到配准得分，使用牛顿优化算法找到最高配准得分下的最佳变换参数p，并以最佳变换参数p进行点云数据配准。
10.根据权利要求6所述用于移动测量设备的测量系统，其特征在于，所述点云数据绝对坐标生成模块包括；所述移动测量设备位姿融合IMU方法获取单元用于使用IMU数据进行状态预测得到预测的移动测量设备位置数据位姿，在将其作为初始值输入到扫描匹配中，通过观测到的点云数据与离线地图进行配准得到观测的移动测量设备位姿，再进行状态更新，得到最优移动测量设备位姿。
CN202111200112.8A 2021-10-14 2021-10-14 一种用于移动测量设备的测量方法及系统 Pending CN113959437A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111200112.8A CN113959437A (zh) 2021-10-14 2021-10-14 一种用于移动测量设备的测量方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111200112.8A CN113959437A (zh) 2021-10-14 2021-10-14 一种用于移动测量设备的测量方法及系统

Publications (1)

Publication Number Publication Date
CN113959437A true CN113959437A (zh) 2022-01-21

Family

ID=79464042

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111200112.8A Pending CN113959437A (zh) 2021-10-14 2021-10-14 一种用于移动测量设备的测量方法及系统

Country Status (1)

Country Link
CN (1) CN113959437A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114897942A (zh) * 2022-07-15 2022-08-12 深圳元戎启行科技有限公司 点云地图的生成方法、设备及相关存储介质
CN115421125A (zh) * 2022-11-07 2022-12-02 山东富锐光学科技有限公司 一种基于数据融合的雷达点云数据惯性校正方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111457902A (zh) * 2020-04-10 2020-07-28 东南大学 基于激光slam定位的水域测量方法及系统
CN112268559A (zh) * 2020-10-22 2021-01-26 中国人民解放军战略支援部队信息工程大学 复杂环境下融合slam技术的移动测量方法
CN112362051A (zh) * 2020-10-16 2021-02-12 无锡卡尔曼导航技术有限公司 一种基于gnss/ins/lidar-slam信息融合的移动机器人导航定位系统
CN112612029A (zh) * 2020-12-24 2021-04-06 哈尔滨工业大学芜湖机器人产业技术研究院 融合ndt和icp的栅格地图定位方法
CN112862894A (zh) * 2021-04-12 2021-05-28 中国科学技术大学 一种机器人三维点云地图构建与扩充方法
CN112967392A (zh) * 2021-03-05 2021-06-15 武汉理工大学 一种基于多传感器触合的大规模园区建图定位方法
CN112964262A (zh) * 2021-03-26 2021-06-15 南京理工大学 无人驾驶车载传感器数据采集与处理系统与方法
CN113495281A (zh) * 2021-06-21 2021-10-12 杭州飞步科技有限公司 可移动平台的实时定位方法及装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111457902A (zh) * 2020-04-10 2020-07-28 东南大学 基于激光slam定位的水域测量方法及系统
CN112362051A (zh) * 2020-10-16 2021-02-12 无锡卡尔曼导航技术有限公司 一种基于gnss/ins/lidar-slam信息融合的移动机器人导航定位系统
CN112268559A (zh) * 2020-10-22 2021-01-26 中国人民解放军战略支援部队信息工程大学 复杂环境下融合slam技术的移动测量方法
CN112612029A (zh) * 2020-12-24 2021-04-06 哈尔滨工业大学芜湖机器人产业技术研究院 融合ndt和icp的栅格地图定位方法
CN112967392A (zh) * 2021-03-05 2021-06-15 武汉理工大学 一种基于多传感器触合的大规模园区建图定位方法
CN112964262A (zh) * 2021-03-26 2021-06-15 南京理工大学 无人驾驶车载传感器数据采集与处理系统与方法
CN112862894A (zh) * 2021-04-12 2021-05-28 中国科学技术大学 一种机器人三维点云地图构建与扩充方法
CN113495281A (zh) * 2021-06-21 2021-10-12 杭州飞步科技有限公司 可移动平台的实时定位方法及装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
吴环宇: "基于激光雷达的智能车辆三维地图构建和定位算法研究", 中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑), pages 035 - 317 *
李慧栋;: "一种基于颜色与三维形状的水果识别算法", 中国科技信息, no. 14, pages 82 - 86 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114897942A (zh) * 2022-07-15 2022-08-12 深圳元戎启行科技有限公司 点云地图的生成方法、设备及相关存储介质
CN114897942B (zh) * 2022-07-15 2022-10-28 深圳元戎启行科技有限公司 点云地图的生成方法、设备及相关存储介质
CN115421125A (zh) * 2022-11-07 2022-12-02 山东富锐光学科技有限公司 一种基于数据融合的雷达点云数据惯性校正方法

Similar Documents

Publication Publication Date Title
CN112347840B (zh) 视觉传感器激光雷达融合无人机定位与建图装置和方法
CN109709801B (zh) 一种基于激光雷达的室内无人机定位系统及方法
CN110033489B (zh) 一种车辆定位准确性的评估方法、装置及设备
CN112268559B (zh) 复杂环境下融合slam技术的移动测量方法
WO2023131123A1 (zh) 组合导航设备与激光雷达的外参标定方法及装置
CN112129281B (zh) 一种基于局部邻域地图的高精度图像导航定位方法
CN112987065B (zh) 一种融合多传感器的手持式slam装置及其控制方法
CN114526745B (zh) 一种紧耦合激光雷达和惯性里程计的建图方法及系统
CN106017463A (zh) 一种基于定位传感装置的飞行器定位方法
JP2009053059A (ja) 対象特定装置、対象特定方法および対象特定プログラム
JP4978615B2 (ja) 対象特定装置
CN111080682B (zh) 点云数据的配准方法及装置
CN113447949B (zh) 一种基于激光雷达和先验地图的实时定位系统及方法
CN113959437A (zh) 一种用于移动测量设备的测量方法及系统
CN111862215B (zh) 一种计算机设备定位方法、装置、计算机设备和存储介质
CN112967392A (zh) 一种基于多传感器触合的大规模园区建图定位方法
CN115272596A (zh) 一种面向单调无纹理大场景的多传感器融合slam方法
CN112578394B (zh) 附有几何约束的LiDAR/INS融合定位与制图方法
CN115183762A (zh) 一种机场仓库内外建图方法、系统、电子设备及介质
Zhao et al. Updating a digital geographic database using vehicle-borne laser scanners and line cameras
CN113838129A (zh) 一种获得位姿信息的方法、装置以及系统
KR102130687B1 (ko) 다중 센서 플랫폼 간 정보 융합을 위한 시스템
Forno et al. Techniques for improving localization applications running on low-cost IoT devices
CN113227713A (zh) 生成用于定位的环境模型的方法和系统
CN113960614A (zh) 一种基于帧-地图匹配的高程图构建方法

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20220121