[发明专利]定位方法、系统及可移动平台在审
| 申请号: | 201980033572.0 | 申请日: | 2019-09-26 |
| 公开(公告)号: | CN112219225A | 公开(公告)日: | 2021-01-12 |
| 发明(设计)人: | 江灿森;张宏辉;李建 | 申请(专利权)人: | 深圳市大疆创新科技有限公司 |
| 主分类号: | G06T7/73 | 分类号: | G06T7/73;G06T7/187;G06T7/11 |
| 代理公司: | 中科专利商标代理有限责任公司 11021 | 代理人: | 王晓晗 |
| 地址: | 518057 广东省深圳市南山区高*** | 国省代码: | 广东;44 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 定位 方法 系统 移动 平台 | ||
1.一种定位方法,其特征在于,包括:
获取由传感器采集的点云,所述点云用于标识可移动平台周围环境的地面,所述传感器设置在所述可移动平台;
确定所述点云的目标特征点,并确定高精地图的参考特征点;
根据所述目标特征点和所述参考特征点,确定所述点云相对于所述高精地图的第一自由度信息;
通过所述第一自由度信息矫正所述点云的位姿;
根据所述高精地图上的参考特征点,以及矫正后的所述点云上的所述目标特征点,确定所述点云相对于所述高精地图的第二自由度信息;
根据所述第二自由度信息,在所述高精地图上对所述可移动平台进行定位。
2.根据权利要求1所述的方法,其特征在于,所述第一自由度信息包括Pitch参数、Roll参数和Z参数,所述第二自由度信息包括X参数、Y参数和Yaw参数。
3.根据权利要求2所述的方法,其特征在于,所述确定所述点云的目标特征点,包括:
确定所述点云在Z轴方向上投影得到的点云面中的目标特征点。
4.根据权利要求3所述的方法,其特征在于,所述方法还包括:
在所述高精地图上对所述可移动平台的所处的目标位置区域进行预测;
所述确定高精地图的参考特征点,包括:
确定所述高精地图上位于所述目标位置区域的高精地图面的参考特征点。
5.根据权利要求4所述的方法,其特征在于,所述根据所述目标特征点和所述参考特征点,确定所述点云相对于所述高精地图的第一自由度信息,包括:
获取多个待选转换矩阵,所述待选转换矩阵用于将所述点云面在Pitch、Roll和Z三个自由度的位姿矫正至与所述高精地图面一致;
根据所述目标特征点对应的高度值和所述参考特征点对应的高度值,计算每一待选转换矩阵对应的矫正损失量;
确定最小的矫正损失量对应的待选转换矩阵为目标转换矩阵;
根据所述目标转换矩阵确定所述第一自由度信息。
6.根据权利要求5所述的方法,其特征在于,所述点云面包括多个点云投影点;所述确定所述点云在Z轴方向上投影得到的点云面中的目标特征点,包括执行以下任意操作:
根据特征提取算法在所述点云面上提取特征点作为所述目标特征点,其中,提取的所述特征点包括用于表征角点或边缘点的所述点云投影点;
根据预设网格尺寸对投影得到的所述点云面进行网格划分,将所述网格的中心像素作为所述目标特征点。
7.根据权利要求6所述的方法,其特征在于,所述目标特征点对应的高度值基于如下操作确定:
若所述目标特征点为所述点云投影点,则将所述点云投影点对应的投影高度作为所述目标特征点对应的高度值;
若所述目标特征点为所述网格的中心像素,则将所述网格中其他所述点云投影点对应的投影高度的均值作为所述目标特征点的高度值。
8.根据权利要求5至7中任一项所述的方法,其特征在于,所述根据所述目标特征点对应的高度值和所述参考特征点对应的高度值,计算每一待选转换矩阵对应的矫正损失量,包括:
将所述目标特征点和所述参考特征点进行配对处理,确定多个特征点配对组;
计算每一组已配对的所述目标特征点的对应的高度值和所述参考特征点对应的高度值之间的高度差;
根据计算得到的多个所述高度差,确定所述矫正损失量。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市大疆创新科技有限公司,未经深圳市大疆创新科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201980033572.0/1.html,转载请声明来源钻瓜专利网。





