【CN110000784A】一种机器人回充定位导航方法、系统、设备及存储介质【专利】
- 格式:pdf
- 大小:782.01 KB
- 文档页数:14
(19)中华人民共和国国家知识产权局
(12)发明专利申请
(10)申请公布号 (43)申请公布日 (21)申请号 201910282127.X
(22)申请日 2019.04.09
(71)申请人 深圳市远弗科技有限公司
地址 518000 广东省深圳市南山区前湾一
路1号A栋201室
(72)发明人 张陈 郑峰 张哲
(74)专利代理机构 北京知呱呱知识产权代理有
限公司 11577
代理人 丁彦峰 贺亚明
(51)Int.Cl.
B25J 9/16(2006.01)
(54)发明名称
一种机器人回充定位导航方法、系统、设备
及存储介质
(57)摘要
本发明实施例公开了一种机器人回充定位
导航方法、系统、设备及存储介质,涉及机器人定
位导航技术领域,本发明实施例通过高反光材料
做成的反光标志、由红外发射器、红外接收器、图
像处理器形成的深度相机来实现机器人的回充
定位导航,利用人造的已知特征图案不但能在可
见光充足的环境良好运作,同时解决环境光照不
足以及黑暗情况下的充电桩定位以及机器人回
充导航问题,反光标志通过反光材料层贴在塑料
底层上,把黑色塑料片层镂空成特定标志,贴在
反光材料层上,从而为识别提供特征图案,这种
做法可以有效抑制近距离下反光标志在红外图
中的发散现象;另外,在黑色塑料片上加一层透
红外滤光片,用于减轻超近距离下反光材料的过
曝现象。
权利要求书2页 说明书7页 附图4页CN 110000784 A 2019.07.12
C N 110000784
A
权 利 要 求 书1/2页CN 110000784 A
1.一种机器人回充定位导航方法,其特征在于,所述方法包括:
向充电桩主体发射红外线;
通过反光标志反射照射到充电桩主体的竖直部分的正面的红外线;
采集反光标志反射的红外线并成像;
基于成像图像进行图像识别分析;及
基于图形识别分析结果对机器人相对于充电桩的位置进行定位并引导机器人靠近充电桩自动回充。
2.如权利要求1所述的方法,其特征在于,所述反光标志设置在充电桩主体的竖直部分的正面,所述反光标志包括塑料底层、反光材料层、黑色塑料片层和透红外滤光片,所述反光材料层贴在所述塑料底层上,所述黑色塑料片层镂空成特定标志图案并贴在所述反光材料层上,形成用于图像识别的特征标志图案,所述透红外滤光片盖在所述黑色塑料片层上。
3.如权利要求2所述的方法,其特征在于,所述充电桩主体的竖直部分与垂直方向之间存在一个仰角。
4.如权利要求2所述的方法,其特征在于,所述反光标志上形成的特征标志图案包括若干反光面积不同的第一类反光图案和第二类反光图案,所述第一类反光图案的反光面积大于所述第二类反光图案的反光面积。
5.如权利要求4所述的方法,其特征在于,所述机器人的定位和引导根据所述机器人距所述充电桩主体的距离采用第一类反光图案和第二类反光图案结合的方案;其包括:远距离和角度偏移达到或超过预定值的情况下,对通过第一类反光图案反射红外线成像后得到的IR图进行自适应阈值处理,然后进行图像低通模糊,再进行阈值处理,检测出图案的高亮部分,并跟环境中的不规则高亮区分开,根据高亮区域在IR图中的大概位置,估计出充电桩的粗略角度,然后控制机器人靠近充电桩并调整角度以接近正对充电桩;
中距离和角度偏移位于预定值范围内的情况下,对通过第一类反光图案反射红外线成像后得到的IR图进行自适应阈值处理,然后进行图像低通模糊,再进行阈值处理,计算得到每个反光图案的几何中心,对每个中心利用其周围最近的n个点计算其描述子,并与模板帧上的点进行匹配,根据匹配结果,计算当前相对于充电桩的单应矩阵,根据提前标定的相机内参和单应矩阵得到旋转矩阵和平移向量,进而调整机器人以正对的角度接近充电桩;及近距离下和角度偏移位于预定值范围内的情况下,对通过第二类反光图案反射红外线成像后得到的IR图进行自适应阈值处理,然后进行图像低通模糊,再进行阈值处理,计算得到每个反光图案的几何中心,对每个中心利用其周围最近的n个点计算其描述子,并与模板帧上的点进行匹配,根据匹配结果,计算当前相对于充电桩的单应矩阵,根据提前标定的相机内参和单应矩阵得到旋转矩阵和平移向量,进而调整机器人以正对的角度接近充电桩;
其中,n个点为至少四个点,四个点中至少有三个点不共线。
6.如权利要求5所述的方法,其特征在于,所述机器人的定位和引导还包括:利用所述第一类反光图案或所述第二类反光图案反射红外线成像后得到的深度图提供的深度信息,获取机器人相对于充电桩的预估距离信息,基于预估距离信息对机器人进行定位和引导。
7.一种机器人回充定位导航系统,其特征在于,所述系统包括:
设置于机器人上的深度相机以及设置于充电桩主体的竖直部分的正面的反光标志,所述深度相机包括:红外接收器、附带于所述红外接收器上的红外发射器以及与所述红外接
2。