首页 / 专利库 / 人工智能 / 人工智能 / 机器人技术 / 机器人 / 非完整机器人 / 一种多传感器数据融合的机器人定位方法

一种多传感器数据融合的机器人定位方法

阅读:985发布:2020-07-02

专利汇可以提供一种多传感器数据融合的机器人定位方法专利检索,专利查询,专利分析的服务。并且本 发明 提供了一种多 传感器 数据融合的 机器人 定位 方法,环境识别传感器将采集的外部环境信息传递给工控机并绘制环境地图,通过相互之间的配合来判断机器人自身的 位姿 以及是否移动到目标的区域,通过 传感器数据 的配合使用可以对机器人进行良好的定位。本发明通过双目相机、 激光雷达 和差分GPS的配合使用,向机器人传达了更丰富的环境信息,解决了二维激光环境信息少,三维激光成本高的问题,同时也提供了更加准确的室外定位信息。,下面是一种多传感器数据融合的机器人定位方法专利的具体信息内容。

1.一种多传感器数据融合的机器人定位方法,其特征在于,定位步骤如下:
步骤一:将双目相机和激光雷达联合标定,得到双目相机的内参、外参以及双目相机相对于激光雷达的旋转和平移阵以纠正双目相机的畸变偏差;
步骤二:激光雷达、双目相机和差分GPS同时采集机器人外部的二维环境信息、三维环境信息及位姿信息并传递给工控机,分别建立完整的离线二维环境栅格地图、离线三维特征环境信息及离线环境位姿信息;
步骤三:工控机对离线二维环境栅格地图和离线三维特征环境信息进行映射匹配处理,得到激光雷达和双目相机的匹配关系K1;工控机对离线三维特征环境信息和离线环境位姿信息进行映射匹配处理,得到差分GPS和双目相机的匹配关系K2;
步骤四:将激光雷达扫描的实时二维环境信息S1传递给工控机,工控机利用激光雷达和双目相机的匹配关系K1对实时二维环境信息S1进行处理,得到第一关键位姿信息S1′;
将差分GPS获取的机器人实时位姿信息S2传递给工控机,工控机利用差分GPS和双目相机的匹配关系K2对机器人实时位姿信息S2进行处理,得到第二关键帧位姿信息S2′;
将双目相机扫描的实时三维环境信息S3传递给工控机;
步骤五:通过卡尔曼滤波算法对第一关键帧位姿信息S1′和第二关键帧位姿信息S2′进行融合筛选得到姿态信息S4,再将姿态信息S4与实时三维环境信息S3进行加权处理,得到机器人的当前定位姿态信息S。
2.如权利要求1所述的多传感器数据融合的机器人定位方法,其特征在于,所述映射匹配为非线性化映射匹配或局部线性映射匹配。
3.如权利要求1所述的多传感器数据融合的机器人定位方法,其特征在于,所述激光雷达的扫描度满足不能扫描到机器人本体
4.如权利要求1所述的多传感器数据融合的机器人定位方法,其特征在于,所述激光雷达、双目相机和差分GPS的扫描频率一致。
5.如权利要求1所述的多传感器数据融合的机器人定位方法,其特征在于,所述差分GPS的天线安装直线与机器人偏航方向平行;若不平行,二者进行对应的坐标变换。

说明书全文

一种多传感器数据融合的机器人定位方法

技术领域

[0001] 本发明涉及一种机器人定位方法,具体涉及多传感器数据融合的机器人定位方法。

背景技术

[0002] 随着计算能和传感器等技术的不断增强,室外巡逻型和安防型机器人的功能也变得日益增大,与此同时,多传感器数据的混合使用也变得日益多样。此时,机器人不再局限于单一的传感器的使用,而可以通过多传感器数据的相互配合从而获得更加准备的环境以及位姿信息。多传感器数据的相互配合使用做位机器人定位的重要手段,需要比较强的计算能力,现在计算机的发展正好为此条件提供了良好的基础
[0003] 现有的机器人定位方法大多使用多个二维传感器获取环境信息,多个二维传感器配合使用的必然缺陷导致机器人定位精度不是很高,这样的机器人会出现在导航定位中的效果相对较差,且可拓展性也不足的问题;获取三维环境信息的三维激光成本又高。

发明内容

[0004] 有鉴于此,本发明提供了一种多传感器数据融合的机器人定位方法,通过双目相机、激光雷达和差分GPS的配合使用,向机器人传达了更丰富的环境信息,解决了二维激光环境信息少,三维激光成本高的问题,同时也提供了更加准确的室外定位信息。
[0005] 一种多传感器数据融合的机器人定位方法,定位步骤如下:
[0006] 步骤一:将双目相机和激光雷达联合标定,得到双目相机的内参、外参以及双目相机相对于激光雷达的旋转和平移阵以纠正双目相机的畸变偏差;
[0007] 步骤二:激光雷达、双目相机和差分GPS同时采集机器人外部的二维环境信息、三维环境信息及位姿信息并传递给工控机,分别建立完整的离线二维环境栅格地图、离线三维特征环境信息及离线环境位姿信息;
[0008] 步骤三:工控机对离线二维环境栅格地图和离线三维特征环境信息进行映射匹配处理,得到激光雷达和双目相机的匹配关系K1;工控机对离线三维特征环境信息和离线环境位姿信息进行映射匹配处理,得到差分GPS和双目相机的匹配关系K2;
[0009] 步骤四:将激光雷达扫描的实时二维环境信息S1传递给工控机,工控机利用激光雷达和双目相机的匹配关系K1对实时二维环境信息S1进行处理,得到第一关键位姿信息S1′;
[0010] 将差分GPS获取的机器人实时位姿信息S2传递给工控机,工控机利用差分GPS和双目相机的匹配关系K2对机器人实时位姿信息S2进行处理,得到第二关键帧位姿信息S2′;
[0011] 将双目相机扫描的实时三维环境信息S3传递给工控机;
[0012] 步骤五:通过卡尔曼滤波算法对第一关键帧位姿信息S1′和第二关键帧位姿信息S2′进行融合筛选得到姿态信息S4,再将姿态信息S4与实时三维环境信息S3进行加权处理,得到机器人的当前定位姿态信息S。
[0013] 进一步地,所述映射匹配为非线性化映射匹配或局部线性映射匹配。
[0014] 进一步地,所述激光雷达的扫描度满足不能扫描到机器人本体
[0015] 进一步地,所述激光雷达、双目相机和差分GPS的扫描频率一致。
[0016] 进一步地,所述差分GPS的天线安装直线与机器人偏航方向平行;若不平行,二者进行对应的坐标变换。
[0017] 有益效果:
[0018] 1、本发明中双目相机使机器人可以获取三维环境信息,激光雷达可以获取二维环境信息,差分GPS可以获取机器人的位置信息,通过双目相机、激光雷达和GPS数据的配合使用,向机器人传达了更丰富的环境信息,解决了二维激光环境信息少,三维激光成本高的问题,并且可以在单一传感器失效的情况下另外一个传感器也能继续完成任务,能够满足室外安防机器人定位的需要,同时也提供了更加准确的室外定位信息。
[0019] 2、本发明采用多样性的算法应用与双目相机结合起来,使得其对机器人定位有一定的可扩展性。
[0020] 3、本发明采用非线性映射匹配或局部线性映射,是为了保证位于同一个坐标系下,并且提高了鲁棒性。
[0021] 4、本发明设置激光雷达的扫描角度保证获取外部环境信息的精确性。
[0022] 5、本发明激光雷达、双目相机和差分GPS的扫描频率一致,保证采集外部环境信息的精确性。
[0023] 6、本发明差分GPS的天线安装直线与机器人偏航方向平行,若不平行,二者进行对应的坐标变换,保证采集外部环境信息的精确性。附图说明
[0024] 附图为本发明的结构原理图。

具体实施方式

[0025] 下面结合附图并举实施例,对本发明进行详细描述。
[0026] 本发明提供了一种多传感器数据融合的机器人定位方法,如附图所示,环境识别传感器将采集的外部环境信息传递给工控机并绘制环境地图,通过相互之间的配合来判断机器人自身的位姿以及是否移动到目标的区域,通过传感器数据的配合使用可以对机器人进行良好的定位。
[0027] 本发明的环境识别传感器包括:激光雷达、双目相机和差分GPS。
[0028] 具体定位步骤如下:
[0029] 步骤一:将双目相机和激光雷达联合标定,得到双目相机的内参、外参以及双目相机相对于激光雷达的旋转和平移阵以纠正双目相机的畸变偏差;
[0030] 步骤二:将激光雷达的扫描频率设为10hz,扫描角度设置为180度;将差分GPS的定位姿频率设为10hz,天线安装直线与机器人偏航方向平行,若不平行,二者进行对应的坐标变换;将双目相机的扫描的频率同样设为10hz,双目相机的广角采用70度;
[0031] 编译ORBSLAM,采用建图模式对外部信息进行离线建特征点图,激光雷达、双目相机和差分GPS同时采集机器人外部的二维环境信息、三维环境信息及位姿信息并传递给工控机,采用建图模式,分别建立完整的离线二维环境栅格地图、离线三维特征环境信息及离线环境位姿信息;
[0032] 步骤三:工控机对离线二维环境栅格地图和离线三维特征环境信息进行非线性化映射匹配处理,得到激光雷达和双目相机的匹配关系K1;工控机对离线三维特征环境信息和离线环境位姿信息进行非线性化映射匹配处理,得到差分GPS和双目相机的匹配关系K2;
[0033] 此处的映射匹配方法也可以采用局部线性映射匹配,需要先将离线二维环境栅格地图、离线三维特征环境信息及离线环境位姿信息进行分处理,然后再进行局部线性映射匹配,实现功能与非线性化映射匹配相同,保证进行映射的坐标系位于同一个坐标系下;
[0034] 步骤四:将匹配关系带入双目相机中,目的是为了让双目相机和其他传感器的坐标系一致,得到最终双目相机的输出结果;
[0035] 在定位模式下,将激光雷达扫描的实时二维环境信息S1传递给工控机,工控机利用激光雷达和双目相机的匹配关系K1对实时二维环境信息S1进行处理,得到第一关键帧位姿信息S1′;
[0036] 将差分GPS获取的机器人实时位姿信息S2传递给工控机,工控机利用差分GPS和双目相机的匹配关系K2对机器人实时位姿信息S2进行处理,得到第二关键帧位姿信息S2′;
[0037] 将双目相机扫描的实时三维环境信息S3传递给工控机;
[0038] 步骤五:通过卡尔曼滤波算法对第一关键帧位姿信息S1′和第二关键帧位姿信息S2′进行融合筛选得到姿态信息S4,再将姿态信息S4与实时三维环境信息S3进行加权处理,得到机器人的当前定位姿态信息S。
[0039] 此时得到的当前定位姿态信息S较为精确。
[0040] 综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈