[发明专利]机器人位姿确认方法、装置、计算机设备及存储介质有效
申请号: | 202010037603.4 | 申请日: | 2020-01-14 |
公开(公告)号: | CN111238496B | 公开(公告)日: | 2022-04-22 |
发明(设计)人: | 高子庆 | 申请(专利权)人: | 深圳市锐曼智能装备有限公司 |
主分类号: | G01C21/30 | 分类号: | G01C21/30;G06T7/73;G06K17/00 |
代理公司: | 武汉华强专利代理事务所(普通合伙) 42237 | 代理人: | 温珊姗 |
地址: | 518000 广东省深圳市宝安区福永街道大*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 确认 方法 装置 计算机 设备 存储 介质 | ||
本发明实施例公开了机器人位姿确认方法、装置、计算机设备及存储介质,包括:获取机器人检测到预设的定位装置时相对里程计坐标系的第一位姿信息;计算得到机器人位于世界坐标系中的第一偏移位姿信息;获取计算完成所述偏移位姿信息时所述机器人相对里程计坐标系的第二位姿信息;将第一位姿信息与第二位姿信息之间的第二偏移位姿信息与所述第一偏移位姿信息累加,得到所述机器人在世界坐标系的目标位姿。本申请采用机器人标定定位装置的反向过程在实际移动过程中识别定位装置,并以此获取得到机器人在世界坐标中的目标位姿,使机器人对自身位姿识别更准确。
技术领域
本发明实施例涉及机器人导航技术领域,尤其是一种机器人位姿确认方法、装置、计算机设备及存储介质。
背景技术
常见的机器人位姿确认方法是采用激光在地图中匹配出吻合的地形来确认最终定位和机器人姿态的方法,此方法受地形相似、人流量过大产生许多临时障碍物等的影响比较大。
现有技术中公开了通过天花板上粘贴RFID标签辅助定位的方法来将机器人全地图定位区域缩小至1.5米的区域内,在定位上较激光定位准确了很多。但RFID标签不能提供方向信息,还是无法更有效地保证机器人姿态的准确性,且区域只能降低到1.5米范围内,而无法得到具体的坐标定位。
发明内容
本发明实施例提供能够通过采用机器人标记标定装置,并用机器人上的摄像装置识别标定装置以确定机器人在世界坐标中的位姿,实现方式简单,识别率准确。
为解决上述技术问题,本发明创造的实施例采用的一个技术方案是:一种机器人位姿确认方法,包括:
获取机器人检测到预设的定位装置时相对里程计坐标系的第一位姿信息;
计算得到机器人位于世界坐标系中的第一偏移位姿信息;
获取计算完成所述偏移位姿信息时所述机器人相对里程计坐标系的第二位姿信息;
将第一位姿信息与第二位姿信息之间的第二偏移位姿信息与所述第一偏移位姿信息累加,得到所述机器人在世界坐标系的目标位姿。
可选的,所述计算得到机器人位于世界坐标系中的第一偏移位姿信息包括:
获取预设的定位装置的定位信息;
根据所述定位信息计算得到机器人上的摄像头坐标系与定位装置坐标系的第一旋转矩阵和第一偏移矩阵;
根据所述第一旋转矩阵和所述第一偏移矩阵计算得到机器人位于世界坐标系中的第一偏移位姿信息。
可选的,所述根据所述第一旋转矩阵和所述第一偏移矩阵计算得到机器人位于世界坐标系中的第一偏移位姿信息包括:
通过预设的定位装置的定位信息列表,根据所述定位信息得到所述机器人世界坐标系与定位装置坐标系的第二旋转矩阵和第二偏移矩阵;
根据所述第一旋转矩阵与所述第二旋转矩阵计算得到世界坐标系与摄像头坐标系的第三旋转矩阵,根据所述第一偏移矩阵与所述第二偏移矩阵计算得到世界坐标系与摄像头坐标系的第三偏移矩阵;
根据所述第三旋转矩阵和所述第三偏移矩阵计算生成机器人位于世界坐标系中的第一偏移位姿信息。
可选的,所述根据所述第三旋转矩阵和所述第三偏移矩阵计算生成机器人位于世界坐标系中的第一偏移位姿信息包括:
根据摄像头安装在所述机器人的位置得到机器人坐标系与摄像头坐标系的第四旋转矩阵与第四偏移矩阵;
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市锐曼智能装备有限公司,未经深圳市锐曼智能装备有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010037603.4/2.html,转载请声明来源钻瓜专利网。
- 上一篇:一种格斗机器人
- 下一篇:煤矿井下随钻测井探管电源控制方法及系统