CN112712107B - 一种基于优化的视觉和激光slam融合定位方法 - Google Patents
一种基于优化的视觉和激光slam融合定位方法 Download PDFInfo
- Publication number
- CN112712107B CN112712107B CN202011461247.5A CN202011461247A CN112712107B CN 112712107 B CN112712107 B CN 112712107B CN 202011461247 A CN202011461247 A CN 202011461247A CN 112712107 B CN112712107 B CN 112712107B
- Authority
- CN
- China
- Prior art keywords
- fusion
- positioning
- position estimation
- vision
- robot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/25—Fusion techniques
-
- 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/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- 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/15—Correlation function computation including computation of convolution operations
-
- 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/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/277—Analysis of motion involving stochastic approaches, e.g. using Kalman filters
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Software Systems (AREA)
- Evolutionary Biology (AREA)
- Bioinformatics & Computational Biology (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Algebra (AREA)
- Life Sciences & Earth Sciences (AREA)
- Databases & Information Systems (AREA)
- Evolutionary Computation (AREA)
- Operations Research (AREA)
- Probability & Statistics with Applications (AREA)
- Multimedia (AREA)
- Computing Systems (AREA)
- Artificial Intelligence (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于优化的视觉和激光SLAM融合定位方法,首先分别获取视觉SLAM模块前端视觉惯性里程计与激光SLAM模块粒子滤波定位算法得到的定位估计结果,对粒子的分布进行近似高斯估计,然后根据定位时间差值对视觉SLAM模块进行补正,根据设定的目标函数和补正后高斯参数计算最优融合系数,得到最终的融合结果。本发明融合了两种相对独立且精准度较高的定位方法,使定位***在一种方法失效情况下仍能正常工作,同时提高了精准度,最后对融合方法的改进也提高了***的实时性。
Description
技术领域
本发明属于移动机器人定位技术领域,具体涉及一种基于优化的视觉和激光SLAM融合定位方法。
背景技术
定位问题始终是移动机器人领域的核心问题之一,定位结果的准确度对移动机器人后续的规划和控制等模块有很大的影响。目前移动机器人的定位方法有很多,如视觉系列方法、激光雷达系列方法、RFID系列方法、GPS系列方法和路标点(Landmark)系列方法等。改善定位效果的方法主要有两种:使用更高精度传感器和改进定位算法,然而高精度传感器往往价格昂贵,且价格与精度的性价比随着精度提高迅速降低,因此对定位算法的改进在实际场景中应用较为广泛。
现阶段定位算法改进集中在两个方向:一种是依赖高速发展的硬件平台运行高计算复杂度的高精度定位方法,特点是计算量大,使用的方法在几年前的硬件平台很难满足实时性,但近几年随着硬件技术飞快发展,这类方法的优势逐渐明显,如SLAM(Simultaneous Localization And Mapping,即时定位与地图构建)后端的处理方法从扩展卡尔曼滤波发展为图优化;另一种是利用不同的传感器之间的特性,优势互补,融合测量数据得到更加精准的定位效果,如视觉和激光SLAM中常常使用IMU(Inertial MeasurementUnit,惯性测量单元)的数据得到定位预测值,通过卡尔曼滤波得到融合的定位结果。
现有的定位融合方法大多基于卡尔曼滤波及其变种,公开号为CN107289933B的中国专利提出了一种融合MEMS传感器和VLC传感器的定位方法,该方法通过MEMS传感器得到PDR定位结果,通过VLC定位模块得到VLC定位结果,通过定位卡尔曼滤波器融合两种定位结果,得到最终定位信息。但实际上价格适中的MEMS传感器往往零飘和测量精准度很差,这会导致PDR的定位精度较差,定位效果仍然很大程度上取决于VLC定位方法。公开号为CN105737832B的中国专利介绍了一种利用分布式结构将整个状态向量分为机器人位姿估计和路标估计五维状态分布化处理再进行融合的定位方法,该方法依据每个有效路标点单独建立多个相互平行的子滤波器,然后将子滤波器的机器人位姿估计结果在主滤波器中进行融合,并将子滤波器的融合结果通过全局预测器反馈修正,最后得到全局最优的机器人位姿估计结果;但是该专利技术中的子滤波器使用扩展卡尔曼滤波,主滤波器将子滤波器的估计结果加权平均得到最优估计值,但并未说明如何得到子滤波器的权值系数。
发明内容
鉴于上述,本发明提出了一种基于优化的视觉和激光SLAM融合定位方法,融合了两种相对独立且精准度较高的定位方法,使定位***在一种方法失效情况下仍能正常工作,同时提高了精准度,最后对融合方法的改进也提高了***的实时性。
一种基于优化的视觉和激光SLAM融合定位方法,包括如下步骤:
(1)获取视觉SLAM模块通过定位计算得到的机器人位置估计结果X及其高斯参数;
(2)获取激光SLAM模块通过粒子滤波定位算法得到的机器人位置估计结果Y;
(3)对激光SLAM模块计算过程中的粒子分布结果进行近似高斯处理,计算得到位置估计结果Y的高斯参数;
(4)利用两个模块定位输出的时间差对位置估计结果X及其高斯参数进行时间修正;
(5)根据上述信息建立目标函数,优化求解出其中的最优融合系数α;
(6)根据最优融合系数α通过融合函数计算出融合后最优的机器人位置估计结果Z。
进一步地,所述视觉SLAM模块在定位计算过程中融合了IMU数据。
进一步地,所述视觉SLAM模块前端使用特征法,根据对极约束求解相机运动并作为观测结果,进而使用IMU和轮速计根据机器人运动模型得到预测结果,之后使用扩展卡尔曼滤波得到机器人的位置估计结果X及其高斯参数。
进一步地,所述目标函数的表达式如下:
其中:m和n为中间变量,f(m,n)为关于m和n的目标函数,n=(1-α)2,m=α2,σx1为机器人位置估计结果X的x轴分量的标准差,σx2为机器人位置估计结果X的y轴分量的标准差,ρx为机器人位置估计结果X的协方差,σy1为机器人位置估计结果Y的x轴分量的标准差,σy2为机器人位置估计结果Y的y轴分量的标准差,ρy为机器人位置估计结果Y的协方差。
进一步地,所述步骤(5)在优化求解过程中需满足以下约束条件:
其中:m和n为中间变量,n=(1-α)2,m=α2。
进一步地,所述步骤(6)通过以下融合函数计算出融合后最优的机器人位置估计结果Z;
其中:m和n为中间变量,n=(1-α)2,m=α2。
本发明SLAM融合定位方法所使用的视觉SLAM模块前端使用特征点或路标点匹配,与IMU和轮速编码器通过扩展卡尔曼滤波融合作为VIO(visual-inertial odometry,视觉惯性里程计);激光SLAM模块使用粒子滤波(particle filter)得到位置估计,根据粒子权重计算近似的高斯分布协方差矩阵,最后视觉和激光SLAM模块得到的位置估计结果和协方差矩阵输入到定位融合模块根据目标函数优化计算两种定位方法的权值系数,得到融合的最优位置估计结果;机器人的朝向角度估计不经过融合模块,直接根据视觉SLAM方法得出。
与现有技术相比较,本发明具有以下有益技术效果:
1.定位精准度更高;本发明融合了两种较高精度定位方法而非使用IMU或MEMS直接位置估计等低精度方法,得到了更加精准的融合定位结果。
2.具有更强的鲁棒性;本发明当一种定位模块失效时,定位融合结果精准度不会低于另一个定位模块;
3.时间复杂度低。本发明融合方法基于优化而非卡尔曼滤波,融合结果由迭代或解析方式得出,在状态数较少时相比卡尔曼滤波矩阵乘法和求逆运算时间复杂度更低。
附图说明
图1为本发明SLAM融合定位方法的***实现框架示意图。
图2为本发明融合模块的执行流程示意图。
图3为在两种定位精度差距较大情况下本发明的融合效果对比示意图。
图4为在两种定位精度基本相同情况下本发明的融合效果对比示意图。
图5为在一种定位失效情况下本发明的融合效果对比示意图。
具体实施方式
为了更为具体地描述本发明,下面结合附图及具体实施方式对本发明的技术方案进行详细说明。
视觉里程计的主要问题是如何根据摄像头采集的相邻帧图像估计相机的运动状态。对于特征点方法,本发明首先需要对图像进行特征点提取,之后再对比两幅图像相应特征点的变化;对于路标点方法,则可以直接将路标点作为特征点。两种方法的本质都是寻找地图坐标系下的位置不变特征,设图像中共同的特征有N个,用yi(i=1,2,…,N)表示,***在k时刻的状态为xk,观测噪声εi,k服从高斯分布,则***的观测方程为:
zk=h(yi,xk)+εi,k (1)
其中抽象函数h是***状态和特征到观测结果的映射,与相机模型有关。根据轮速计和IMU的测量值uk可以根据k-1时刻的***状态推算出k时刻的***状态,即***的运动方程为:
xk=g(xk-1,uk)+δk (2)
其中:抽象函数g描述了运动模型,δk为***噪声,服从高斯分布。
由于***的观测模型和运动模型是非线性的,因此使用扩展卡尔曼滤波方法进行状态估计,设观测模型和运动模型在k时刻的Jacobi矩阵分别为Hk和Gk,观测噪声εi,k~N(0,Rk),***噪声δk~N(0,Qk),则状态估计的期望值和协方差预测量为:
卡尔曼增益为:
最后根据摄像头的观测更新状态估计的期望值和协方差矩阵如下:
在平面运动中,机器人的位姿状态由二维位置坐标和偏航角表示,***状态xk=[x y θ]T,至此得到视觉SLAM模块的定位估计及其协方差矩阵。
本发明方法中激光SLAM使用通用的粒子滤波方法进行定位估计,粒子滤波的结果是一组离散的状态估计样本集及其对应置信度,但后续的优化算法需要连续的置信度估计,本发明方法根据粒子权重计算高斯近似,具体步骤如下:
粒子滤波器的粒子数量为N,在k时刻输出状态样本集xk,i(i=1,2,…,N),对应的粒子归一化权重为wi(i=1,2,…,N),则高斯近似的均值为:
协方差矩阵为:
由于只对激光SLAM模块的位置估计进行融合,因此只计算位置坐标的高斯近似,至此得到激光SLAM模块的位置估计及其协方差矩阵。
激光SLAM模块的定位频率约为10Hz,在得到激光定位结果分布的高斯近似后,对视觉SLAM模块状态估计均值和协方差根据式(3)和式(4)进行时差补正,得到当前时刻的位置估计。为了方便讨论,设视觉和激光SLAM的位置估计为分别随机变量X=[x1 x2]T和Y=[y1 y2]T,且均服从以下二维高斯分布:
Z为融合后的位置估计,即:
Z=αX+(1-α)Y (10)
式中α为融合系数,Z服从以下高斯分布:
二维高斯分布中,标准差椭圆的面积反映了随机变量的分布集中度,在定位问题中,我们希望位置估计结果尽可能集中在期望值附近;误差椭圆面积S与随机变量Z协方差矩阵的关系为:
其中:
Z的协方差矩阵元素值分别为:
ρz=E(Z1Z2)-pxpy
其中:
E(Z1Z2)=α2E(X1X2)+α(1-α)E(X1Y2)+α(1-α)E(X2Y1)+(1-α)2(Y1Y2)
由于摄像头、IMU和激光雷达高斯噪声的独立性,则:
E(X1Y2)=E(X2Y1)=Cov(X1,Y2)+EX1EY2=pxpy
且:
E(X1X2)=ρx+pxpy
E(Y1Y2)=ρy+pxpy
所以:
ρz=α2ρx+(1-α)2ρy
设m=α2,n=(1-α)2,优化的目标函数为:
约束条件为:
最后通过拉格朗日乘数法等优化方法求得m和n,融合结果为:
理论和实践证明,融合之后的定位误差精准度均比融合前的精准度高。
图1给出了本发明方法的***实现框架,IMU集成了加速度计、陀螺仪和磁力计,测量数据输出频率100Hz;加速度计积分得到的速度测量结果不够准确,本发明使用轮速计模块计算速度,轮速计使用光电式旋转编码器,速度计算结果输出频率100Hz。视觉SLAM模块的前端部分使用特征法,特征可以是ORB等特征提取算法提取的特征点,也可以是色块之类的路标点之后使用扩展卡尔曼滤波算法与IMU和轮速计的测量结果融合,得到位置估计和协方差矩阵,视觉SLAM模块的定位频率为30Hz。激光SLAM模块使用IMU和轮速计进行初始位姿估计,目的是减少粒子收敛时间,之后通过粒子滤波定位算法得到位置估计和一组粒子权重,激光SLAM的定位频率为10Hz。粒子的权重分布反映了位置的概率分布,对粒子的权重分布进行近似高斯处理,得到高斯分布表示的位置概率分布,之后将两个模块的位置估计和高斯参数输入到融合模块。
图2为融合模块的执行流程,经过对位置估计的处理,得到了两组服从高斯分布的位置概率分布,视觉SLAM模块的位置输出记为随机变量X,激光SLAM模块的位置输出记为随机变量Y。融合模块在得到激光SLAM的位置估计结果之后进行融合处理,但是由于两个定位模块的计算结果并不会同时输出,所以需要对视觉SLAM位置估计结果根据运动模型和IMU、轮速计数据进行时差补正得到当前时刻的位置估计及高斯参数。融合模块使用了线型融合函数Z=αX+(1-α)Y,目标是减小融合结果的不确定度。融合模块采用优化的方式求解融合系数,根据融合系数输出最后的定位结果。
图3、图4和图5是本发明***在不同情况下的定位融合效果对比。第一排第二列图片的点表示了视觉SLAM得到的位置分布,第二排第一列图片的点表示了激光SLAM得到的位置分布,第二排第二列图片的点表示了融合后的位置分布,第一排第一列图片表示了三种位置分布结果的对比,椭圆A、B、C分别为视觉SLAM、激光SLAM和融合后的定位位置分布。图3是两种定位精度相差较大的情况,融合后的结果稍优于激光SLAM的效果;图4是两种定位精度相近的情况,融合后的结果明显优于未融合前的效果;图5是一种定位模块失效的情况,融合后的结果基本与正常工作的定位方法相同。
以上所述的具体实施方式对本发明的技术方案和效果进行了详尽说明,目的是便于本领域的技术人员能够理解和应用本发明。熟悉本领域技术的人员显然可以容易地对上述实施例做出各种修改,并把在此说明的一般原理应用到其他实施例中而不必经过创造性的劳动。因此,本发明不限于上述实施例,本领域技术人员根据本发明的揭示,对于本发明做出的改进和修改都应该在本发明的保护范围之内。
Claims (3)
1.一种基于优化的视觉和激光SLAM融合定位方法,包括如下步骤:
(1)获取视觉SLAM模块通过定位计算得到的机器人位置估计结果X及其高斯参数;
所述视觉SLAM模块在定位计算过程中融合了IMU数据,视觉SLAM模块前端使用特征法,根据对极约束求解相机运动并作为观测结果,进而使用IMU和轮速计根据机器人运动模型得到预测结果,之后使用扩展卡尔曼滤波得到机器人的位置估计结果X及其高斯参数;
(2)获取激光SLAM模块通过粒子滤波定位算法得到的机器人位置估计结果Y;
(3)对激光SLAM模块计算过程中的粒子分布结果进行近似高斯处理,计算得到位置估计结果Y的高斯参数;
(4)利用两个模块定位输出的时间差对位置估计结果X及其高斯参数进行时间修正;
(5)根据上述信息建立以下目标函数,优化求解出其中的最优融合系数α;
其中:m和n为中间变量,f(m,n)为关于m和n的目标函数,n=(1-α)2,m=α2,σx1为机器人位置估计结果X的x轴分量的标准差,σx2为机器人位置估计结果X的y轴分量的标准差,ρx为机器人位置估计结果X的协方差,σy1为机器人位置估计结果Y的x轴分量的标准差,σy2为机器人位置估计结果Y的y轴分量的标准差,ρy为机器人位置估计结果Y的协方差;
优化求解过程中需满足以下约束条件:
(6)根据最优融合系数α通过融合函数计算出融合后最优的机器人位置估计结果Z。
3.根据权利要求1所述基于优化的视觉和激光SLAM融合定位方法,其特征在于:该融合定位方法所使用的视觉SLAM模块前端使用特征点或路标点匹配,与IMU和轮速编码器通过扩展卡尔曼滤波融合作为视觉惯性里程计;激光SLAM模块使用粒子滤波得到位置估计,根据粒子权重计算近似的高斯分布协方差矩阵,最后视觉和激光SLAM模块得到的位置估计结果和协方差矩阵输入到定位融合模块根据目标函数优化计算两种定位方法的权值系数,得到融合的最优位置估计结果;机器人的朝向角度估计不经过融合模块,直接根据视觉SLAM方法得出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011461247.5A CN112712107B (zh) | 2020-12-10 | 2020-12-10 | 一种基于优化的视觉和激光slam融合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011461247.5A CN112712107B (zh) | 2020-12-10 | 2020-12-10 | 一种基于优化的视觉和激光slam融合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112712107A CN112712107A (zh) | 2021-04-27 |
CN112712107B true CN112712107B (zh) | 2022-06-28 |
Family
ID=75543151
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011461247.5A Active CN112712107B (zh) | 2020-12-10 | 2020-12-10 | 一种基于优化的视觉和激光slam融合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112712107B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113490146B (zh) * | 2021-05-08 | 2022-04-22 | 湖南大学 | 一种基于WiFi与视觉融合的SLAM方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105865449A (zh) * | 2016-04-01 | 2016-08-17 | 深圳杉川科技有限公司 | 基于激光和视觉的移动机器人的混合定位方法 |
CN108198223A (zh) * | 2018-01-29 | 2018-06-22 | 清华大学 | 一种激光点云与视觉图像映射关系快速精确标定方法 |
CN108694731A (zh) * | 2018-05-11 | 2018-10-23 | 武汉环宇智行科技有限公司 | 基于低线束激光雷达和双目相机的融合定位方法及设备 |
CN109633664A (zh) * | 2018-12-29 | 2019-04-16 | 南京理工大学工程技术研究院有限公司 | 基于rgb-d与激光里程计的联合定位方法 |
CN110174107A (zh) * | 2019-04-30 | 2019-08-27 | 厦门大学 | 一种导览机器人定位建图激光视觉融合方法和机器人 |
CN110243358A (zh) * | 2019-04-29 | 2019-09-17 | 武汉理工大学 | 多源融合的无人车室内外定位方法及*** |
CN111121767A (zh) * | 2019-12-18 | 2020-05-08 | 南京理工大学 | 一种融合gps的机器人视觉惯导组合定位方法 |
CN111337943A (zh) * | 2020-02-26 | 2020-06-26 | 同济大学 | 一种基于视觉引导激光重定位的移动机器人定位方法 |
CN111429574A (zh) * | 2020-03-06 | 2020-07-17 | 上海交通大学 | 基于三维点云和视觉融合的移动机器人定位方法和*** |
CN111521176A (zh) * | 2020-04-27 | 2020-08-11 | 北京工业大学 | 融合激光的视觉辅助惯性导航方法 |
CN111595333A (zh) * | 2020-04-26 | 2020-08-28 | 武汉理工大学 | 视觉惯性激光数据融合的模块化无人车定位方法及*** |
-
2020
- 2020-12-10 CN CN202011461247.5A patent/CN112712107B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105865449A (zh) * | 2016-04-01 | 2016-08-17 | 深圳杉川科技有限公司 | 基于激光和视觉的移动机器人的混合定位方法 |
CN108198223A (zh) * | 2018-01-29 | 2018-06-22 | 清华大学 | 一种激光点云与视觉图像映射关系快速精确标定方法 |
CN108694731A (zh) * | 2018-05-11 | 2018-10-23 | 武汉环宇智行科技有限公司 | 基于低线束激光雷达和双目相机的融合定位方法及设备 |
CN109633664A (zh) * | 2018-12-29 | 2019-04-16 | 南京理工大学工程技术研究院有限公司 | 基于rgb-d与激光里程计的联合定位方法 |
CN110243358A (zh) * | 2019-04-29 | 2019-09-17 | 武汉理工大学 | 多源融合的无人车室内外定位方法及*** |
CN110174107A (zh) * | 2019-04-30 | 2019-08-27 | 厦门大学 | 一种导览机器人定位建图激光视觉融合方法和机器人 |
CN111121767A (zh) * | 2019-12-18 | 2020-05-08 | 南京理工大学 | 一种融合gps的机器人视觉惯导组合定位方法 |
CN111337943A (zh) * | 2020-02-26 | 2020-06-26 | 同济大学 | 一种基于视觉引导激光重定位的移动机器人定位方法 |
CN111429574A (zh) * | 2020-03-06 | 2020-07-17 | 上海交通大学 | 基于三维点云和视觉融合的移动机器人定位方法和*** |
CN111595333A (zh) * | 2020-04-26 | 2020-08-28 | 武汉理工大学 | 视觉惯性激光数据融合的模块化无人车定位方法及*** |
CN111521176A (zh) * | 2020-04-27 | 2020-08-11 | 北京工业大学 | 融合激光的视觉辅助惯性导航方法 |
Non-Patent Citations (1)
Title |
---|
单目-无扫描3D激光雷达融合的非合作目标相对位姿估计;郝刚涛等;《宇航学报》;20151030;第36卷(第10期);第1178-1186页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112712107A (zh) | 2021-04-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111121767B (zh) | 一种融合gps的机器人视觉惯导组合定位方法 | |
CN111415387B (zh) | 相机位姿确定方法、装置、电子设备及存储介质 | |
CN110702107A (zh) | 一种单目视觉惯性组合的定位导航方法 | |
CN110517324B (zh) | 基于变分贝叶斯自适应算法的双目vio实现方法 | |
CN110726406A (zh) | 一种改进的非线性优化单目惯导slam的方法 | |
US7747348B2 (en) | Method and apparatus for using rotational movement amount of mobile device and computer-readable recording medium for storing computer program | |
WO2018182524A1 (en) | Real time robust localization via visual inertial odometry | |
WO2019191288A1 (en) | Direct sparse visual-inertial odometry using dynamic marginalization | |
CN111238467A (zh) | 一种仿生偏振光辅助的无人作战飞行器自主导航方法 | |
CN113551665B (zh) | 一种用于运动载体的高动态运动状态感知***及感知方法 | |
CN113920198B (zh) | 一种基于语义边缘对齐的由粗到精的多传感器融合定位方法 | |
CN112347205A (zh) | 一种车辆误差状态的更新方法和装置 | |
CN113066127A (zh) | 一种在线标定设备参数的视觉惯性里程计方法和*** | |
CN112541423A (zh) | 一种同步定位与地图构建方法和*** | |
CN114234967A (zh) | 一种基于多传感器融合的六足机器人定位方法 | |
CN112712107B (zh) | 一种基于优化的视觉和激光slam融合定位方法 | |
CN114690229A (zh) | 一种融合gps的移动机器人视觉惯性导航方法 | |
CN116929338B (zh) | 地图构建方法、设备及存储介质 | |
CN111553954B (zh) | 一种基于直接法单目slam的在线光度标定方法 | |
CN117367427A (zh) | 一种适用于室内环境中的视觉辅助激光融合IMU的多模态slam方法 | |
CN116753953A (zh) | 一种基于视觉的无人机组合导航方法 | |
CN116429098A (zh) | 低速无人飞行器视觉导航定位方法及*** | |
CN115930948A (zh) | 一种果园机器人融合定位方法 | |
CN113503872B (zh) | 一种基于相机与消费级imu融合的低速无人车定位方法 | |
Conway et al. | Vision-based Velocimetry over Unknown Terrain with a Low-Noise IMU |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |