[发明专利]基于天花板图像信息的机器人定位与地图构建系统

摘要

本发明涉及机器人领域，特别是涉及一种基于天花板图像信息的机器人定位与地图构建系统。本发明提供的系统包括图像获取模块，设置在机器人上，其光轴垂直于天花板，用于在机器人运动时对天花板进行拍摄，获取当前天花板图像信息；所述图像处理模块，用于对所述图像获取模块获取的天花板图像信息进行处理；所述特征提取模块，用于在所述图像处理模块处理后的图像信息中提取特征，得到图像特征集；所述特征跟踪模块，用于对所述特征提取模块提取出的图像特征集中的每一个图像特征进行匹配跟踪，得到跟踪后的图像特征集；所述存储管理模块，用于存储所述特征跟踪模块得到的图像特征集，并根据所述图像特征集绘制地图。本发明方便地图构建。

主权项

一种基于天花板图像信息的机器人定位与地图构建系统，其特征在于，所述系统包括：图像获取模块，特征提取模块，特征跟踪模块和存储管理模块；所述图像获取模块，设置在机器人上，其光轴垂直于天花板，用于在机器人运动时对天花板进行拍摄，获取当前天花板图像信息；所述图像处理模块，用于对所述图像获取模块获取的天花板图像信息进行处理；所述特征提取模块，用于在所述图像处理模块处理后的图像信息中提取特征，得到图像特征集；所述特征跟踪模块，用于对所述特征提取模块提取出的图像特征集中的每一个图像特征进行匹配跟踪，得到跟踪后的图像特征集；所述存储管理模块，用于存储所述特征跟踪模块得到的图像特征集，并根据所述图像特征集绘制地图；所述图像特征为角点特征，所述图像特征集为角点特征集；所述特征跟踪模块包括光流跟踪模块和校正模块；所述光流跟踪模块，用于通过Lucas—Kanade光流法跟踪当前图像的角点特征集中每一个角点特征，得到跟踪角点特征集；所述校正模块，用于对所述述光流跟踪模块得到跟踪角点特征集进行校正；所述校正模块在当前帧图像上重新提取角点特征，得到新的角点特征集，将通过所述光流跟踪模块得到的跟踪角点特征集中每个角点特征与新的角点特征集中的角点特征在预设窗口范围内重合的角点特征作为校正后的角点特征集；所述校正模块包括第一跟踪单元，第二跟踪单元和判断单元：设当前帧图像为图像imgA，其角点特征集为A，下一帧图像为imgB；所述第一跟踪单元，用于以角点特征集A为基础，在下一帧图像imgB跟踪得到角点特征集B；所述第二跟踪单元，用于以角点特征集B为基础，在当前帧图像imgA跟踪得到角点特征集B2；所述判断单元，用于判断所述角点特征集A的各角点特征标号是否与所述角点特征集B2中的各角点特征标号相同，若相同，则取标号相同的角点特征加入预备角点特征集中；所述校正模块包括提取单元，预测单元，对比单元：所述提取单元，用于提取当前图像的角点特征集B2；在B2中有一部分角点特征已经存在于跟踪所述当前图像得到的跟踪角点特征集B；所述预测单元，用于依照角点特征库中的角点特征预测当前图像的角点特征集B’；所述对比单元，用于对比B2、B和B’，将B2中没有出现在B与B’的角点特征判断为新角点特征，将通过阈值的新角点特征加入到角点特征库中。