[发明专利]定位方法、装置、自移动设备和存储介质有效
| 申请号: | 202011106787.1 | 申请日: | 2020-10-16 |
| 公开(公告)号: | CN112013858B | 公开(公告)日: | 2021-07-02 |
| 发明(设计)人: | 张彦刚;高梓翔 | 申请(专利权)人: | 北京猎户星空科技有限公司 |
| 主分类号: | G01C21/32 | 分类号: | G01C21/32;G01C21/34;G01S17/46;G01S17/89;G01C21/16;G01C22/00 |
| 代理公司: | 北京清亦华知识产权代理事务所(普通合伙) 11201 | 代理人: | 张大威 |
| 地址: | 100026 北京市朝阳区*** | 国省代码: | 北京;11 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 定位 方法 装置 移动 设备 存储 介质 | ||
1.一种定位方法,其特征在于,所述方法包括以下步骤:
获取图像传感器采集的图像;其中,所述图像中展示有图案部分,以及标记点部分;
根据所述图案部分中的非对称图案,确定候选坐标系;
根据所述标记点部分中的各标记点在所述候选坐标系中的坐标位置,解码得到目标编码;
若所述标记点的个数小于设定阈值个数,则查询所述目标编码对应的辅助标记点在世界坐标系中的第一坐标位置,以及在设定的标准坐标系中的坐标位置;
根据所述辅助标记点在所述标准坐标系中的坐标位置,确定所述辅助标记点在所述图像中的第二坐标位置;
将所述辅助标记点确定为在所述世界坐标系中处于所述第一坐标位置,且在所述图像中处于第二坐标位置的所述标记点;
根据所述目标编码,查询得到各所述标记点在世界坐标系中的坐标位置;
根据各所述标记点在所述世界坐标系中的坐标位置,以及在所述图像中的坐标位置,确定搭载所述图像传感器的自移动设备在所述世界坐标系下的位姿。
2.根据权利要求1所述的定位方法,其特征在于,所述根据所述图案部分中的非对称图案,确定候选坐标系,包括:
根据所述非对称图案中的设定参考线,确定所述候选坐标系的坐标轴;其中,所述坐标轴的方向,是根据所述非对称图案中设定局部图案所在位置确定的;
和/或,
根据所述非对称图案中设定关键点所在位置,确定所述候选坐标系中设定的坐标点。
3.根据权利要求1所述的定位方法,其特征在于,所述根据所述标记点部分中的各标记点在所述候选坐标系中的坐标位置,解码得到目标编码,包括:
将所述候选坐标系,与设定的标准坐标系进行坐标系变换,得到所述候选坐标系与所述标准坐标系之间的仿射变换矩阵;
采用所述仿射变换矩阵,将各所述标记点在所述候选坐标系中的坐标位置变换至所述标准坐标系下,以得到各所述标记点在所述标准坐标系中的坐标位置;
根据各所述标记点在所述标准坐标系中的坐标位置,确定对应的目标编码。
4.根据权利要求1所述的定位方法,其特征在于,所述根据所述标记点部分中的各标记点在所述候选坐标系中的坐标位置,解码得到目标编码,包括:
将所述候选坐标系,与设定的标准坐标系进行坐标系变换,得到所述候选坐标系与所述标准坐标系之间的仿射变换矩阵;
采用所述仿射变换矩阵,将各所述标记点在所述候选坐标系中的坐标位置变换至所述标准坐标系下,以得到所述标准坐标系下各所述标记点与所述标准坐标系中坐标轴之间的夹角和/或与所述标准坐标系原点的距离;
根据所述标准坐标系下各所述标记点与所述标准坐标系中坐标轴之间的夹角和/或与所述标准坐标系原点的距离,确定对应的目标编码。
5.根据权利要求3或4所述的定位方法,其特征在于,所述根据所述辅助标记点在所述标准坐标系中的坐标位置,确定所述辅助标记点在所述图像中的第二坐标位置,包括:
采用所述仿射变换矩阵,将所述辅助标记点在所述标准坐标系中的坐标位置变换至所述候选坐标系下,以得到所述辅助标记点在所述候选坐标系中的坐标位置;
根据所述候选坐标系的原点在所述图像中的坐标位置,确定所述辅助标记点在所述图像中的第二坐标位置。
6.根据权利要求1-4任一项所述的定位方法,其特征在于,所述获取图像传感器采集的图像之后,还包括:
根据所述图像中各像素点的取值,确定所述图案部分。
7.根据权利要求6所述的定位方法,其特征在于,所述根据所述图案部分中的非对称图案,确定候选坐标系之后,还包括:
根据所述候选坐标系,确定所述标记点部分的设定分布范围;
在所述图像中的所述设定分布范围内识别各所述标记点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京猎户星空科技有限公司,未经北京猎户星空科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011106787.1/1.html,转载请声明来源钻瓜专利网。





