CN107180215A - 基于库位和二维码的停车场自动建图与高精度定位方法 - Google Patents
基于库位和二维码的停车场自动建图与高精度定位方法 Download PDFInfo
- Publication number
- CN107180215A CN107180215A CN201710397595.2A CN201710397595A CN107180215A CN 107180215 A CN107180215 A CN 107180215A CN 201710397595 A CN201710397595 A CN 201710397595A CN 107180215 A CN107180215 A CN 107180215A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- warehouse compartment
- vehicle
- quick response
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
- G06K7/00—Methods or arrangements for sensing record carriers, e.g. for reading patterns
- G06K7/10—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation
- G06K7/14—Methods or arrangements for sensing record carriers, e.g. for reading patterns by electromagnetic radiation, e.g. optical sensing; by corpuscular radiation using light without selection of wavelength, e.g. sensing reflected white light
- G06K7/1404—Methods for optical code recognition
- G06K7/1408—Methods for optical code recognition the method being specifically adapted for the type of code
- G06K7/1417—2D bar codes
-
- 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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T11/00—2D [Two Dimensional] image generation
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- General Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Toxicology (AREA)
- Electromagnetism (AREA)
- Health & Medical Sciences (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明提出了一种基于库位和二维码识别的即时定位与建图(SLAM)方法,基于低成本的前视单目相机以及由鱼眼相机组成的环视系统,对环境中的库位、库位编号以及预先布设的二维码进行鲁棒识别;利用低成本的惯性导航设备对车辆航向以及速度进行观测;利用SLAM算法实现对环境中的库位以及二维码标记的位置的优化估计,实现车库平面分布图自动构建,并利用建图结果实现无人车的实时高精度分米级定位。
Description
技术领域
本发明是一种应用于停车场以及类似无GNSS环境下的自动建图与高精度定位方法,适用无人车在停车场环境中的自主无人驾驶。
背景技术
在室外,全球卫星导航系统(GNSS)技术已经可以提供准确可靠的定位导航服务,但在室内空间,由于建筑墙体遮挡,无法接受到GNSS信号。当前实现室内停车场定位的方法主要依靠无线设备例如WiFi或UWB等,其一方面需要布设大量基站设备,成本高昂;另一方面定位精度(米级)难以满足无人驾驶需求。另外,采用激光雷达的机器人室内SLAM受到激光雷达成本的制约,难以在量产车型中装备;采用纯视觉系统的机器人SLAM方法受到停车场环境中缺乏丰富纹理的限制,无法保证精度和可用性。
发明内容
本发明提出了一种基于库位和二维码识别的即时定位与建图(SLAM)方法,基于低成本的前视单目相机以及由鱼眼相机组成的环视系统,对环境中的库位、库位编号以及预先布设的二维码进行鲁棒识别;利用低成本的惯性导航设备对车辆航向以及速度进行观测;利用SLAM算法实现对环境中的库位以及二维码标记的位置的优化估计,实现车库平面分布图自动构建,并利用建图结果实现无人车的实时高精度分米级定位。
本发明所采用的技术方案是:
1、通过低成本前视单目相机以及鱼眼环视相机获得车辆前方以及车辆四周地面的图像信息;
2、从前视图像中识别并提取二维码标志的类型和二维码的四个角点,利用二维码的平面假设计算车辆与二维码之间的相对位置关系;
3、从环视图像中提取库位的边界线,计算库位边界在车辆坐标系中的坐标,同时对库位的编号进行识别;
4、利用二维码标志的编号、库位位置和编号,对重复观测的库位以及二维码进行闭环优化,消除累积噪声;
5、实时通过扩展卡尔曼滤波器优化融合基于库位和二维码分别求解出的车辆位置信息,以及惯性导航观测得到的车辆位移信息,实现优化建图;
6、利用图优化方法对建图结果进行多次优化,提高建图的精度;
7、将建图结果进行保存,生成停车场库位平面地图;在线定位时通过已生成的建图结果,通过对库位边界以及二维码的实时识别优化求解当前车辆的位置,实现分米级的高精度定位。
本发明的有益效果是:1、在停车场等无GNSS信号以及在视觉特征稀疏的环境中提供高精度的实时定位结果;2、使用低成本传感器,和少数纸质二维码标记,实用性强;3、自动构建的定位地图能够同时支持无人车自主无人驾驶的定位需求,以及人类在停车场内的导航需求。
附图说明
图1各相机传感器获得的影像
图2二维码布置效果图
图3单目相机影像中视觉标记与三维空间坐标系中视觉标记对应关系
图4俯视图中检测得的库位
图5本方法中使用的图模型及基于视觉标记的导航示例
具体实施方式
基于本发明技术方案,以下结合附图对本发明技术方案做更为详细的介绍。
各个步骤依次为:
1、通过低成本前视单目相机以及鱼眼环视相机获得车辆前方以及车辆四周地面的图像信息
视觉传感器布置与标定:
1.1布置
本发明采用1个前视相机和4个鱼眼环视相机,前视相机分辨率为1080p或以上,水平视场角75-90度之间,帧率为25Hz,延迟小于5ms;鱼眼环视相机分辨率为720p或以上,水平视场角180度,帧率为25Hz,延迟小于5ms。其中,前视相机布置于汽车前挡风玻璃与后视镜之间;鱼眼环视相机布置于车辆前后保险杠,以及左右后视镜。
1.2标定
通过棋盘格内参标定法对前视相机和鱼眼相机的内参数进行标定,通过地面标志点对鱼眼相机的外参数进行标定,获得拼接后的俯视图如图1所示。
2、从前视图像中识别并提取二维码标志的类型和二维码的四个角点,利用二维码的平面假设计算车辆与二维码之间的相对位置关系
二维码布置及检测方法说明
2.1二维码布置
二维码生成采用Apriltag方案(https://april.eecs.umich.edu/wiki/AprilTags),将二维码打印于A2以上尺寸的雾面防水纸,然后将其张贴在停车场的立柱与墙面之上。张贴的密度约为沿停车场道路每1张/10m,在转弯处增加张贴密度至1张/5m。张贴高度约为1.7m-2.5m,保证车辆前视相机能够观测到二维码,并避免其他车辆的遮挡。二维码布置效果图如图2所示。
2.2检测并计算车辆与二维码之间的相对位置关系
利用前视单目相机对二维码进行检测,其中首先使用AprilTag SDK检测二维码的角点坐标。由于图像中四个角点在世界坐标系中位于同一平面上,因此对于每一个角点,可列出方程:·K-1·x+t=X,其中,K为相机内参数,x为角点在像空间坐标系中的坐标,R、t为相机在这一时刻的外参数,分别代表旋转和平移,X为角点在三维空间中的坐标。
如图3所示,其中s为人为二维码标记边长的一半。由于四个角点之间的位置关系已知,根据其位置关系,可以建立一个以二维码标记中心为原点,x轴沿标记边缘方向右,y轴沿标记边缘方向向上,z轴垂直于标记平面向内的三维空间直角坐标系。在此坐标系中,X已知,此外,x已经检测确定,K通过相机标定得出,R、t自由度为6Dof,则仅需三个或以上点,即可迭代求解出R、t。
对R进行罗德里格变换,即得单目相机到二维码标记中心连线与车辆航向的夹角a,对t取二范数即为单目相机到二维码标记中心的距离d。则构建视觉标记在车身坐标系,坐标为:
x=sin(a)·d
y=cos(a)·d。
3、从环视图像中提取库位的边界线,计算库位边界在车辆坐标系中的坐标,同时对库位的编号进行识别
库位布置及检测方法说明
3.1库位布置
库位需为停车场标准库位,其包括平直的库位线以及库位编号(英文字母与阿拉伯数字)。
3.2检测并计算
在获得环视相机俯视图后,利用机器视觉方法,检测俯视图中的停车库位线与库位编号。由于俯视图标定在步骤2构建的车身坐标系(x轴方向垂直航向向右,y轴方向沿航向指向车辆行驶方向)下,因此库位近端两个角点坐标可直接读出,远端两个角点利用库位规则(所述库位规则,为每个车库固有的规则,非本发明技术方案需要披露内容)估算得到。图4俯视图中检测得的库位。
4、利用二维码标志的编号、库位位置和编号,对重复观测的库位以及二维码进行离线闭环优化,消除累积噪声
该离线优化建图过程说明:
由于基于惯性导航进行航位推算存在累积误差,因此需要通过不断重复观测二维码标记或库位位置来修正累积误差。在离线建图过程中,由于无需考虑效率等问题,使用图优化方法建立地图。
所述图优化方法,是以图的方式来建立优化模型,图由顶点和边组成。如图5(左)所示,本方法中,所述顶点是指每个时刻车辆所在位置、各视觉标记(二维码与库位)所在位置,所述边是指两时刻间基于惯性导航的推算结果,或每个时刻车辆与视觉标记的相对坐标差。每观测到一个新的视觉标记或车辆发生了位移,则在图模型中增加一个新的结点和一条边,在添加所有数据后,根据图模型中边和结点的关系,列出边误差方程,使用高斯牛顿法迭代进行优化。
进一步公开,所述图模型可以用下列误差方程描述:
其中,
k表示图模型中任意一个结点(视觉标记或车辆);
C表示图模型中全体结点集合;
xk表示第k个结点的位置信息矩阵,若该结点为视觉标记,则存储视觉标记的位置坐标;若该结点为车辆,则存储车辆的位置坐标及航向;
zk表示由与第k个结点相关的观测获得的第k个结点的位置信息矩阵;
Ωk表示由与第k个结点相关的观测获得的协方差矩阵;
ek(xk,zk)表示xk与zk的误差函数;
则F(x)是整个图模型的误差函数,x*表示图模型的全局最优解;
为了求出全局最优解x*,用高斯牛顿法对上式进行迭代求解:
首先,对F(x)进行一阶泰勒展开:
其中,
表示结点信息矩阵x的初始值;
Δx表示x的修正值;
Jk表示将初始值代入ek中计算,得到的雅可比矩阵;
于是,该问题转化为对求解线性方程:
HΔx*=-b
解得新的全局最优解并作为初始值代入F(x)进行新一轮迭代。
5、实时通过扩展卡尔曼滤波器优化融合基于库位和二维码分别求解出的车辆位置信息,以及通过步骤4惯性导航观测得到的车辆位移信息,实现优化建图
在线定位及建图过程中的优化
在获得构建的停车场地图后,即可进行即时定位。为达到实时性的需求,在定位过程中使用扩展卡尔曼滤波同时对定位结果及导航地图中视觉标记的位置进行优化,系统的处理速度为5-10Hz。
所述扩展卡尔曼滤波是适用于非线性系统的卡尔曼滤波,它基于联合概率分布和贝叶斯理论,可根据一系列具有噪声的时序数据,对未知量进行估计,在本方法中,每一时刻获得的视觉标记观测和车辆位移观测均含有误差,而车辆所处的位置即为待求的未知量,则可用扩展卡尔曼滤波公式描述这一问题:
其中,
k为当前时刻,k-1为上一时刻,
x是包含车辆位置、航向及视觉标记位置的未知量矩阵,
z中包含了车辆对视觉标记的观测,
u表示惯性导航数据,
函数f()表示了上一时刻x、u对这一时刻x值的影响,
F为函数f()的雅可比矩阵,
Q和R表示观测信息和经验模型中包含的噪声。
经过上式即可增量式地得到车辆当前位置,并即时更新地图中视觉标记的位置。
6、利用图优化方法对建图结果进行多次优化,提高建图的精度
离线地图的局部细化与全局优化相结合
为了提高优化的效率,本方法采取全局图优化与局部图优化相结合的模式,首先对结点和边进行均匀采样,进行全局图优化,再以全局图中的点为基准,进行局部图优化。建图步骤的结果如图5(右)所示,其中点为二维码标记,框为库位。该地图自动生成完全无需人工干预,可用于实现在线高精度定位和行人导航。
7、将建图结果进行保存,生成停车场库位平面地图;在线定位时通过已生成的建图结果,通过对库位边界以及二维码的实时识别优化求解当前车辆的位置,实现分米级的高精度定位。
7.1离线地图的保存
在完成建图优化工作后,将地图中的二维码和库位位置坐标及属性信息(库位的编号、长度、宽度、方向等)存储为文本信息,供在线定位使用。
7.2在线定位中离线地图的使用
在线定位时,首先从文本中读取离线地图信息,进行地图初始化,再用步骤2、3中的检测方法识别车库中的二维码及库位信息、利用步骤5进行在线优化,最终实时获得车辆在离线地图中的位置,并进一步对离线地图进行精化,达到分米级定位效果。
创新点:
1.利用低成本视觉传感器与惯性导航设备结合二维码和库位信息进行高精度室内定位;
2.定位与建图的速度能够满足实际应用中的实时性需求;
3.导航地图在被使用的同时可以不断迭代优化,最终趋于稳定;
4.使用二维码和库位作为定位地图中的地标,既可用于车辆的自主定位,又符合人类对地图的认知规律。
Claims (7)
1.基于库位和二维码的停车场自动建图与高精度定位方法,其特征在于,包括如下过程:
步骤1、通过前视单目相机以及鱼眼环视相机获得车辆前方以及车辆四周地面的图像信息,所述图像信息是单目相机采集的车库中张贴的二维码标志和环视相机采集的俯视图;
包括视觉传感器布置与标定:
步骤1.1视觉传感器布置
采用1个前视相机和4个鱼眼环视相机;所述前视相机布置于汽车前挡风玻璃与后视镜之间;所述鱼眼环视相机布置于车辆前后保险杠,以及左右后视镜;
步骤1.2标定
通过棋盘格内参标定法(为现有技术)分别对前视相机和鱼眼相机的内参数进行标定,通过地面标志点对鱼眼相机的外参数进行标定,获得拼接后的俯视图。
步骤2、从前视图像中识别并提取二维码标志的类型和二维码的四个角点,利用二维码的平面假设计算车辆与二维码之间的相对位置关系;
步骤2.1二维码布置
将二维码打印,然后将其张贴在停车场的立柱与墙面之上;
步骤2.2检测并计算车辆与二维码之间的相对位置关系;
步骤3、从环视图像中提取库位的边界线,计算库位边界在车辆坐标系中的坐标,同时对库位的编号进行识别;
步骤3.1库位布置
库位需为停车场标准库位,其包括平直的库位线以及库位编号(英文字母与阿拉伯数字)。
3.2检测并计算
在获得环视相机俯视图后,利用机器视觉方法,检测俯视图中的停车库位线与库位编号;由于俯视图标定在步骤2构建的车身坐标系(x轴方向垂直航向向右,y轴方向沿航向指向车辆行驶方向)下,因此库位近端两个角点坐标可直接读出,远端两个角点利用库位规则估算得到;
步骤4、利用二维码标志的编号、库位位置和编号,对重复观测的库位以及二维码进行离线闭环优化,消除累积噪声;
通过不断重复观测二维码标记或库位位置来修正累积误差,在离线建图过程中,使用图优化方法建立地图;
步骤5、实时通过扩展卡尔曼滤波器优化融合基于库位和二维码分别求解出的车辆位置信息,以及通过惯性导航观测得到的车辆位移信息,实现优化建图;
步骤6、利用图优化方法对建图结果进行多次优化,提高建图的精度:
首先对结点和边进行均匀采样,进行全局图优化,再以全局图中的点为基准,进行局部图优化;
步骤7、将建图结果进行保存,生成停车场库位平面地图;在线定位时通过已生成的建图结果,通过对库位边界以及二维码的实时识别优化求解当前车辆的位置,实现分米级的高精度定位。
2.如权利要求1所述的方法,其特征在于,所述步骤2.2,具体为:
先检测二维码的角点坐标;
由于图像中四个角点在世界坐标系中位于同一平面上,对于每一个角点可列出方程:R·K-1·x+t=X,其中,K为相机内参数,x为角点在像空间坐标系中的坐标,R、t为相机在这一时刻的外参数,分别代表旋转和平移,X为角点在三维空间中的坐标;
由于四个角点之间的位置关系已知,根据其位置关系,可以建立一个以二维码标记中心为原点,x轴沿标记边缘方向右,y轴沿标记边缘方向向上,z轴垂直于标记平面向内的三维空间直角坐标系。在此坐标系中,X已知,此外,x已经检测确定,K通过相机标定得出,R、t自由度为6Dof,则仅需三个或以上点,即可迭代求解出R、t;
对R进行罗德里格变换,即得单目相机到二维码标记中心连线与车辆航向的夹角a,对t取二范数即为单目相机到二维码标记中心的距离d。则构建视觉标记在车身坐标系,坐标为:
x=sin(a)·d
y=cos(a)·d。
3.如权利要求1所述的方法,其特征在于,步骤4中,所述图优化方法,是以图的方式来建立优化模型,图由顶点和边组成,所述顶点是指每个时刻车辆所在位置、各视觉标记(二维码与库位)所在位置,所述边是指两时刻间基于惯性导航的推算结果,或每个时刻车辆与视觉标记的相对坐标差;每观测到一个新的视觉标记或车辆发生了位移,则在图模型中增加一个新的结点和一条边,在添加所有数据后,根据图模型中边和结点的关系,列出边误差方程,使用高斯牛顿法迭代进行优化。
4.如权利要求3所述的方法,其特征在于,所述图模型用下列误差方程描述:
<mrow>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munder>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>&Element;</mo>
<mi>C</mi>
</mrow>
</munder>
<msub>
<mi>e</mi>
<mi>k</mi>
</msub>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>k</mi>
</msub>
<mo>,</mo>
<msub>
<mi>z</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msub>
<mi>&Omega;</mi>
<mi>k</mi>
</msub>
<msub>
<mi>e</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>k</mi>
</msub>
<mo>,</mo>
<msub>
<mi>z</mi>
<mi>k</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msup>
<mi>x</mi>
<mo>*</mo>
</msup>
<mo>=</mo>
<munder>
<mrow>
<mi>arg</mi>
<mi>min</mi>
</mrow>
<mi>x</mi>
</munder>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
</mrow>
k表示图模型中任意一个结点(视觉标记或车辆);
C表示图模型中全体结点集合;
xk表示第k个结点的位置信息矩阵,若该结点为视觉标记,则存储视觉标记的位置坐标;若该结点为车辆,则存储车辆的位置坐标及航向;
zk表示由与第k个结点相关的观测获得的第k个结点的位置信息矩阵;
Ωk表示由与第k个结点相关的观测获得的协方差矩阵;
ek(xk,zk)表示xk与zk的误差函数;
F(x)是整个图模型的误差函数,x*表示图模型的全局最优解。
5.如权利要求4所述的方法,其特征在于,为了求出全局最优解x*,用高斯牛顿法对上式进行迭代求解:
首先,对F(x)进行一阶泰勒展开:
<mrow>
<mi>c</mi>
<mo>=</mo>
<munder>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>&Element;</mo>
<mi>C</mi>
</mrow>
</munder>
<msubsup>
<mi>e</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msub>
<mi>&Omega;</mi>
<mi>k</mi>
</msub>
<msub>
<mi>e</mi>
<mi>k</mi>
</msub>
</mrow>
<mrow>
<mi>b</mi>
<mo>=</mo>
<munder>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>&Element;</mo>
<mi>C</mi>
</mrow>
</munder>
<msubsup>
<mi>e</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msub>
<mi>&Omega;</mi>
<mi>k</mi>
</msub>
<msub>
<mi>J</mi>
<mi>k</mi>
</msub>
</mrow>
2
<mrow>
<mi>H</mi>
<mo>=</mo>
<munder>
<mo>&Sigma;</mo>
<mrow>
<mi>k</mi>
<mo>&Element;</mo>
<mi>C</mi>
</mrow>
</munder>
<msubsup>
<mi>J</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msub>
<mi>&Omega;</mi>
<mi>k</mi>
</msub>
<msub>
<mi>J</mi>
<mi>k</mi>
</msub>
</mrow>
表示结点信息矩阵x的初始值;
Δx表示x的修正值;
Jk表示将初始值代入ek中计算,得到的雅可比矩阵;
于是,该问题转化为对求解线性方程:
HΔx*=-b
解得新的全局最优解并作为初始值代入F(x)进行新一轮迭代。
6.如权利要求1所述的方法,其特征在于,步骤5中,每一时刻获得的视觉标记观测和车辆位移观测均含有误差,而车辆所处的位置即为待求的未知量,则可用扩展卡尔曼滤波公式描述这一问题:
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>u</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msubsup>
<mi>F</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>T</mi>
</msubsup>
<mo>+</mo>
<msub>
<mi>Q</mi>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>~</mo>
</mover>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mi>k</mi>
</msub>
<mo>-</mo>
<mi>h</mi>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>S</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mi>H</mi>
<mi>k</mi>
</msub>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msubsup>
<mi>H</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<mo>+</mo>
<msub>
<mi>R</mi>
<mi>k</mi>
</msub>
</mrow>
<mrow>
<msub>
<mi>K</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msubsup>
<mi>H</mi>
<mi>k</mi>
<mi>T</mi>
</msubsup>
<msubsup>
<mi>S</mi>
<mi>k</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
</mrow>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>k</mi>
</msub>
<msub>
<mover>
<mi>y</mi>
<mo>~</mo>
</mover>
<mi>k</mi>
</msub>
</mrow>
Pk|k=(I-KkHk)Pk|k-1
其中,
k为当前时刻,k-1为上一时刻,
x是包含车辆位置、航向及视觉标记位置的未知量矩阵,
z中包含了车辆对视觉标记的观测,
u表示惯性导航数据,
函数f()表示了上一时刻x、u对这一时刻x值的影响,
F为函数f()的雅可比矩阵,
Q和R表示观测信息和经验模型中包含的噪声。
经过上式即可增量式地得到车辆当前位置,并即时更新地图中视觉标记的位置。
7.如权利要求1所述的方法,其特征在于,步骤7中,包括
步骤7.1离线地图的保存
在完成建图优化工作后,将地图中的二维码和库位位置坐标及属性信息(库位的编号、长度、宽度、方向等)存储为文本信息,供在线定位使用;
步骤7.2在线定位中离线地图的使用
在线定位时,首先从文本中读取离线地图信息,进行地图初始化,再用步骤2、3中的检测方法识别车库中的二维码及库位信息、利用步骤5进行在线优化,最终实时获得车辆在离线地图中的位置,并进一步对离线地图进行精化,达到分米级定位效果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710397595.2A CN107180215B (zh) | 2017-05-31 | 2017-05-31 | 基于库位和二维码的停车场自动建图与高精度定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710397595.2A CN107180215B (zh) | 2017-05-31 | 2017-05-31 | 基于库位和二维码的停车场自动建图与高精度定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107180215A true CN107180215A (zh) | 2017-09-19 |
CN107180215B CN107180215B (zh) | 2020-01-31 |
Family
ID=59836013
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710397595.2A Expired - Fee Related CN107180215B (zh) | 2017-05-31 | 2017-05-31 | 基于库位和二维码的停车场自动建图与高精度定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107180215B (zh) |
Cited By (42)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107844858A (zh) * | 2017-10-25 | 2018-03-27 | 驭势科技(北京)有限公司 | 一种用于智能驾驶场景确定定位特征及布局的方法与系统 |
CN108225367A (zh) * | 2017-12-29 | 2018-06-29 | 大陆汽车投资(上海)有限公司 | 一种用于遮蔽空间的定位导航方法 |
CN108510434A (zh) * | 2018-02-12 | 2018-09-07 | 中德(珠海)人工智能研究院有限公司 | 通过球幕相机进行三维建模的方法 |
CN108717712A (zh) * | 2018-05-29 | 2018-10-30 | 东北大学 | 一种基于地平面假设的视觉惯导slam方法 |
CN109343540A (zh) * | 2018-11-30 | 2019-02-15 | 广东工业大学 | 一种基于回环检测的slam后端轨迹优化方法 |
CN109405837A (zh) * | 2018-11-14 | 2019-03-01 | 蔚来汽车有限公司 | 物体定位方法、应用和车辆 |
CN109443348A (zh) * | 2018-09-25 | 2019-03-08 | 同济大学 | 一种基于环视视觉和惯导融合的地下车库库位跟踪方法 |
CN109508474A (zh) * | 2018-10-09 | 2019-03-22 | 北京优位智停科技有限公司 | 停车场结构分布图的构建方法 |
CN109556616A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种基于视觉标记的自动建图机器人建图修整方法 |
CN109556617A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种自动建图机器人的地图要素提取方法 |
CN109631896A (zh) * | 2018-07-23 | 2019-04-16 | 同济大学 | 一种基于车辆视觉和运动信息的停车场自主泊车定位方法 |
CN109801314A (zh) * | 2019-01-17 | 2019-05-24 | 同济大学 | 一种基于深度学习的双目动态视觉传感器立体匹配方法 |
CN109883434A (zh) * | 2019-03-25 | 2019-06-14 | 魔视智能科技(上海)有限公司 | 限制场景下辅助无人车全局定位的场端及全局定位方法 |
CN109920266A (zh) * | 2019-02-20 | 2019-06-21 | 武汉理工大学 | 一种智能车辆定位方法 |
CN110097064A (zh) * | 2019-05-14 | 2019-08-06 | 驭势科技(北京)有限公司 | 一种建图方法及装置 |
WO2019153855A1 (zh) * | 2018-02-07 | 2019-08-15 | 迎刃而解有限公司 | 一种360度环绕方位及位置感知物件信息获取系统及其应用 |
CN110243360A (zh) * | 2018-03-08 | 2019-09-17 | 深圳市优必选科技有限公司 | 机器人在运动区域的地图构建及定位方法 |
CN110262517A (zh) * | 2019-07-18 | 2019-09-20 | 石家庄辰宙智能装备有限公司 | Agv系统的轨迹跟踪控制方法 |
CN110378962A (zh) * | 2018-11-27 | 2019-10-25 | 北京京东尚科信息技术有限公司 | 车载相机的标定方法、装置及计算机可读存储介质 |
CN110415550A (zh) * | 2019-07-31 | 2019-11-05 | 北京智行者科技有限公司 | 基于视觉的自动泊车方法 |
CN110411441A (zh) * | 2018-04-30 | 2019-11-05 | 北京京东尚科信息技术有限公司 | 用于多模态映射和定位的系统和方法 |
CN110481602A (zh) * | 2019-07-15 | 2019-11-22 | 广西柳钢东信科技有限公司 | 一种轨道运输设备的实时定位方法及装置 |
CN110514225A (zh) * | 2019-08-29 | 2019-11-29 | 中国矿业大学 | 一种矿井下多传感器融合的外部参数标定及精准定位方法 |
CN110542416A (zh) * | 2018-05-28 | 2019-12-06 | 上海汽车集团股份有限公司 | 一种地下车库自动定位系统及方法 |
CN110826364A (zh) * | 2018-08-09 | 2020-02-21 | 上海汽车集团股份有限公司 | 一种库位识别方法及装置 |
CN110910311A (zh) * | 2019-10-30 | 2020-03-24 | 同济大学 | 一种基于二维码的多路环视相机自动拼接方法 |
CN110969890A (zh) * | 2018-09-30 | 2020-04-07 | 上海博泰悦臻电子设备制造有限公司 | 车辆、车机设备及其在线式地图智能构造方法、云服务器 |
CN111060118A (zh) * | 2019-12-27 | 2020-04-24 | 炬星科技(深圳)有限公司 | 场景地图建立方法、设备及存储介质 |
CN111191596A (zh) * | 2019-12-31 | 2020-05-22 | 武汉中海庭数据技术有限公司 | 一种封闭区域制图方法、装置及存储介质 |
CN111197984A (zh) * | 2020-01-15 | 2020-05-26 | 重庆邮电大学 | 一种基于环境约束下的视觉-惯性运动估计方法 |
CN111242996A (zh) * | 2020-01-08 | 2020-06-05 | 郭轩 | 一种基于Apriltag标签与因子图的SLAM方法 |
CN111256689A (zh) * | 2020-01-15 | 2020-06-09 | 北京智华机器人科技有限公司 | 一种机器人定位方法、机器人和存储介质 |
CN111862672A (zh) * | 2020-06-24 | 2020-10-30 | 北京易航远智科技有限公司 | 基于顶视图的停车场车辆自定位及地图构建方法 |
CN111881235A (zh) * | 2020-07-01 | 2020-11-03 | 广州小鹏车联网科技有限公司 | 一种语义地图更新方法及装置、车辆、存储介质 |
CN112304305A (zh) * | 2020-10-31 | 2021-02-02 | 中环曼普科技(南京)有限公司 | 一种结合marker图像的车辆初始定位方法及系统 |
CN113781645A (zh) * | 2021-08-31 | 2021-12-10 | 同济大学 | 一种面向室内泊车环境的定位和建图方法 |
CN114093195A (zh) * | 2021-11-17 | 2022-02-25 | 深圳市豪位科技有限公司 | 记录车位标记方法及装置 |
CN115390116A (zh) * | 2022-09-09 | 2022-11-25 | 紫清智行科技(北京)有限公司 | 一种基于路侧图像识别与卫星图像的动态建图方法与装置 |
CN115407355A (zh) * | 2022-11-01 | 2022-11-29 | 小米汽车科技有限公司 | 库位地图的验证方法、装置及终端设备 |
CN116228870A (zh) * | 2023-05-05 | 2023-06-06 | 山东省国土测绘院 | 一种基于二维码slam精度控制的建图方法及系统 |
CN116499470A (zh) * | 2023-06-28 | 2023-07-28 | 苏州中德睿博智能科技有限公司 | 环视相机定位系统优化控制方法、装置及系统 |
CN117824666A (zh) * | 2024-03-06 | 2024-04-05 | 成都睿芯行科技有限公司 | 融合定位用二维码对、二维码标定方法及融合定位方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AU2021455956A1 (en) * | 2021-07-16 | 2024-01-04 | Thales Simulation & Training Ag | Personalized combat simulation equipment |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20130078847A (ko) * | 2011-12-31 | 2013-07-10 | 한정남 | 모의 주행 시스템 |
CN105814404A (zh) * | 2014-02-26 | 2016-07-27 | 奥迪股份公司 | 用于定位移动设备的方法和系统 |
CN205450772U (zh) * | 2016-01-05 | 2016-08-10 | 东莞市松迪智能机器人科技有限公司 | 一种全向自动导引车 |
CN106643801A (zh) * | 2016-12-27 | 2017-05-10 | 纳恩博(北京)科技有限公司 | 一种定位准确度的检测方法及电子设备 |
CN106679648A (zh) * | 2016-12-08 | 2017-05-17 | 东南大学 | 一种基于遗传算法的视觉惯性组合的slam方法 |
-
2017
- 2017-05-31 CN CN201710397595.2A patent/CN107180215B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20130078847A (ko) * | 2011-12-31 | 2013-07-10 | 한정남 | 모의 주행 시스템 |
CN105814404A (zh) * | 2014-02-26 | 2016-07-27 | 奥迪股份公司 | 用于定位移动设备的方法和系统 |
CN205450772U (zh) * | 2016-01-05 | 2016-08-10 | 东莞市松迪智能机器人科技有限公司 | 一种全向自动导引车 |
CN106679648A (zh) * | 2016-12-08 | 2017-05-17 | 东南大学 | 一种基于遗传算法的视觉惯性组合的slam方法 |
CN106643801A (zh) * | 2016-12-27 | 2017-05-10 | 纳恩博(北京)科技有限公司 | 一种定位准确度的检测方法及电子设备 |
Non-Patent Citations (1)
Title |
---|
赵永华: "基于二维码的天花板视觉同步定位与制图", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (60)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107844858A (zh) * | 2017-10-25 | 2018-03-27 | 驭势科技(北京)有限公司 | 一种用于智能驾驶场景确定定位特征及布局的方法与系统 |
CN108225367A (zh) * | 2017-12-29 | 2018-06-29 | 大陆汽车投资(上海)有限公司 | 一种用于遮蔽空间的定位导航方法 |
WO2019153855A1 (zh) * | 2018-02-07 | 2019-08-15 | 迎刃而解有限公司 | 一种360度环绕方位及位置感知物件信息获取系统及其应用 |
CN108510434A (zh) * | 2018-02-12 | 2018-09-07 | 中德(珠海)人工智能研究院有限公司 | 通过球幕相机进行三维建模的方法 |
CN108510434B (zh) * | 2018-02-12 | 2019-08-20 | 中德(珠海)人工智能研究院有限公司 | 通过球幕相机进行三维建模的方法 |
US11067997B2 (en) | 2018-03-08 | 2021-07-20 | Ubtech Robotics Corp | Simultaneous localization and mapping methods of mobile robot in motion area |
CN110243360B (zh) * | 2018-03-08 | 2022-02-22 | 深圳市优必选科技有限公司 | 机器人在运动区域的地图构建及定位方法 |
CN110243360A (zh) * | 2018-03-08 | 2019-09-17 | 深圳市优必选科技有限公司 | 机器人在运动区域的地图构建及定位方法 |
CN110411441A (zh) * | 2018-04-30 | 2019-11-05 | 北京京东尚科信息技术有限公司 | 用于多模态映射和定位的系统和方法 |
CN110411441B (zh) * | 2018-04-30 | 2023-04-07 | 北京京东乾石科技有限公司 | 用于多模态映射和定位的系统和方法 |
CN110542416A (zh) * | 2018-05-28 | 2019-12-06 | 上海汽车集团股份有限公司 | 一种地下车库自动定位系统及方法 |
CN108717712A (zh) * | 2018-05-29 | 2018-10-30 | 东北大学 | 一种基于地平面假设的视觉惯导slam方法 |
CN108717712B (zh) * | 2018-05-29 | 2021-09-03 | 东北大学 | 一种基于地平面假设的视觉惯导slam方法 |
CN109631896A (zh) * | 2018-07-23 | 2019-04-16 | 同济大学 | 一种基于车辆视觉和运动信息的停车场自主泊车定位方法 |
CN110826364A (zh) * | 2018-08-09 | 2020-02-21 | 上海汽车集团股份有限公司 | 一种库位识别方法及装置 |
CN110826364B (zh) * | 2018-08-09 | 2024-02-02 | 上海汽车集团股份有限公司 | 一种库位识别方法及装置 |
CN109443348B (zh) * | 2018-09-25 | 2022-08-23 | 同济大学 | 一种基于环视视觉和惯导融合的地下车库库位跟踪方法 |
CN109443348A (zh) * | 2018-09-25 | 2019-03-08 | 同济大学 | 一种基于环视视觉和惯导融合的地下车库库位跟踪方法 |
CN110969890A (zh) * | 2018-09-30 | 2020-04-07 | 上海博泰悦臻电子设备制造有限公司 | 车辆、车机设备及其在线式地图智能构造方法、云服务器 |
CN109508474A (zh) * | 2018-10-09 | 2019-03-22 | 北京优位智停科技有限公司 | 停车场结构分布图的构建方法 |
CN109556617A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种自动建图机器人的地图要素提取方法 |
CN109556616A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种基于视觉标记的自动建图机器人建图修整方法 |
CN109405837A (zh) * | 2018-11-14 | 2019-03-01 | 蔚来汽车有限公司 | 物体定位方法、应用和车辆 |
CN109405837B (zh) * | 2018-11-14 | 2021-06-08 | 蔚来(安徽)控股有限公司 | 物体定位方法、应用和车辆 |
CN110378962A (zh) * | 2018-11-27 | 2019-10-25 | 北京京东尚科信息技术有限公司 | 车载相机的标定方法、装置及计算机可读存储介质 |
CN109343540A (zh) * | 2018-11-30 | 2019-02-15 | 广东工业大学 | 一种基于回环检测的slam后端轨迹优化方法 |
CN109801314B (zh) * | 2019-01-17 | 2020-10-02 | 同济大学 | 一种基于深度学习的双目动态视觉传感器立体匹配方法 |
CN109801314A (zh) * | 2019-01-17 | 2019-05-24 | 同济大学 | 一种基于深度学习的双目动态视觉传感器立体匹配方法 |
CN109920266A (zh) * | 2019-02-20 | 2019-06-21 | 武汉理工大学 | 一种智能车辆定位方法 |
CN109883434B (zh) * | 2019-03-25 | 2022-08-19 | 魔视智能科技(上海)有限公司 | 限制场景下辅助无人车全局定位的场端及全局定位方法 |
CN109883434A (zh) * | 2019-03-25 | 2019-06-14 | 魔视智能科技(上海)有限公司 | 限制场景下辅助无人车全局定位的场端及全局定位方法 |
CN110097064A (zh) * | 2019-05-14 | 2019-08-06 | 驭势科技(北京)有限公司 | 一种建图方法及装置 |
CN110481602A (zh) * | 2019-07-15 | 2019-11-22 | 广西柳钢东信科技有限公司 | 一种轨道运输设备的实时定位方法及装置 |
CN110262517B (zh) * | 2019-07-18 | 2022-05-10 | 石家庄辰宙智能装备有限公司 | Agv系统的轨迹跟踪控制方法 |
CN110262517A (zh) * | 2019-07-18 | 2019-09-20 | 石家庄辰宙智能装备有限公司 | Agv系统的轨迹跟踪控制方法 |
CN110415550A (zh) * | 2019-07-31 | 2019-11-05 | 北京智行者科技有限公司 | 基于视觉的自动泊车方法 |
CN110514225A (zh) * | 2019-08-29 | 2019-11-29 | 中国矿业大学 | 一种矿井下多传感器融合的外部参数标定及精准定位方法 |
CN110910311B (zh) * | 2019-10-30 | 2023-09-26 | 同济大学 | 一种基于二维码的多路环视相机自动拼接方法 |
CN110910311A (zh) * | 2019-10-30 | 2020-03-24 | 同济大学 | 一种基于二维码的多路环视相机自动拼接方法 |
CN111060118A (zh) * | 2019-12-27 | 2020-04-24 | 炬星科技(深圳)有限公司 | 场景地图建立方法、设备及存储介质 |
CN111060118B (zh) * | 2019-12-27 | 2022-01-07 | 炬星科技(深圳)有限公司 | 场景地图建立方法、设备及存储介质 |
CN111191596A (zh) * | 2019-12-31 | 2020-05-22 | 武汉中海庭数据技术有限公司 | 一种封闭区域制图方法、装置及存储介质 |
CN111242996A (zh) * | 2020-01-08 | 2020-06-05 | 郭轩 | 一种基于Apriltag标签与因子图的SLAM方法 |
CN111256689A (zh) * | 2020-01-15 | 2020-06-09 | 北京智华机器人科技有限公司 | 一种机器人定位方法、机器人和存储介质 |
CN111256689B (zh) * | 2020-01-15 | 2022-01-21 | 北京智华机器人科技有限公司 | 一种机器人定位方法、机器人和存储介质 |
CN111197984A (zh) * | 2020-01-15 | 2020-05-26 | 重庆邮电大学 | 一种基于环境约束下的视觉-惯性运动估计方法 |
CN111862672A (zh) * | 2020-06-24 | 2020-10-30 | 北京易航远智科技有限公司 | 基于顶视图的停车场车辆自定位及地图构建方法 |
CN111881235A (zh) * | 2020-07-01 | 2020-11-03 | 广州小鹏车联网科技有限公司 | 一种语义地图更新方法及装置、车辆、存储介质 |
CN112304305A (zh) * | 2020-10-31 | 2021-02-02 | 中环曼普科技(南京)有限公司 | 一种结合marker图像的车辆初始定位方法及系统 |
CN113781645A (zh) * | 2021-08-31 | 2021-12-10 | 同济大学 | 一种面向室内泊车环境的定位和建图方法 |
CN113781645B (zh) * | 2021-08-31 | 2024-03-26 | 同济大学 | 一种面向室内泊车环境的定位和建图方法 |
CN114093195A (zh) * | 2021-11-17 | 2022-02-25 | 深圳市豪位科技有限公司 | 记录车位标记方法及装置 |
CN115390116A (zh) * | 2022-09-09 | 2022-11-25 | 紫清智行科技(北京)有限公司 | 一种基于路侧图像识别与卫星图像的动态建图方法与装置 |
CN115407355B (zh) * | 2022-11-01 | 2023-01-10 | 小米汽车科技有限公司 | 库位地图的验证方法、装置及终端设备 |
CN115407355A (zh) * | 2022-11-01 | 2022-11-29 | 小米汽车科技有限公司 | 库位地图的验证方法、装置及终端设备 |
CN116228870A (zh) * | 2023-05-05 | 2023-06-06 | 山东省国土测绘院 | 一种基于二维码slam精度控制的建图方法及系统 |
CN116499470A (zh) * | 2023-06-28 | 2023-07-28 | 苏州中德睿博智能科技有限公司 | 环视相机定位系统优化控制方法、装置及系统 |
CN116499470B (zh) * | 2023-06-28 | 2023-09-05 | 苏州中德睿博智能科技有限公司 | 环视相机定位系统优化控制方法、装置及系统 |
CN117824666A (zh) * | 2024-03-06 | 2024-04-05 | 成都睿芯行科技有限公司 | 融合定位用二维码对、二维码标定方法及融合定位方法 |
CN117824666B (zh) * | 2024-03-06 | 2024-05-10 | 成都睿芯行科技有限公司 | 融合定位用二维码对、二维码标定方法及融合定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107180215B (zh) | 2020-01-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107180215A (zh) | 基于库位和二维码的停车场自动建图与高精度定位方法 | |
CN109631887B (zh) | 基于双目、加速度与陀螺仪的惯性导航高精度定位方法 | |
CN107246868B (zh) | 一种协同导航定位系统及导航定位方法 | |
CN110068836B (zh) | 一种智能驾驶电动清扫车的激光雷达路沿感知系统 | |
EP2948927B1 (en) | A method of detecting structural parts of a scene | |
Alonso et al. | Accurate global localization using visual odometry and digital maps on urban environments | |
Levinson et al. | Map-based precision vehicle localization in urban environments. | |
CN107229063A (zh) | 一种基于gnss和视觉里程计融合的无人驾驶汽车导航定位精度矫正方法 | |
CN109631896A (zh) | 一种基于车辆视觉和运动信息的停车场自主泊车定位方法 | |
US11512975B2 (en) | Method of navigating an unmanned vehicle and system thereof | |
Qu et al. | Landmark based localization in urban environment | |
CN107422730A (zh) | 基于视觉导引的agv运输系统及其驾驶控制方法 | |
CN108226938A (zh) | 一种agv小车的定位系统和方法 | |
CN109583409A (zh) | 一种面向认知地图的智能车定位方法及系统 | |
CN108534782A (zh) | 一种基于双目视觉系统的地标地图车辆即时定位方法 | |
CN111426320B (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
Senlet et al. | Satellite image based precise robot localization on sidewalks | |
CN109443348A (zh) | 一种基于环视视觉和惯导融合的地下车库库位跟踪方法 | |
CN113580134B (zh) | 视觉定位方法、设备、机器人、存储介质及程序产品 | |
CN113220818B (zh) | 一种停车场自动建图与高精度定位方法 | |
Hoang et al. | 3D motion estimation based on pitch and azimuth from respective camera and laser rangefinder sensing | |
Rehder et al. | Submap-based SLAM for road markings | |
CN115574816A (zh) | 仿生视觉多源信息智能感知无人平台 | |
Gakne et al. | Tackling the scale factor issue in a monocular visual odometry using a 3D city model | |
Ragab et al. | Leveraging vision-based structure-from-motion for robust integrated land vehicle positioning systems in challenging GNSS environments |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200131 |