[发明专利]近距离障碍物的光达侦测装置及其方法

摘要

本发明公开了一种近距离障碍物的光达侦测装置及其方法，其利用四个二维光达扫描障碍物，以取得障碍物对应的原始点云数据，其包含障碍物相对车辆的相对距离、相对角度与相对速度。接着，将点云数据分成对应障碍物的点云群组，并依据点云群组的轮廓取得障碍物的边界长度。最后，利用卡尔曼滤波法与外插法预测并追踪动态障碍物的动作路径，且传送对应动态障碍物的相对速度与边界长度予自动驾驶控制装置使用，又根据相对距离取得最接近车辆的动态障碍物的坐标，以传送坐标予自动驾驶控制装置使用，进而有效侦测障碍物。

主权项

1.一种近距离障碍物的光达侦测装置，其设于一车辆中，该车辆周围有至少一障碍物，其特征在于，该近距离障碍物的光达侦测装置包含：四个二维光达，其中两个该二维光达设于该车辆的前端，另外两个该二维光达设于该车辆的后端，该四个二维光达扫描该至少一障碍物障碍物，以取得该至少一障碍物对应的原始点云数据，该原始点云数据包含该至少一障碍物相对该车辆的相对距离、相对角度与相对速度；一噪声滤波器，电性连接该四个二维光达，并接收该原始点云数据，以滤除该原始点云数据的噪声，进而产生滤除点云数据；以及一处理器，电性连接该噪声滤波器与设于该车辆中的一自动驾驶控制装置，并接收该滤除点云数据，该处理器以一预设长度将该滤除点云数据分成对应该至少一障碍物的至少一点云群组，并依据该至少一点云群组的轮廓取得该至少一障碍物的边界长度，在该相对速度于一预设时段内变动时，该处理器判断该至少一障碍物为动态障碍物，该处理器利用卡尔曼滤波法与外插法预测并追踪该动态障碍物的动作路径，且传送对应该动态障碍物的该相对速度与该边界长度予该自动驾驶控制装置，又该处理器根据该动态障碍物的该相对距离取得最接近该车辆的该动态障碍物的坐标，以传送该坐标予该自动驾驶控制装置。