一种同步建立激光地图和标签地图的方法技术

本发明专利技术提供一种同步建立激光地图和标签地图的方法，本发明专利技术在建立激光子图的时候，同步记录标签在激光子图中的局部坐标，在完成激光图的整体建立后，使用激光子图间的回环信息，对标签进行回环修正，得到符合激光地图坐标系的标签地图；本发明专利技术增强了机器人的环境适用性，面对标签比较稀疏的场合，以激光为主，标签为辅的融合地图更能有效地为机器人描述环境特征；本发明专利技术增强了机器人定位的稳定性，单纯的激光定位很容易受到环境变化的影响，本发明专利技术的融合地图在激光地图的基础上添加了标签，利用标签定位进行位姿修正，可以让机器人定位更加稳定

【技术实现步骤摘要】
一种同步建立激光地图和标签地图的方法


[0001]本专利技术涉及机器人建图
，尤其是一种同步建立激光地图和标签地图的方法
。

技术介绍

[0002]送餐机器人室内定位的主流方法为激光定位和标签定位，但两种定位方式都有明显的缺点
。
[0003]对于单纯的激光定位，它对环境的变化比较敏感，障碍物位置的移动会影响激光定位的评分；对于单纯的标签定位，需要识别天花板上粘贴的标签进行定位计算，而在天花板较高的区域，标签识别效果的变差会影响标签定位的评分
。
[0004]在上述的情景中，单纯的激光地图无法满足机器人稳定定位的需求，又因为标签的分布是稀疏，因此普通的标签建图方法效果也不理想，为解决这个问题，提出一种同步建立激光地图和标签地图的方法
。

技术实现思路

[0005]针对现有技术的不足，本专利技术提供一种同步建立激光地图和标签地图的方法，本专利技术能够适应标签稀疏的环境，建立准确无误的机器人定位地图
。
[0006]本专利技术的技术方案为：一种同步建立激光地图和标签地图的方法，包括以下步骤：
[0007]S1)、
记录当前机器人的里程计数据，记录当前激光雷达数据，并将当前激光雷达数据加入临时激光子图，将当前机器人位姿记为激光子图坐标系的原点；建立第一个子图时，机器人的位姿认为是
(0
，0，
0)
；
[0008]S2)、
持续获取机器人的里程计数据和激光雷达数据，并根据前后两个时刻机器人的里程计数据计算前后两个时刻机器人的位移增量
Δ
s
和角度增量
Δθ
；并将其分解为激光子图坐标系的
X
轴
、Y
轴位移，然后将增量位移增量
Δ
s
和角度增量
Δθ
与前一时刻的机器人位姿
(x
last
，
y
last
，
θ
last
)
进行叠加，计算得到机器人当前的预测位姿
(x
guess
，
y
guess
，
θ
guess
)
；具体如下：
[0009][0010]S3)、
激光匹配定位
[0011]将当前的激光雷达数据与临时激光子图中的数据进行匹配，选取重合度最高的结果作为当前机器人的真实位姿
(x
local
，
y
local
，
θ
local
)
；
[0012]S4)、
获取标签数据
[0013]利用红外相机获取天花板图像，并对该天花板图像进行图像识别得到标签数据，如果当前没有拍摄到标签则跳转到步骤
S6)
，否则执行步骤
S5)
；
[0014]S5)、
计算标签在激光子图中的位姿
[0015]根据步骤
S4)
得到的标签数据，获取标签相对于相机中心的偏移距离
(x
bias
，
y
bias
)、
相对于相机正方向的角度偏差
θ
bias
；将基于相机坐标系的偏移距离
(x
bias
，
y
bias
)
和角度偏差
θ
bias
变换为激光子图坐标系下的数据，并与当前机器人在激光子图下的真实位姿
(x
local
，
y
local
，
θ
local
)
进行叠加，以得到标签在激光子图的局部坐标
(x
label
，
y
label
，
θ
label
)
，计算方式如下：
[0016][0017]计算完成后，执行步骤
S6)
；
[0018]S6)、
激光子图更新：
[0019]将当前的激光雷达数据加入临时激光子图，并判定临时激光子图是否已有
40
帧激光雷达数据，如果临时激光子图已有
40
帧激光雷达数据，则该子图定义为一个激光子图；并判定建图是否完成，如果是，则执行步骤
S7)
；如果建图未完成，则执行步骤
S2)
；
[0020]S7)、
回环修正
[0021]通过人工输入或者子图间自主匹配的方式对所有的激光子图进行回环数据计算，得到回环数据；将回环数据按照预设的图优化算法对激光子图进行运算，以调整子图的位置，使整个激光地图更符合实际情况，同时，按照预设的图优化算法对标签数据进行运算，以修正标签位置
。
[0022]作为优选的，步骤
S1)
中，所述的临时激光子图是指不足
40
帧的激光数据的集合
。
[0023]作为优选的，步骤
S1)、S2)
中，获取的所述的激光雷达数据为极坐标系下的激光雷达数据，需要将其转换为直角坐标系下的激光雷达数据
。
[0024]作为优选的，步骤
S1)、
步骤
S2)
中
、
将处于极坐标系下的激光雷达数据转换为直角坐标系下的激光雷达数据，具体为：
[0025]已知极坐标系下的雷达数据为
(r
，
θ
)
，则直角坐标系下的激光雷达数据
(x
laser
，
y
laser
)
为：
[0026][0027]作为优选的，步骤
S2)
中，所述的根据前后两个时刻机器人的里程计数据计算前后两个时刻机器人的位移增量
Δ
s
和角度增量
Δθ
，具体如下：
[0028]已知前一时刻的里程计数据为
(x
odom_t
，
y
odom_t
，
θ
odom_t
)
，后一时刻的里程计数据为
(x
odom_(t+1)
，
y
odom_(t+1)
，
θ
odom_(t+1)
)
，则可以计算得到：
[0029][0030]作为优选的，步骤
S3)
中，将直角坐标系下的激光雷达数据与临时激光子图进行匹配，选取重合度最高的结果作为当前机器人的位姿
(x
local
，
y
local
，
θ
loc本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种同步建立激光地图和标签地图的方法，其特征在于，包括以下步骤：
S1)、
记录当前机器人的里程计数据，记录当前激光雷达数据，并将当前激光雷达数据加入临时激光子图，将当前机器人位姿记为激光子图坐标系的原点；建立第一个子图时，机器人的位姿认为是
(0
，0，
0)
；
S2)、
持续获取机器人的里程计数据和激光雷达数据，并根据前后两个时刻机器人的里程计数据计算前后两个时刻机器人的位移增量
Δ
s
和角度增量
Δθ
；并将其分解为激光子图坐标系的
X
轴
、Y
轴位移，然后将增量位移增量
Δ
s
和角度增量
Δθ
与前一时刻的机器人位姿
(x
last
，
y
last
，
θ
last
)
进行叠加，计算得到机器人当前的预测位姿
(x
guess
，
y
guess
，
θ
guess
)
；具体如下：
S3)、
激光匹配定位将当前的激光雷达数据与临时激光子图中的数据进行匹配，选取重合度最高的结果作为当前机器人的真实位姿
(x
local
，
y
local
，
θ
local
)
；
S4)、
获取标签数据利用红外相机获取天花板图像，并对该天花板图像进行图像识别得到标签数据，如果当前没有拍摄到标签则跳转到步骤
S6)
，否则执行步骤
S5)
；
S5)、
计算标签在激光子图中的位姿根据步骤
S4)
得到的标签数据，获取标签相对于相机中心的偏移距离
(x
bias
，
y
bias
)、
相对于相机正方向的角度偏差
θ
bias
；将基于相机坐标系的偏移距离
(x
bias
，
y
bias
)
和角度偏差
θ
bias
变换为激光子图坐标系下的数据，并与当前机器人在激光子图下的真实位姿
(x
local
，
y
local
，
θ
local
)
进行叠加，以得到标签在激光子图的局部坐标
(x
label
，
y
label
，
θ
label
)
，计算方式如下：计算完成后，执行步骤
S6)
；
S6)、
激光子图更新：将当前的激光雷达数据加入临时激光子图，并判定临时激光子图是否已有
40
帧激光雷达数据，如果临时激光子图已有
40
帧激光雷达数据，则该子图定义为一个激光子图；并判定建图是否完成，如果是，则执行步骤
S7)
；如果建图未完成，则执行步骤
S2)
；
S7)、
回环修正通过人工输入或者子图间自主匹配的方式对所有的激光子图进行回环数据计算，得到回环数据；将回环数据按照预设的图优化算法对激光子图进行运算，以调整子图的位置，使整个激光地图更符合实际情况，同时，按照预设的图优化算法对标签数据进行运算，以修正标签位置
。2.
根据权利要求1所述的一种同步建立激光地图和标签地图的方法，其特征在于：步骤
S1)
中，所述的临时激光子图是指不足
40
帧的激光数据的集合
。
3.
根据权利要求1所述的一种同步建立激光地图和标签地图的方法，其特征在于：步骤
S1)、S2)
中，获取的所述的激光雷达数据为极坐标系下的激光雷达数据，需要将其转换为直角坐标系下的激光雷达数据
。4.
根据权利要求3所述的一种同步建立激光地图和标签地图的方法，其特征在于：步骤
S1)、
步骤
S2)
中
、
将处于极坐标系下的激光雷达数据转换为直角坐标系下的激光雷达数据，具体为：已知极坐标系下的雷达数据为
(r
，
θ
)
，则直角坐标系下的激光雷达数据
(x
laser
，
y
laser
)
为：
5.
根据权利要求1所述的一种同步建立激光地图和标签地图的方法，其特征在于：步骤
S2)
中，所述的根据前后两个时刻机器人的里程计数据计算前后两个时刻机器人的位移增量
Δ
s
和角度增量
Δθ
，具体如下：
S31)、
已知前一时刻的里程计数据为
(x
odom_t
，
y
odom_t
，
θ
odom_t
)
，后一时刻的里程计数据为
(x
odom_(t+1)
，
...

【专利技术属性】
技术研发人员：杜继能，何汉烜，胡显达，
申请(专利权)人：广州市申迪计算机系统有限公司，
类型：发明
国别省市：