[发明专利]一种雷达法线标定方法、装置、系统、设备和存储介质

权利要求书

1.一种雷达法线标定方法，其特征在于，包括：

获取目标车辆的实际的轨迹点的坐标序列；所述轨迹点的坐标序列处于以雷达安装位置的UTM坐标为原点，正东方向为横轴正方向，正北方向为纵轴正方向的第一笛卡尔坐标系内；

获取目标车辆的雷达检测点的坐标序列；所述雷达检测点的坐标序列为处于以雷达安装位置的UTM坐标为原点，雷达法线方向为纵轴正方向，法线方向顺时针旋转90°为横轴正方向的第二笛卡尔坐标系内；

根据关于雷达检测点的坐标序列、轨迹点的坐标序列和旋转角度的损失函数，确定雷达法线的正北偏转角度，以完成雷达法线标定；所述雷达法线的正北偏转角度为使损失函数值最小的旋转角度；

利用所述雷达法线的正北偏转角度，完成雷达法线标定。

2.根据权利要求1所述的方法，其特征在于，所述根据关于雷达检测点的坐标序列、轨迹点的坐标序列和旋转角度的损失函数，确定雷达法线的正北偏转角度，包括：

计算所述第二笛卡尔坐标系以原点为圆心旋转目标角度后的每个雷达检测点的坐标，得到第一旋转坐标序列；

计算每个雷达检测点的第一旋转坐标与各轨迹点的坐标的欧式距离，得到每个雷达检测点对应的第一结果序列；

从每个雷达检测点对应的第一结果序列中获取最小的欧式距离值，作为第二结果；

将每个雷达检测点对应的第二结果的相加，得到损失函数值；

根据不同目标角度的损失函数值，确定损失函数值最小的角度为雷达法线的正北偏转角度。

3.根据权利要求1所述的方法，其特征在于，所述根据关于雷达检测点的坐标序列、轨迹点的坐标序列和旋转角度的损失函数，确定雷达法线的正北偏转角度，包括：

计算所述第一笛卡尔坐标系以原点为圆心旋转目标角度后的每个轨迹点的坐标，得到第二旋转坐标序列；

计算每个轨迹点的第二旋转坐标与各雷达检测点的坐标的欧式距离，得到每个轨迹点对应的第三结果序列；

从每个轨迹点对应的第三结果序列中获取最小的欧式距离值，作为第四结果；

将每个轨迹点对应的第四结果的相加，得到损失函数值；

根据不同目标角度的损失函数值，确定损失函数值最小的角度为雷达法线的正北偏转角度。

4.根据权利要求1所述的方法，其特征在于，所述获取目标车辆的实际的轨迹点的坐标序列，包括：

获取雷达安装位置的经纬度；

从目标车辆的导航系统中获取目标车辆在雷达检测区域行驶的轨迹点的经纬度序列；

将所述雷达安装位置的经纬度转换为UTM坐标；

将所述轨迹点的经纬度序列转换为轨迹点的初始UTM坐标序列；

将轨迹点的初始UTM坐标序列转换到以雷达安装位置的UTM坐标为原点的第一笛卡尔坐标系内，得到轨迹点的坐标序列。

5.根据权利要求1所述的方法，其特征在于，所述利用所述雷达法线的正北偏转角度，完成雷达法线标定，包括：将所述第一笛卡尔坐标系以原点为圆心旋转正北偏转角度，完成雷达法线标定；或者，将所述第二笛卡尔坐标系以原点为圆心旋转正北偏转角度，完成雷达法线标定。

6.根据权利要求4所述的方法，其特征在于，所述获取雷达安装位置的经纬度，包括：

获取RTK设备测量的雷达安装位置得到的经纬度。

7.根据权利要求1所述的方法，其特征在于，所述获取目标车辆的雷达检测点的坐标序列，包括：

获取不同时刻的雷达目标跟踪数据；所述雷达目标跟踪数据包括多个车辆的多个雷达检测点；

根据目标车辆的标识信息从不同时刻的雷达目标跟踪数据中获得目标车辆的雷达检测点的坐标序列。

8.根据权利要求7所述的方法，其特征在于，所述获取不同时刻的雷达目标跟踪数据之前，所述方法还包括：对原始雷达点云数据进行去噪处理。