[发明专利]一种考虑速度因素的激光雷达测距的快速数值仿真方法有效
申请号: | 202010750633.X | 申请日: | 2020-07-30 |
公开(公告)号: | CN111624583B | 公开(公告)日: | 2020-10-30 |
发明(设计)人: | 华炜;高健健;谢天;李融 | 申请(专利权)人: | 之江实验室 |
主分类号: | G01S7/497 | 分类号: | G01S7/497;G01S17/08;G06F30/20 |
代理公司: | 杭州求是专利事务所有限公司 33200 | 代理人: | 贾玉霞 |
地址: | 310023 浙江省杭州市余*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 考虑 速度 因素 激光雷达 测距 快速 数值 仿真 方法 | ||
1.一种考虑速度因素的激光雷达测距的快速数值仿真方法,其特征在于,包括以下步骤:
(1)设待仿真的机械旋转式激光雷达器为Lidar,设定其工作方式和参数如下:Lidar具有NL个激光发射器,这些激光发射器以频率f同步发射激光射线,每个激光发射器发出1条激光射线,其起点均为Lidar上的同一个点,称该点为基准点,所有激光发射器围绕着过基准点的一根直线进行定轴旋转,称该直线为转轴,垂直于转轴的平面为基准面,同一时刻激光发射器发射的NL条射线位于垂直于基准面的平面内,任选转轴一侧方向为转轴方向,这NL条激光射线与转轴方向形成的夹角依次为Q0,Q1,Q2,...,QNL-1,满足Qi Qj, 0=ijNL;Lidar每个扫描周期开始时刻射出的激光射线在基准面上的垂直投影都重合于由基准点发出的一条射线,该射线称为基准线,在一个扫描周期T时间内激光发射器所旋转过的角度为Fmax=ωT,ω为在扫描周期T内激光发射器的旋转角速度,在扫描周期结束后激光发射器回到扫描周期开始时的位置与姿态;Lidar的最大探测距离为Dmax;Lidar上的基准点、基准线、基准面和转轴位置与姿态均定义在固定于Lidar的物体坐标系中;
(2) 选择正整数K,将扫描角度范围[0,Fmax]分成为K个扫描角度区间[F0,F1],[F1,F2],...,[FK-1,FK],使得每个水平扫描角度区间小于180度,其中F0=0,FK=Fmax;
(3)开始Lidar一个水平扫描周期的测距仿真:设此时的仿真时刻为tnT,对每个仿真时刻tk= tnT+Fk/ω,其中k∈{0,1,...K-1},进行如下处理:
(3.1)计算更新在tk时刻Lidar以及Lidar周围可反射激光的物体的位置与姿态;
(3.2)采样Lidar周围可反射激光的物体表面,计算生成点集Bk,对于任意采样点q∈Bk,点q满足j(q)∈[Fk,Fk+1]、q(q)∈[Q0,QNL-1]且基准点到点q距离小于等于Dmax;其中,点q为R(q)与Lidar周围可反射激光的物体表面相交的最近的一个交点,R(q)为从基准点出发经过点q的射线,j(q)为R(q)在基准面上的投影与基准线的夹角,q(q)为R(q)与转轴方向的夹角;
(3.3)生成一个具有ML列NL行的二维数据结构Ck ,并将每个元素初始化为非有效值,其中ML为大于等于(Fk+1-Fk)f/ω的最小整数,对每个i∈{0,1,2...ML-1},采用如下步骤计算Ck的第i列元素:
(3.3.1)当i为0时,直接执行步骤(3.3.2);当i大于0时,计算更新在tk+i×f-1时刻Lidar和其周围可反射激光的物体的位置与姿态;
(3.3.2)遍历Bk中每个点q,根据点q所属物体的位置与姿态,计算更新在tk+i×f-1时刻点q的位置,并判断点q是否满足以下条件:
(I)|j(q)-Fk -(i/ML)(Fk+1 - Fk)|≤d1
(II) |q(q)-Qjj|≤d2
其中,d1为第一预设阈值,d2为第二预设阈值,Qjj为序列{Q0,Q1,Q2,...,QNL-1}中与q(q)最接近的值,jj是该值在序列中的序号;
(3.3.3)若点q同时满足上述条件(I)(II),则用基准点与点q的距离来更新Ck的第i列第jj行元素Ck[i,jj];若点q没有同时满足上述条件(I)(II),则检验下一个点q是否满足条件(I)(II);
(3.4)输出C0,C1,...CK-1,这些数据结构为当前扫描周期的Lidar的仿真测距结果,其中第k个数据结构Ck的第i列元素所保存的数值是仿真时刻tnT+Fk/ω+i×f-1的NL个激光发射器的仿真测距结果;
(4)若仿真没有达到终止条件,执行步骤3);否则结束仿真过程。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于之江实验室,未经之江实验室许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010750633.X/1.html,转载请声明来源钻瓜专利网。