[发明专利]一种二维扫描型激光雷达的扫描数据修正方法及系统

说明书

技术领域

本发明涉及传感器检测领域，特别是一种二维扫描型激光雷达的扫描数据修正方法及系统。

背景技术

二维扫描型激光雷达可准确实时的提供一定范围内(一般为0°～180°)位于单个扫描平面内的距离信息，近年来，二维扫描型激光雷达由于具有体积小、价格合理、精度高等优势而被广泛用于机器人领域，配合其他传感器进行环境检测，并完成任务。

通过集成在激光雷达激光发射器上的可旋转镜片，激光雷达可在正前方测量区域中建立一个二维的扇形测量面(一般是0°～180°)，激光雷达发出的激光束接触到扇形测量面内的目标表面后反射回来，即可以建立被扫描目标表面的二维轮廓图。

从上述扫描型激光雷达的原理可以看出，当激光雷达和环境处于相对静止的时，测量值精度较高。但是当激光雷达或环境处于相对运动状态时，由于激光雷达的激光发射线是依靠负载电机的转动从而覆盖出扇形的扫描区域，那么，在测量范围的上限(如0°)和下限(如180°)是在两个不同时刻的测量值，因此，一个扫描周期下的环境数据并不是同一时刻的数据。假设激光雷达扫描角度是150°，角度分辨率是30°，扫描周期为100ms，速度为1单位/100ms，如图1所示，图1为激光雷达运动状态下误差来源示意图；当第一线激光束发出时，激光雷达处于1#位置，当激光雷达到达6#位置时，一个扫描周期结束。此时，激光雷达记录的数据分别是：{1，2，3，4，5，⑥}，而从图中显然可以看到，当激光雷达处于6#位置的时候，其距离数据应该为：{①，②，③，④，⑤，⑥}，因此，测量数据产生了误差。不难看出，产生误差的来源主要由2个方面影响：环境(如墙体)相对激光雷达的角度和激光雷达相对环境(如墙体)的速度。

如果将二维扫描型激光雷达安放在对速度相对较快，且对环境检测实时性要求较高时，往往需要修正激光雷达的环境数据。目前，针对如何解决运动状态下二维扫描型激光雷达的扫描数据误差问题，国内外还没有相关文献及研究。随着该类型激光雷达的快速普及，对运动状态下出现的误差的修正有着重要的意义。

发明内容

本发明的目的就是提供一种二维扫描型激光雷达的扫描数据修正方法；该方法针对二维扫描型激光雷达处于运动情况下，其扫描数据修正的方法。适用于二维扫描型激光雷达环境检测方面。

本发明的目的是通过这样的技术方案实现的：

本发明提供的二维扫描型激光雷达的扫描数据修正方法，包括以下步骤：

S1：获取激光雷达扫描参数，所示扫描参数包括扫描周期、角度分辨率、扫描范围、线数；

S2：获取扫描周期内第i线激光束的距离信息；

S3：根据第i线激光束的距离信息和上一周期的该线激光束的距离获取第i线激光束相对于扫描环境的当前角度；

S4：通过传感器获取激光雷达当前速度；

S5：根据当前速度获取第i线激光束到扫描环境的当前距离；

S6：根据激光雷达第i线激光束的当前距离和激光雷达的当前速度得到第i线激光束的修正值；

S7：获取第i线激光束在t时刻的扫描距离；

S8：利用第i线激光束的修正值和扫描距离得到第i线激光束在t时刻扫描的真实扫描值；

S9：重复循环步骤S2-S8得到激光雷达所有线激光束的真实扫描值。

进一步，所述第i线激光束相对于扫描环境的当前角度，具体通过以下步骤来实现：

获取上一周期第i线激光束的扫描距离；

获取当前周期第i线激光束的扫描距离；

根据以下公式计算第i线激光束所扫描处环境的当前角度：

式中，

θ_i表示第i线激光束所扫描处环境的当前角度：

S_(t-T)表示上一周期第i线激光束的扫描距离；

S_t表示当前周期第i线激光束的扫描距离；

v表示激光雷达当前速度；

T表示扫描周期；

i表示第i线激光束；

表示扫描范围；

γ表示角度分辨率。

进一步，所述第i线激光束的修正值按照以下公式来实现：

式中，

ΔS_t(i)表示第i线激光束的修正值；

t表示第i线激光束的扫描时间。

进一步，所述第i线激光束的真实扫描值按照以下公式来实现：