[发明专利]点云数据处理方法及其装置、激光雷达、可移动平台在审
申请号: | 201980033234.7 | 申请日: | 2019-09-27 |
公开(公告)号: | CN112154356A | 公开(公告)日: | 2020-12-29 |
发明(设计)人: | 蒋卓键 | 申请(专利权)人: | 深圳市大疆创新科技有限公司 |
主分类号: | G01S17/93 | 分类号: | G01S17/93;G01S17/58;G01S19/52;G01S19/47;G01C21/16 |
代理公司: | 中科专利商标代理有限责任公司 11021 | 代理人: | 赵婷 |
地址: | 518057 广东省深圳市南山区高*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 数据处理 方法 及其 装置 激光雷达 移动 平台 | ||
1.一种点云数据处理方法,其特征在于,包括:
获取当前帧,确定所述当前帧中的障碍物;
获取所述当前帧之前的历史帧,确定所述障碍物在所述历史帧中的位置和速度;
根据所述障碍物在所述历史帧中的位置和速度,将所述历史帧中的所述障碍物的点云数据累积至所述当前帧。
2.如权利要求1所述的点云数据处理方法,其特征在于,所述确定所述障碍物在所述历史帧中的位置,包括:
在所述历史帧中识别出所述障碍物;
从所述历史帧中的所述障碍物的点云数据,提取出所述障碍物在所述历史帧中的位置。
3.如权利要求2所述的点云数据处理方法,其特征在于,所述在所述历史帧中识别出所述障碍物,包括:
分别获取所述当前帧的特征点和所述历史帧的特征点;
根据所述当前帧的特征点和所述历史帧的特征点,通过光流算法确定所述当前帧的障碍物是否为所述历史帧的障碍物。
4.如权利要求1所述的点云数据处理方法,其特征在于,根据预设传感器的测量值确定所述障碍物在所述历史帧中的速度。
5.如权利要求4所述的点云数据处理方法,其特征在于,根据预设传感器的测量值,利用卡尔曼滤波器确定所述障碍物在所述历史帧中的速度。
6.如权利要求5所述的点云数据处理方法,其特征在于,所述卡尔曼滤波器包括:状态方程、测量方程;
所述利用卡尔曼滤波器确定所述障碍物在所述历史帧中的速度,包括:
根据所述状态方程和所述测量方程进行迭代运算确定所述障碍物在所述历史帧中的速度;所述测量方程包括所述预设传感器的测量值。
7.如权利要求6所述的点云数据处理方法,其特征在于,所述预设传感器为多个,所述测量值通过多个所述预设传感器的测量结果的融合得到。
8.如权利要求5所述的点云数据处理方法,其特征在于,所述预设传感器至少包括以下其中一种:惯性测量单元、轮速计、卫星定位单元。
9.如权利要求1所述的点云数据处理方法,其特征在于,所述将所述历史帧中的所述障碍物的点云数据累积至所述当前帧,包括:
根据所述障碍物在所述历史帧中的速度,确定所述障碍物从所述历史帧至所述当前帧的移动距离;
根据所述障碍物在所述历史帧中的位置、以及所述移动距离,确定所述历史帧中的所述障碍物在所述当前帧中的预测位置;
根据所述预测位置更新所述历史帧中的所述障碍物的点云数据,将更新后的所述点云数据补充至所述当前帧。
10.如权利要求9所述的点云数据处理方法,其特征在于,所述确定所述障碍物从所述历史帧至所述当前帧的移动距离,包括:
确定所述历史帧与所述当前帧的时间差;
根据所述障碍物在所述历史帧中的速度、以及所述时间差,得到所述移动距离。
11.如权利要求9所述的点云数据处理方法,其特征在于,所述更新所述历史帧中的所述障碍物的点云数据,包括:
将所述历史帧中的所述障碍物的点云数据的位置坐标替换为所述预测位置的位置坐标。
12.如权利要求9所述的点云数据处理方法,其特征在于,还包括:
将位于预设位置范围之外的预测位置作为噪点位置;
将与所述噪点位置对应的点云数据从所述当前帧中去除。
13.如权利要求12所述的点云数据处理方法,其特征在于,所述预设位置范围至少包括:
执行所述点云数据处理方法的点云处理装置的坐标系下至少一个维度的范围。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市大疆创新科技有限公司,未经深圳市大疆创新科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201980033234.7/1.html,转载请声明来源钻瓜专利网。