融合激光定位的远距二维码地图创建及定位方法技术

本发明专利技术提供了一种融合激光定位的远距二维码地图创建及定位方法

【技术实现步骤摘要】
融合激光定位的远距二维码地图创建及定位方法、系统


[0001]本专利技术涉及室内空间建图定位技术，尤其涉及一种融合激光定位的远距二维码地图创建及定位方法
、
系统
。

技术介绍

[0002]目前主流的移动机器人建图定位方案，通常采用激光建图技术，如机器人使用当前激光点云与点云地图匹配实现激光定位
。
然而实际实施过程中，由于存在场景变化因素，例如，在堆垛，解垛，窄通道，动态场景下等，容易受到环境及堆放物
、
移动物体的遮挡及干扰影响，阻挡激光雷达的扫描，加上机器人运动机构时常还存在打滑现象，从而使得采用纯激光定位在长时间的实际运行部署中存在一定的局限
。
[0003]为此，专利技术人考虑到远距二维码定位的特殊性，可以将远距二维码设置在室内天花板上这种无遮挡
、
开阔的环境中，此时相机在拍摄远距二维码的过程中，将不易受到地面环境的影响，同时若采用人工标记方式，在场景中容易发生定位丢失的区域内设置远距二维码进行辅助定位，则可减少或避免前述此类问题的发生，以在该些场景下获得定位优势
。

技术实现思路

[0004]为此，本专利技术的主要目的在于提供一种融合激光定位的远距二维码地图创建及定位方法
、
系统，以实现
技术介绍
中提出的方案，获得在该些场景下的定位优势
。
[0005]为了实现上述目的，根据本专利技术的第一个方面，提供了一种融合激光定位的远距二维码地图创建方法，步骤包括：/>[0006]步骤
S100
将远距二维码设置在建图区域顶部相对于相机的仰望位；建立建图区域的激光地图，并获取激光定位信息；
[0007]步骤
S200
经相机获取含远距二维码的图像，以提取远距二维码在相机坐标系下的空间位姿；
[0008]步骤
S300
当判断相机观测到的图像中含有首次观测到的远距二维码时，计算首次观测到的远距二维码在激光地图中的空间位置，并将其加入远距二维码地图中
。
[0009]在可能的优选实施方式中，步骤
S300
中，计算首次观测到的远距二维码在激光地图中的空间位置的步骤包括：
[0010]步骤
S310
通过因子图形式融合所有时刻的激光定位信息及远距二维码在相机坐标系下的空间位姿，构建最大后验概率问题优化激光地图中每一个远距二维码的空间位置
。
[0011]在可能的优选实施方式中，步骤
S310
中，构建最大后验概率问题优化激光地图中每一个远距二维码的空间位置的步骤包括：
[0012]步骤
S311
设所有远距二维码在激光地图中的位置为，使用测量值约束待优化变量，使用贝叶斯网络建模为，通过最大后验概率求解优化后的状态变量：
[0013][0014]其中，测量值为一组测量值的集合：
[0015]表示处于移动机器人位于第个位置时相机对的观测；
[0016]表示处于移动机器人在激光地图中的第个位置；
[0017] 表示相机在车体坐标系下的安装位置
。
[0018]在可能的优选实施方式中，所述远距二维码，包括：定位码，信息码，其中定位码由数个方向点围绕中心点在数个非交叉方向布设而成，并在各个相邻方向点的夹角处划分出数个象限区域，所述信息码根据预设码表布设在对应象限区域中，以与定位码组成二维点阵，其中定位码与信息码表面设有反光层
。
[0019]在可能的优选实施方式中，步骤
S200
中，提取远距二维码在相机坐标系下的空间位姿的步骤包括：
[0020]步骤
S210
获取包含远距二维码信息的图像做二值化处理后，进行边缘提取；
[0021]步骤
S220
根据提取的边缘信息进行椭圆拟合检测，获取原始 码及其圆心坐标；
[0022]步骤
S230
根据定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置，以筛选出原始码中的信息码，并根据通码表来获取远距二维码的
ID
信息；
[0023]步骤
S240
当判断该
ID
下的远距二维码首次出现时，根据定位码在图像中的圆心坐标，计算对应远距二维码在相机坐标系下的空间位姿并与该
ID
信息绑定
。
[0024]在可能的优选实施方式中，步骤
S240
中计算远距二维码在相机坐标系下空间位姿的步骤包括：
[0025]步骤
S241
设定位码的圆心坐标为，建立齐次矩阵
[0026][0027]基于
SVD
法求解单应性矩阵
H
，其中
u
，
v
表示定位码圆心的像素坐标
、
表示远距二维码坐标系下点的坐标，
s
为等效距离比例因子；
[0028]步骤
S242
根据单应性矩阵与远距二维码在相机坐标系下转换矩阵的关系
[0029][0030]求得旋转和平移矩阵，其中
P
为相机投影矩阵
、E
为截断外参矩阵，
, 分别为相机方向和方向的焦距，，为相机中心点坐标，为旋转矩阵中的前两列，
, , 分别表示在相机坐标系下远距二维码中心的位置，为3×3的单应投影矩阵
。
[0031]在可能的优选实施方式中，步骤
S240
中还包括：
[0032]步骤
243
通过迭代优化方法求解最小化误差函数
[0033][0034]以优化旋转和平移矩阵，其中
R
表示旋转，
t
表示平移
[0035][0036][0037]表示平移向量中的第
i
个元素，表示旋转矩阵中的第
i
列；其中分别表示图像中第个远距二维码的圆心投影到相机归一化坐标系中的坐标；表示所有定位码的的圆心坐标；分别表示由远距二维码中第个定位码的圆心空间坐标，按照旋转平移矩阵转换到相机归一化平面中的点的坐标；表示在远距二维码坐标系中每一个定位码的圆心空间坐标；
[0038]其中在求解过程中以
[0039][0040]作为约束条件
。
[0041]在可能的优选实施方式中，步骤
S200
中，提取远距二维码在相机坐标系下的空间位姿的步骤还包括：
[0042]步骤
S250 按照时间过滤和先验位姿约束，对经步骤
S240
获得的空间位姿进行约束，其中时间过滤步骤包括：当判断空间位姿结果存在突变时，滤除；先验位姿约束步骤包括：当判断空间位姿结果中远距二维码坐标系和相机坐标系处于非平行时，滤除
。
...

【技术保护点】

【技术特征摘要】
1.
一种融合激光定位的远距二维码地图创建方法，步骤包括：步骤
S100
将远距二维码设置在建图区域顶部相对于相机的仰望位；建立建图区域的激光地图，并获取激光定位信息；步骤
S200
经相机获取含远距二维码的图像，以提取远距二维码在相机坐标系下的空间位姿；步骤
S300
当判断相机观测到的图像中含有首次观测到的远距二维码时，计算首次观测到的远距二维码在激光地图中的空间位置，并将其加入远距二维码地图中
。2.
与根据权利要求1所述的基于远距二维码的地图创建方法，其中步骤
S300
中，计算首次观测到的远距二维码在激光地图中的空间位置的步骤包括：步骤
S310
通过因子图形式融合所有时刻的激光定位信息及远距二维码在相机坐标系下的空间位姿，构建最大后验概率问题优化激光地图中每一个远距二维码的空间位置
。3.
根据权利要求2所述的基于远距二维码的地图创建方法，其中步骤
S310
中，构建最大后验概率问题优化激光地图中每一个远距二维码的空间位置的步骤包括：步骤
S311
设所有远距二维码在激光地图中的位置为，使用测量值约束待优化变量，使用贝叶斯网络建模为，通过最大后验概率求解优化后的状态变量：
;
其中，测量值为一组测量值的集合：表示处于移动机器人位于第个位置时相机对的观测；表示处于移动机器人在激光地图中的第个位置； 表示相机在车体坐标系下的安装位置
。4.
根据权利要求1所述的融合激光定位的远距二维码地图创建方法，其中所述远距二维码，包括：定位码，信息码，其中定位码由数个方向点围绕中心点在数个非交叉方向布设而成，并在各个相邻方向点的夹角处划分出数个象限区域，所述信息码根据预设码表布设在对应象限区域中，以与定位码组成二维点阵，其中定位码与信息码表面设有反光层
。5.
根据权利要求4所述的融合激光定位的远距二维码地图创建方法，其中步骤
S200
中，提取远距二维码在相机坐标系下的空间位姿的步骤包括：步骤
S210
获取包含远距二维码信息的图像做二值化处理后，进行边缘提取；步骤
S220
根据提取的边缘信息进行椭圆拟合检测，获取原始 码及其圆心坐标；步骤
S230
根据定位码的几何关系，定位出原始码中对应各远距二维码的定位码分布位置，以筛选出原始码中的信息码，并根据通码表来获取远距二维码的
ID
信息；步骤
S240
当判断该
ID
下的远距二维码首次出现时，根据定位码在图像中的圆心坐标，计算对应远距二维码在相机坐标系下的空间位姿并与该
ID
信息绑定
。6.
根据权利要求5所述的融合激光定位的远距二维码地图创建方法，其中步骤
S240
中计算远距二维码在相机坐标系下空间位姿的步骤包括：步骤
S241
设定位码的圆心坐标为，建立齐次矩阵
;
基于
SVD
法求解单应性矩阵
H
，其中
u
，
v
表示定位码圆心的像素坐标
、
表示远距二维码坐标系下点的坐标，
s
为等效距离比例因子；步骤
S242
根据单应性矩阵与远距二维码在相机坐标系下转换矩阵的关系
;
求得旋转和平移矩阵，...

【专利技术属性】
技术研发人员：刘洋洋，赵越，
申请(专利权)人：上海仙工智能科技有限公司，
类型：发明
国别省市：