一种路口雷达安装角确定方法及系统与流程

1.本发明涉及路口智能车辆管理领域，特别涉及一种路口雷达安装角确定方法及系统。


背景技术：

2.随着城市汽车数量的不断增加，路况也越发复杂，尤其是在各种路口区域，车辆、非机动车、行人等汇聚在一起，因此通常通过雷达结合相机的方式对多个路口的车辆目标进行跟踪与检测。为了能够更好地将雷达采集的目标点的数据与相机采集到的目标点的数据相结合，需要对雷达的安装角度有着严格的要求。
3.目前在进行雷达安装角获取时，通常是在汽车左右两侧分别放置两个目标，并分开一定的距离，将这两个目标的连线与汽车的纵向轴线平行，然后利用雷达对一侧的两个目标测量的距离、角度进行输出，确定汽车纵向轴线与雷达法线方向的夹角，进而得到雷达的真实安装角。然而由于安装角的计算结果依赖于两个目标的连线与汽车的纵向轴线平行，如果两个目标的连线与车身纵向中轴线不是严格平行，就会导致计算结果存在误差，导致获取的雷达安装角的误差较大。


技术实现要素：

4.为解决上述技术问题，本发明提供一种路口雷达安装角确定方法及系统，可以解决现有获取的雷达安装角的误差较大的问题。
5.为实现上述目的，一方面，本发明提供一种路口雷达安装角确定方法，所述方法包括：
6.从当前路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点；
7.获取当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量；
8.根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量；
9.根据当前路口对应的预置个数标定点中相邻标定点在校正后的坐标系下的坐标向量，获取当前路口对应的相邻标定点连线在校正后的坐标系下的斜率向量；
10.获取当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，并根据当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，获取当前路口对应的相邻标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量；
11.根据所述当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角。
12.进一步地，所述根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量的步骤包括：
13.若所述当前路口在多路口中对应的方向为朝北，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；
14.根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
15.进一步地，所述根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量的步骤包括：
16.若所述当前路口在多路口中对应的方向为朝东，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；
17.根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
18.进一步地，所述根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量的步骤包括：
19.若所述当前路口在多路口中对应的方向为朝南，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；
20.根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
21.进一步地，所述根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量的步骤包括：
22.若所述当前路口在多路口中对应的方向为朝西，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；
23.根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，获取当前路
口对应的预置个数标定点在校正后的坐标系下的坐标向量。
24.进一步地，所述根据所述当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角的步骤包括：
25.根据所述当前路口对应的预置个数标定点在校正后的坐标系下的方位角向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的方位角向量获取当前路口对应的雷达安装角向量；
26.根据当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，获取当前路口对应的预置个数标定点对应的雷达误差向量，并对所述雷达误差向量进行归一化处理得到预置个数标定点对应的权值向量；
27.对所述雷达安装角向量以及所述预置个数标定点对应的权值向量进行预置加权处理，得到当前路口对应的雷达安装角。
28.另一方面，本发明提供一种路口雷达安装角确定系统，所述系统包括：
29.选择单元，用于从当前路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点；
30.获取单元，用于获取当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量；
31.所述获取单元，还用于根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量；
32.所述获取单元，还用于根据当前路口对应的预置个数标定点中相邻标定点在校正后的坐标系下的坐标向量，获取当前路口对应的相邻标定点连线在校正后的坐标系下的斜率向量；
33.所述获取单元，还用于获取当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，并根据当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，获取当前路口对应的相邻标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量；
34.确定单元，用于根据所述当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角。
35.进一步地，所述获取单元，具体用于若所述当前路口在多路口中对应的方向为朝北，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；
36.根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
37.进一步地，所述获取单元，具体还用于若所述当前路口在多路口中对应的方向为朝东，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
38.进一步地，所述获取单元，具体还用于若所述当前路口在多路口中对应的方向为朝南，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
39.进一步地，所述获取单元，具体还用于若所述当前路口在多路口中对应的方向为朝西，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
40.进一步地，所述获取单元，具体还用于根据所述当前路口对应的预置个数标定点在校正后的坐标系下的方位角向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的方位角向量获取当前路口对应的雷达安装角向量；
41.根据当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，获取当前路口对应的预置个数标定点对应的雷达误差向量，并对所述雷达误差向量进行归一化处理得到预置个数标定点对应的权值向量；对所述雷达安装角向量以及所述预置个数标定点对应的权值向量进行预置加权处理，得到当前路口对应的雷达安装角。
42.本发明提供的一种路口雷达安装角确定方法及系统，通过从路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点，将预置个数标定点在预置标定坐标系中分别对应的坐标向量转换到在校正后的坐标系下的坐标向量，并且根据当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、当前路口对应的预置个数标定点在预置偏斜坐标系下的相邻标定点连线的斜率向、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角，可以提升雷达安装角的获取准确率。
附图说明
43.图1是本发明提供的一种路口雷达安装角确定方法的流程图；
44.图2是本发明提供的一种路口雷达安装角确定系统的结构示意图；
45.图3本发明提供的预置标定坐标系示意图；
46.图4为本发明提供的单路口偏斜坐标系示意图。
具体实施方式
47.下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
48.如图1所示，本发明实施例提供的一种路口雷达安装角确定方法，包括如下步骤：
49.101、从当前路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点。
50.具体地，选定旋转角反射器作为标定点的介质，标定坐标系如图3所示，通过人工在距离雷达较远处，以圆心o’为中心，半径为r绘出一个圆形：只测量出圆心o’在标定坐标系下的坐标x'、y'和半径r，即可以计算得到均分这个圆形的n个标定点在标定坐标系下的坐标向量x、y，默认标定点1在圆形的正右侧，逆时针开始标定点序号的累加，旋转角反射器的转速随标定点序号的增加而增加)。令x＝[x1…
、xi、
…
、xn]，y＝[y1、
…
yi、
…yn
]，其中，xi为第i个标定点在标定坐标系的x轴坐标，yi为第i个标定点在标定坐标系的y轴坐标，
[0051]
xi＝x' r*cos(theta'*(i-1))
[0052]
yi＝y' r*sin(theta'*(i-1))
[0053]
其中为相邻标定点分别与圆心o’的连线的夹角，如图4所示，图4中示例n＝8，需要说明的是，通过路口大坐标系转换坐标的原因：若直接在校正坐标系下测量坐标，为使雷达检测目标时分辨力较高，标定点的位置离雷达较远，特别在路口环境中，直接测量标定点至雷达的距离，测量不便，所以通过以大坐标系为中介进行坐标转换，更方便。
[0054]
102、获取当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量。
[0055]
103、根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0056]
对于本发明实施例，步骤103具体可以包括：若所述当前路口在多路口中对应的方向为朝北，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0057]
例如，步骤101中测量得到的坐标向量x、y转换到对应路口校正后的坐标系下，得到转换后的坐标向量x_trans、y_trans。x_trans＝[x1_trans、x2_trans、
…
、xi_trans、
…
x10_trans]，y_trans＝[y1_trans、y2_trans、
…
、yi_trans、
…
y10_trans]，其中，xi_trans为第i个标定点在路口校正坐标系的x轴坐标，yi_trans为第i个标定点在路口校正坐标系的y轴坐标。若当前路口为1号路口，对应十字路口的朝北方向，坐标转换公式如下：以第i个
标定点的坐标xi，yi为例进行说明，其他标定点的处理方法均相同：xi_trans＝xi deltax1；yi_trans＝yi deltay1；其中，deltax1为01原点与0原点的距离在1号路口横坐标方向的投影；deltay1为01原点与o原点的距离在1号路口纵坐标方向的纵向投影；o1为1号路口雷达坐标系原点，o为标定坐标系原点。
[0058]
进一步地，若所述当前路口在多路口中对应的方向为朝东，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0059]
例如，若当前路口为2号路口，对应十字路口的朝东方向，坐标转换公式如下：以第i个标定点的坐标xi，yi为例进行说明，其他标定点的处理方法均相同。xi_trans＝deltax2-yi；yi_trans＝xi deltay2；其中，deltax2为02原点与0原点的距离在2号路口横坐标方向的投影；deltay2为02原点与0原点的距离在2号路口纵坐标方向的纵向投影；02为2号路口雷达坐标系原点，0为标定坐标系原点。
[0060]
进一步地，若所述当前路口在多路口中对应的方向为朝南，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0061]
例如，若当前路口为3号路口，对应十字路口的朝南方向，坐标转换公式如下：以第i个标定点的坐标xi，yi为例进行说明，其他标定点的处理方法均相同。xi_trans＝deltax3-xi；yi_trans＝deltay3-yi；其中，deltax3为03原点与o原点的距离在3号路口横坐标方向的投影；deltay3为o3原点与0原点的距离在3号路口纵坐标方向的纵向投影；03为3号路口雷达坐标系原点，0为标定坐标系原点。
[0062]
进一步地，若所述当前路口在多路口中对应的方向为朝西，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0063]
例如，若当前路口为4号路口，对应十字路口的朝西方向，坐标转换公式如下：以第i个标定点的坐标xi，yi为例进行说明，其他标定点的处理方法均相同。xi_trans＝deltax4 yi；yi_trans＝deltay4-xi；其中，deltax4为04原点与0原点的距离在4号路口横坐标方向的投影；deltay4为04原点与0原点的距离在4号路口纵坐标方向的纵向投影；04为4号路口雷达坐标系原点，0为标定坐标系原点。
[0064]
104、根据当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量，获取当前路口对应的相邻标定点连线在校正后的坐标系下的斜率向量。
[0065]
对于本发明实施例，步骤104具体可以包括：theta＝[theta1、
…
、thetai、
…
、thetan]；其中，以计算第i个连线斜率thetai为例进行说明，其他连线斜率的计算方法均相同。若i《n，需使用第i 1个标定点转换后的坐标xl_trans、yl_trans和第i个标定点转换后的坐标xi_trans、yi_trans，thetai＝atan((yi_trans-yl_trans)/(xi_trans-xl_trans))；若i＝n，需使用第1个标定点转换后的坐标x1_trans、y1_trans和第i个标定点转换后的坐标xi_trans、yi_trans，thetai＝atan((yi_trans-y1_trans)/(xi_trans-x1_trans))。
[0066]
105、获取当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，并根据当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，获取当前路口对应的相邻标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量。
[0067]
对于本发明实施例，步骤105具体可以包括：如图4所示，在单路口偏斜坐标系下，通过雷达测量得到n个标定点的坐标向量x_bias、y_bias，可以通过目标速度的递增来确定第1个标定点至第n个标定点。，x_bias＝[x1_bias、x2_bias、
…
、xi_bias、
…
xn_bias]，y_bias＝[y1_bias、y2_bias、
…
、yi_bias、
…
yn_bias]，其中，xi_bias为第i个标定点在偏斜坐标系的x轴坐标，yi_bias为第i个标定点在偏斜坐标系的y轴坐标。由偏斜坐标系下的坐标向量x_bias、y_bias，计算得到在偏斜坐标系下相邻标定点连线的斜率向量theta。theta＝[theta1、
…
、thetai、
…
、thetan]；以第i个在偏斜坐标系下连线斜率thetai为例进行说明，其他连线斜率的计算方法均相同。若i《n，需使用第i 1个标定点偏斜坐标系下的坐标xl_bias、yl_bias和第i个标定点在偏斜坐标系下的坐标xi_bias、yi_bias，thetai＝atan((yi_bias-yl_bias)/(xi_bias-xl_bias))；若i＝n，需使用第1个标定点偏斜坐标系下的坐标x1_bias、y1_bias和第i个标定点在偏斜坐标系下的坐标xi_bias、yi_bias，thetai＝atan((yi_bias-y1_bias)/(xi_bias-x1_bias))。
[0068]
106、根据所述当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角。
[0069]
对于本发明实施例，步骤106具体可以包括：根据所述当前路口对应的预置个数标定点在校正后的坐标系下的方位角向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的方位角向量获取当前路口对应的雷达安装角向量；根据当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，获取当前路口对应的预置个数标定点对应的雷达误差向量，并对所述雷达误差向量进行归一化处理得到预置个数标定点对应的权值向量；对所述雷达安装角向量以及所述预置个数标定点对应的权值向量进行预置加权处理，得到当前路口对应的雷达安装角。
[0070]
例如，由校正坐标系下的斜率向量theta和由在偏斜坐标系下的斜率向量theta，计算得到安装角向量theta_fix，theta_fix＝[theta1_fix、theta2_fix、
…
、thetai_fix、thetan_fix]；以在校正坐标系下的第i个连线斜率thetai和在偏斜坐标系下的第i个连线斜率thetai为例进行说明，其他连线斜率的计算方法均相同，thetai_fix＝theta
i-thetai，由n个标定点在偏斜坐标系下的y轴坐标向量y_bias，计算得到n个标定点对应的雷达误差向量n_errorn_error＝[n1，
…
，ni,
…
nn]；，因雷达测量值在y轴100米处的误差是10％，认
为雷达测量误差与坐标y值成正比，以第i个雷达误差ni为例进行说明，其他雷达误差的计算方法均相同，若i《n，需使用第i 1个标定点偏斜坐标系下的y轴坐标yl_bias和第i个标定点在偏斜坐标系下的y轴坐标yi_bias，ni＝yi_bias/(yi_bias yl_bias)*yi_bias/100*10％ yl_bias/(yi_bias yl_bias)*yl_bias/100*10％；若i＝n，需使用第1个标定点偏斜坐标系下的y轴坐标y1_bias和第i个标定点在偏斜坐标系下的y轴坐标yi_bias，ni＝yi_bias/(yi_bias y1_bias)*yi_bias/100*10％ y1_bias/(yi_bias y1_bias)*y1_bias/100*10％；由得到的雷达误差向量n_error，进行计算得到n个安装角对应权值向量w，w＝[w1,w2,
…
,wi,
…
,w10]；由于误差越大，对应安装角的权重越小，先计算误差因子coef＝[coef1，
…
，coefi，
…
，coefn]，再对误差因子进行归一化，得到w，wi＝coefi/(coef1 coef2
…
coefn)。为进一步减小雷达安装角的测量误差，对安装角向量theta_fix和权值向量w进行加权处理，得到最终的安装角theta_final，theta_final＝w1*theta1_fix w2*theta2_fix
…
wn*thetan_fix。
[0071]
本发明提供的一种路口雷达安装角确定方法，通过从路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点，将预置个数标定点在预置标定坐标系中分别对应的坐标向量转换到在校正后的坐标系下的坐标向量，并且根据当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、当前路口对应的预置个数标定点在预置偏斜坐标系下的相邻标定点连线的斜率向、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角，可以提升雷达安装角的获取准确率。
[0072]
为实现本发明实施例提供的方法，本发明实施例提供一种路口雷达安装角确定系统，如图2所示，该系统包括：选择单元21、获取单元22、确定单元23；
[0073]
选择单元21，用于从当前路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点。
[0074]
获取单元22，用于获取当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量。
[0075]
所述获取单元22，还用于根据当前路口在多路口中对应的方向、以及当前路口对应的预置个数标定点在预置标定坐标系中分别对应的坐标向量，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0076]
所述获取单元22，还用于根据当前路口对应的预置个数标定点中相邻标定点在校正后的坐标系下的坐标向量，获取当前路口对应的相邻标定点连线在校正后的坐标系下的斜率向量。
[0077]
所述获取单元22，还用于获取当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，并根据当前路口对应的预置个数标定点在预置偏斜坐标系中分别对应的坐标向量，获取当前路口对应的相邻标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量。
[0078]
确定单元23，用于根据所述当前路口对应的预置个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的相邻标定点连线的斜率向量、以及当前路口对应的预置个数标定点在预置偏斜坐标
系下的y轴坐标向量，确定当前路口对应的雷达安装角。
[0079]
进一步地，所述获取单元21，具体用于若所述当前路口在多路口中对应的方向为朝北，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0080]
进一步地，所述获取单元21，具体还用于若所述当前路口在多路口中对应的方向为朝东，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量之和，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0081]
进一步地，所述获取单元21，具体还用于若所述当前路口在多路口中对应的方向为朝南，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0082]
进一步地，所述获取单元21，具体还用于若所述当前路口在多路口中对应的方向为朝西，则获取当前路口对应的校正后的坐标系原点与所述预置标定坐标系原点的距离在校正后的坐标系中横坐标方向的投影、纵坐标方向的纵向投影；根据所述横坐标方向的投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的y轴方向坐标向量之和值，以及所述纵坐标方向的纵向投影与当前路口对应的预置个数标定点在预置标定坐标系中分别对应的x轴方向坐标向量差值，获取当前路口对应的预置个数标定点在校正后的坐标系下的坐标向量。
[0083]
进一步地，所述获取单元21，具体还用于根据所述当前路口对应的预置个数标定点在校正后的坐标系下的方位角向量、所述当前路口对应的预置个数标定点在所述预置偏斜坐标系下的方位角向量获取当前路口对应的雷达安装角向量；根据当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，获取当前路口对应的预置个数标定点对应的雷达误差向量，并对所述雷达误差向量进行归一化处理得到预置个数标定点对应的权值向量；对所述雷达安装角向量以及所述预置个数标定点对应的权值向量进行预置加权处理，得到当前路口对应的雷达安装角。
[0084]
本发明提供的一种路口雷达安装角确定系统，通过从路口对应的预置标定坐标系中的预置圆形区域边界上选择预置个数标定点，将预置个数标定点在预置标定坐标系中分别对应的坐标向量转换到在校正后的坐标系下的坐标向量，并且根据当前路口对应的预置
个数标定点在校正后的坐标系下的相邻标定点连线的斜率向量、当前路口对应的预置个数标定点在预置偏斜坐标系下的相邻标定点连线的斜率向、以及当前路口对应的预置个数标定点在预置偏斜坐标系下的y轴坐标向量，确定当前路口对应的雷达安装角，可以提升雷达安装角的获取准确率。
[0085]
应该明白，公开的过程中的步骤的特定顺序或层次是示例性方法的实例。基于设计偏好，应该理解，过程中的步骤的特定顺序或层次可以在不脱离本公开的保护范围的情况下得到重新安排。所附的方法权利要求以示例性的顺序给出了各种步骤的要素，并且不是要限于所述的特定顺序或层次。
[0086]
在上述的详细描述中，各种特征一起组合在单个的实施方案中，以简化本公开。不应该将这种公开方法解释为反映了这样的意图，即，所要求保护的主题的实施方案需要比清楚地在每个权利要求中所陈述的特征更多的特征。相反，如所附的权利要求书所反映的那样，本发明处于比所公开的单个实施方案的全部特征少的状态。因此，所附的权利要求书特此清楚地被并入详细描述中，其中每项权利要求独自作为本发明单独的优选实施方案。
[0087]
为使本领域内的任何技术人员能够实现或者使用本发明，上面对所公开实施例进行了描述。对于本领域技术人员来说；这些实施例的各种修改方式都是显而易见的，并且本文定义的一般原理也可以在不脱离本公开的精神和保护范围的基础上适用于其它实施例。因此，本公开并不限于本文给出的实施例，而是与本技术公开的原理和新颖性特征的最广范围相一致。
[0088]
上文的描述包括一个或多个实施例的举例。当然，为了描述上述实施例而描述部件或方法的所有可能的结合是不可能的，但是本领域普通技术人员应该认识到，各个实施例可以做进一步的组合和排列。因此，本文中描述的实施例旨在涵盖落入所附权利要求书的保护范围内的所有这样的改变、修改和变型。此外，就说明书或权利要求书中使用的术语“包含”，该词的涵盖方式类似于术语“包括”，就如同“包括，”在权利要求中用作衔接词所解释的那样。此外，使用在权利要求书的说明书中的任何一个术语“或者”是要表示“非排它性的或者”。
[0089]
本领域技术人员还可以了解到本发明实施例列出的各种说明性逻辑块(illustrative logical block)，单元，和步骤可以通过电子硬件、电脑软件，或两者的结合进行实现。为清楚展示硬件和软件的可替换性(interchangeability)，上述的各种说明性部件(illustrative components)，单元和步骤已经通用地描述了它们的功能。这样的功能是通过硬件还是软件来实现取决于特定的应用和整个系统的设计要求。本领域技术人员可以对于每种特定的应用，可以使用各种方法实现所述的功能，但这种实现不应被理解为超出本发明实施例保护的范围。
[0090]
本发明实施例中所描述的各种说明性的逻辑块，或单元都可以通过通用处理器，数字信号处理器，专用集成电路(asic)，现场可编程门阵列或其它可编程逻辑系统，离散门或晶体管逻辑，离散硬件部件，或上述任何组合的设计来实现或操作所描述的功能。通用处理器可以为微处理器，可选地，该通用处理器也可以为任何传统的处理器、控制器、微控制器或状态机。处理器也可以通过计算系统的组合来实现，例如数字信号处理器和微处理器，多个微处理器，一个或多个微处理器联合一个数字信号处理器核，或任何其它类似的配置来实现。
[0091]
本发明实施例中所描述的方法或算法的步骤可以直接嵌入硬件、处理器执行的软件模块、或者这两者的结合。软件模块可以存储于ram存储器、闪存、rom存储器、eprom存储器、eeprom存储器、寄存器、硬盘、可移动磁盘、cd-rom或本领域中其它任意形式的存储媒介中。示例性地，存储媒介可以与处理器连接，以使得处理器可以从存储媒介中读取信息，并可以向存储媒介存写信息。可选地，存储媒介还可以集成到处理器中。处理器和存储媒介可以设置于asic中，asic可以设置于用户终端中。可选地，处理器和存储媒介也可以设置于用户终端中的不同的部件中。
[0092]
在一个或多个示例性的设计中，本发明实施例所描述的上述功能可以在硬件、软件、固件或这三者的任意组合来实现。如果在软件中实现，这些功能可以存储与电脑可读的媒介上，或以一个或多个指令或代码形式传输于电脑可读的媒介上。电脑可读媒介包括电脑存储媒介和便于使得让电脑程序从一个地方转移到其它地方的通信媒介。存储媒介可以是任何通用或特殊电脑可以接入访问的可用媒体。例如，这样的电脑可读媒体可以包括但不限于ram、rom、eeprom、cd-rom或其它光盘存储、磁盘存储或其它磁性存储系统，或其它任何可以用于承载或存储以指令或数据结构和其它可被通用或特殊电脑、或通用或特殊处理器读取形式的程序代码的媒介。此外，任何连接都可以被适当地定义为电脑可读媒介，例如，如果软件是从一个网站站点、服务器或其它远程资源通过一个同轴电缆、光纤电缆、双绞线、数字用户线(dsl)或以例如红外、无线和微波等无线方式传输的也被包含在所定义的电脑可读媒介中。所述的碟片(disk)和磁盘(disc)包括压缩磁盘、镭射盘、光盘、dvd、软盘和蓝光光盘，磁盘通常以磁性复制数据，而碟片通常以激光进行光学复制数据。上述的组合也可以包含在电脑可读媒介中。
[0093]
以上所述的具体实施方式，对本发明的目的、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本发明的具体实施方式而已，并不用于限定本发明的保护范围，凡在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。。