一种雷达外参标定精度的评估方法、装置及设备与流程

1.本技术涉及激光雷达技术领域，尤其涉及一种雷达外参标定精度的评估方法、装置及设备。


背景技术：

2.激光雷达是一种目标探测技术。使用激光作为信号光源，通过向目标对象发射激光，从而采集目标对象的反射信号，以此获得目标对象的方位、速度等信息。激光雷达具有测量精度高、抗干扰能力强等优点，广泛应用于遥感、测量、智能驾驶、机器人等领域。
3.目前，为了实现大视场，甚至全视场覆盖，可以采用多雷达的配置。但是由于安装位置的不同，多雷达的坐标系并不统一，需要对多雷达的外参进行标定。
4.但是，如何对多雷达外参标定的精度进行评估是一个亟待解决的问题。


技术实现要素：

5.本技术提供了一种雷达外参标定精度的评估方法、装置及设备，以实现在完成外参标定的同时给出标定的精度，用于指导操作人员进行定量的判断，大大提高自动化效率。
6.第一方面，本技术提供一种雷达外参标定精度的评估方法，包括：基于点云配准获得m个雷达的配准坐标系、第一点云数据和第二点云数据，其中，配准坐标系为基于雷达外参标定得到的基准地图坐标系，第一点云数据为每台雷达视场内的n个标定板在配准坐标系中的点云数据，第二点云数据为n个标定板在基准地图坐标系中的点云数据，m为正整数，n为大于或等于3的整数；根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差；至少根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差。
7.在一些可能的实施方式中，获得m个雷达的第一点云数据和第二点云数据，包括：采用点云提取算法，提取n个标定板在配准坐标系中的第一点云数据，以及提取n个标定板在基准地图坐标系的点云交叠区域中的第二点云数据；其中，点云重叠区域为基准地图坐标系统中点云数据与配准坐标系中点云数据的重叠区域。
8.在一些可能的实施方式中，根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差，包括：根据每台雷达的第一点云数据，计算n个标定板在配准坐标系中的第一法向量；从每台雷达的第二点云数据，计算n个在基准地图坐标系中的第二法向量；根据第一法向量和第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差。
9.在一些可能的实施方式中，根据第一法向量和第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差，包括：根据第一法向量和第二法向量，使用最小二乘法计算每台雷达从雷达坐标系到配准坐标系的旋转矩阵与雷达坐标系到基准地图坐标系的旋转矩阵的偏差矩阵，偏差矩阵用于表征雷达从配准坐标系到基准地图坐标系的角度误差。
10.在一些可能的实施方式中，根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差，包括：根据第一点云数据，获得n个标定板中相交的s个标定板的第一交点数据，s为大于或等于3，且小于或等于n的整数；根据第二点云数据，获得s个标定板在基准地图坐标系中的第二交点数据；第一交点数据和第二交点数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差。
11.在一些可能的实施方式中，根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，获得m个雷达的外参标定误差，包括：根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算每台雷达从配准坐标系到基准地图坐标系的变换矩阵；将m个雷达中的第m台达确定为基准雷达，m为小于或等于m的正整数；至少根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵和基准雷达从配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差。
12.在一些可能的实施方式中，至少根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵和基准雷达从配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差，包括：根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵、基准雷达从配准坐标系到基准地图坐标系的变换矩阵和每台雷达雷达坐标系到配准坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差。
13.第二方面，本技术提供了一种雷达外参标定精度的评估装置，该评估装置可以为激光雷达的外参标定设备或者外参标定设备中的芯片或者片上系统，还可以为激光雷达的外参标定设备中用于实现上述各个实施例所述的方法的功能模块。该标定装置可以实现上述各实施例中标定设备所执行的功能，这些功能可以通过硬件执行相应的软件实现。这些硬件或软件包括一个或多个上述功能相应的模块。该评估装置，包括：外参标定模块，用于基于点云配准获得m个雷达的配准坐标系、第一点云数据和第二点云数据，其中，配准坐标系为基于雷达外参标定得到的基准地图坐标系，第一点云数据为每台雷达视场内的n个标定板在配准坐标系中的点云数据，第二点云数据为n个标定板在基准地图坐标系中的点云数据，m为正整数，n为大于或等于3的整数；误差计算模块，用于根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差；至少根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差。
14.在一些可能的实施方式中，外参标定模块，还用于采用点云提取算法，提取n个标定板在配准坐标系中的第一点云数据，以及提取n个标定板在基准地图坐标系的点云交叠区域中的第二点云数据；其中，点云交叠区域为基准地图坐标系统中点云数据与配准坐标系中点云数据的重叠区域。
15.在一些可能的实施方式中，误差计算模块，用于根据每台雷达的第一点云数据，计算n个标定板在配准坐标系中的第一法向量；从每台雷达的第二点云数据，计算n个在基准地图坐标系中的第二法向量；根据第一法向量和第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差。
16.在一些可能的实施方式中，误差计算模块，用于根据第一法向量和第二法向量，使用最小二乘法计算每台雷达从雷达坐标系到配准坐标系的旋转矩阵与从雷达坐标系到基准地图坐标系的旋转矩阵的偏差矩阵，偏差矩阵用于表征每台雷达从配准坐标系到基准地
图坐标系的角度误差。
17.在一些可能的实施方式中，误差计算模块，用于根据第一点云数据，获得n个标定板中相交的s个标定板的第一交点数据，s为大于或等于3，且小于或等于n的整数；根据第二点云数据，获得s个标定板在基准地图坐标系中的第二交点数据；根据第一交点数据和第二交点数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差。
18.在一些可能的实施方式中，误差计算模块，用于根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算每台雷达从配准坐标系到基准地图坐标系的变换矩阵；将m个雷达中的第m台雷达确定为基准雷达，m为小于或等于m的正整数；至少根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵和基准雷达从配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差。
19.在一些可能的实施方式中，误差计算模块，还用于根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵、基准雷达从配准坐标系到基准地图坐标系的变换矩阵和每台雷达雷达坐标系到配准坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差。
20.第三方面，本技术提供了一种外参标定设备，包括：存储器，存储有计算机可执行指令；处理器，与存储器相连，用于通过执行计算机可执行指令，以实现如第一方面及其任一可能的实施方式所述的方法。
21.第四方面，本技术提供了一种激光雷达外参标定系统，包括：m台雷达和如第三方面及其任一可能的实施方式所述的外参标定设备；每台雷达的视场内设置n个标定板，m为正整数，n为n为大于或等于3的整数。
22.第五方面，本技术提供了一种计算机存储介质，计算机存储介质存储有计算机可执行指令，计算机可执行指令被处理器执行后能够实现如第一方面及其任一可能的实施方式所述的方法。
23.本技术提供的技术方案与现有技术相比存在的有益效果是：
24.在本技术中，通过在外参标定后，计算多台雷达之间的外参标定误差，如角度误差和平移误差，以此评估多台雷达的外参标定精度，以指导操作人员进行定量的判断，大大提高自动化效率。
25.应当理解的是，以上的一般描述和后文的细节描述仅是示例性和解释性的，并不能限制本技术的保护范围。
附图说明
26.图1为相关技术中的一种激光雷达的结构示意图；
27.图2为本技术实施例中的外参标定系统的示意图；
28.图3为本技术实施例中的雷达外参标定精度的一种评估方法的实施流程示意图；
29.图4为本技术实施例中的各坐标系之间的关系示意图；
30.图5为本技术实施例中的雷达外参标定精度的另一种评估方法的实施流程示意图；
31.图6为本技术实施例中的各变换矩阵的关系示意图；
32.图7为本技术实施例中的雷达外参标定精度的评估装置的一种结构示意图；
33.图8为本技术实施例中的一种激光雷达的标定设备的结构示意图。
具体实施方式
34.以下描述中，为了说明而不是为了限定，提出了诸如特定系统结构、技术之类的具体细节，以便透彻理解本发明实施例。然而，本领域的技术人员应当清楚，在没有这些具体细节的其它实施例中也可以实现本发明。在其它情况中省略对众所周知的系统、装置、电路以及方法的详细说明，以免不必要的细节妨碍本发明的描述。
35.为了说明本技术所述的技术方案，下面通过具体实施例来进行说明。
36.激光雷达是一种目标探测技术。激光雷达通过激光器发出激光光束，激光光束遇到目标物体后发生漫反射，通过探测器接收反射回的光束，并根据发射的光束和反射回的光束确定目标物体的距离、方位、高度、速度、姿态、形状等特征量。
37.激光雷达的应用领域非常广泛。除了运用在军事领域之外，目前还被广泛应用于生活领域，包括但不限于：智能驾驶车辆、智能驾驶飞机、三维(3d)打印、虚拟现实、增强现实、服务机器人等领域。以智能家驾驶技术为例，在智能驾驶车辆中设置激光雷达，激光雷达可通过快速且重复地发射激光束来扫描周围环境，以获取反映周围环境中的一个或多个目标对象的形貌、位置、运动的点云数据等。
38.需要说明的是，上述智能驾驶技术可以指无人驾驶、自动驾驶、辅助驾驶等技术。
39.图1为相关技术中的一种激光雷达的结构示意图，参见图1所示，激光雷达10可以包括：光发射装置101、光接收装置102和处理器103。其中，光发射装置101、光接收装置102均与处理器103连接。
40.其中，上述各器件之间的连接关系可以是电性连接，还可以是光纤连接。更具体的，在光发射装置101和光接收装置102中，还可能分别包括多个光学器件，这些光学器件之间的连接关系还可能是空间光传输连接。
41.处理器103用于实现对发射装置101和光接收装置102的控制，以使光发射装置101和光接收装置102能够正常工作。示例性的，处理器103可以为光发射装置101和光接收装置102分别提供驱动电压，处理器103还可以为光发射装置101和光接收装置102提供控制信号。
42.示例性的，处理器103可以是通用处理器，如中央处理器(central processing unit，cpu)、网络处理器(network processor，np)等；处理器103还可以是数字信号处理器(digital signal processing，dsp)、专用集成电路(application specific integrated circuit，asic)、现场可编程门阵列(field-programmable gate array，fpga)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。
43.光发射装置101中还包括光源(图1未示出)。可以理解的，上述光源可以指激光器，激光器的数量可以是一个或者多个。可选的，激光器可以具体为脉冲激光二极管(pulsed laser diode，pld)、半导体激光器、光纤激光器等。上述光源用于发射激光束。具体的，处理器103可以向光源发送发射控制信号，从而触发光源发射激光束。
44.可以理解的，上述激光束也可以称为激光脉冲、激光、发射光束等。
45.下面结合图1所示的激光雷达的结构，简单描述激光雷达对目标物体104的探测过程。
46.参见图1所示，激光束沿发射方向进行传播，当激光束遇到目标物体104后，在目标物体104的表面发生反射，反射回的光束被激光雷达的光接收装置102接收。这里，可以将激光束被目标物体104反射回的光束称为回波光束(图1中激光束和回波光束采用实线标识)。
47.光接收装置102接收到回波光束后，对回波光束进行光电转换，即，将回波光束转换为电信号，光接收装置102将回波光束对应的电信号输出至处理器103，处理器103可以根据回波光束的电信号，获取目标物体104的形貌、位置、运动的点云数据等。
48.在实际应用中，为了实现大视场，甚至全视场覆盖，单个车可以配置多台雷达。但是由于安装位置的不同，多雷达的坐标系并不统一，导致多雷达输出的点云并不能统一到同一个坐标系，因此需要对多雷达的外参进行标定，使其输出同一坐标系下的点云数据。
49.在相关技术中，通过预先获知标定场景(地图)高精度点云数据的前提下，将多台雷达的雷达坐标系分别配准到地图坐标系下实现多雷达外参标定。如此，实际拼接的点云数据的质量和精度取决于外参标定的精度。但是，如何对多雷达外参标定的精度进行评估是一个亟待解决的问题。
50.为了解决上述问题，本技术实施例提供一种雷达外参标定精度的评估方法，该方法可以应用于上述激光雷达的外参标定系统中。图2为本技术实施例中的外参标定系统的示意图，参见图2所示，该外参标定系统20可以包括：m台雷达(可以记为雷达1、雷达2、雷达3、
…
、雷达m(m为正整数)、外参标定设备22和标定板23。其中，m台雷达为需要进行外参标定的雷达；外参标定设备22用于对m台雷达进行外参标定并评估外参标定精度；每一台雷达的视场内设置有n个标定板23(n为正整数，n为大于或等于3的整数)，n个标定板23用于每台雷达的外参标定以及外参标定精度的评估。可选的，n个标定板23至少包括两两相交的s个标定板，s为大于或等于3，且小于或等于n的整数。
51.需要说明的是，在本技术实施例中，如无特别说明，雷达指激光雷达。
52.在实际应用中，上述外参标定设备可以为独立设备，也可以与一台雷达集成在一起，本技术实施例对此不做具体限定。
53.下面结合上述外参标定系统，对本技术实施例提供的雷达外参标定精度的评估方法进行说明。
54.图3为本技术实施例中的雷达外参标定精度的一种评估方法的实施流程示意图，参见图3所示，上述方法可以包括：
55.s301，获得m个雷达的配准坐标系。
56.其中，基准地图坐标系为外参标定设备工作时建立的自身坐标系。上述配准坐标系为基于雷达外参标定过程中点云配准得到的。配准坐标系可以理解为基准地图坐标系的测量值，而非基准地图坐标系的真实值。
57.示例性的，图4为本技术实施例中的各类坐标系之间的关系示意图，参见图4所示，雷达坐标系oi中的n个向量通过从oi到配准坐标系o
guess
的旋转矩阵r
guess
映射至o
guess
，得到对应的n个向量n个向量通过从oi到基准地图坐标系o
map
的旋转矩阵r
map
映射至o
map
，得到对应的n个向量
58.可以理解的，外参标定设备可以先对m个雷达进行外参标定，以计算出每台雷达从
各自的雷达坐标系到基准地图坐标系的变换矩阵。但是由于计算误差的存在，计算得到的变换矩阵实际为各自的雷达坐标系到配准坐标系的变换矩阵。因此，通过外参标定计算出的变换矩阵得到每台雷达的配准坐标系。
59.示例性的，对于m台雷达的中的雷达i(即第i台雷达，i＝1、2、
…
、m)来说，外参标定设备通过外参标定，可以得到雷达i的雷达坐标系oi到雷达i的配准坐标系o
guess,i
的变换矩阵t
guess,i
。
60.在一些可能的实施方式中，外参标定设备可以利用点云配准算法对多台雷达进行外参标定。示例性的，上述点云配准算法可以但不限于包括：迭代最近点算法(iterative closest point，icp)、正态分布变换(normal distribution transform，ndt)。
61.s302，获得m个雷达的第一点云数据和第二点云数据。
62.这里，第一点云数据可以为每台雷达视场内的n个标定板在配准坐标系中的点云数据。第二点云数据为每台雷达视场内的n个标定板在基准地图坐标系中的点云数据。其中，第二点云数据也可以理解为上述n个标定板在基准地图坐标系的点云交叠区域中的点云数据。
63.需要说明的是，点云交叠区域为基准地图坐标系统中点云数据与配准坐标系中点云数据的重叠区域，是点云数据的集合。还可以理解为，配准坐标系中的点云数据映射至基准地图坐标系中的点云数据。
64.在一种可能的实施方式中，上述s302可以包括：采用点云提取算法，提取n个标定板在配准坐标系中的第一点云数据，以及提取n个标定板在基准地图坐标系的点云交叠区域中的第二点云数据。
65.示例性的，上述点云提取算法可以但不限于包括：随机抽样一致(random sample consensus，ransac)算法。
66.举例来说，对于雷达i来说，外参标定设备可以采用ransac算法从雷达i的配准坐标系o
guess,i
的点云数据中提取标定板(即雷达i视场内的n个标定板，例如n＝3)的点云数据(即第一点云数据)，以及从o
map
的点云重叠区域中，提取标定板的点云数据(即第二点云数据)。
67.s303，根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度(如轴角)误差和位移误差。
68.在一些可能的实施例中，上述s303可以看做是两个计算过程，即计算每台雷达从配准坐标系到基准地图坐标系的角度误差和计算每台雷达从配准坐标系到基准地图坐标系的位移误差。那么，图5为本技术实施例中的雷达外参标定精度的另一种评估方法的实施流程示意图，参见图5所示，s303可以包括：
69.s501，根据第一点云数据和第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差；
70.s502，根据第一点云数据和第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差。
71.需要说明的是，s501和s502可以顺序执行，如先执行s501再执行s502、先执行s502再执行s501；也可以同时执行。当然，本技术实施例对s501和s502的执行时机不作具体限定。
72.在一些可能的实施方式中，s501可以包括：根据每台雷达的第一点云数据，计算每台雷达视场内的n个标定板在配准坐标系中的第一法向量，以及根据每台雷达的第二点云数据，计算n个标定板在基准地图坐标系中的第二法向量；根据第一法向量和第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差。
73.在本技术实施例中，m台雷达中的每台雷达均须执行s501至s502。为了方便描述，下面以m台雷达中的雷达i(i＝1、2、3、
…
、m)为例，分别对s501和s502进行说明。
74.可以理解的，对于雷达i来说，在通过s302获得雷达i的第一点云数据和第二点云数据之后，外参标定设备可以根据第一点云数据计算第一法向量，即雷达i视场内的n个标定板在o
guess,i
中的法向量ki(可以记为)。以及，外参标定设备可以根据第二点云数据计算第二法向量，即雷达i视场内的n个标定板在o
map
中的法向量ji(可以记为)。
75.进一步地，外参标定设备可以根据ki和ji，使用最小二乘法计算雷达i从oi到o
guess,i
的旋转矩阵r
guess,i
与oi到o
map
的旋转矩阵r
map,i
的偏差矩阵w
guess，i
。这里，w
guess，i
用于表示雷达i从o
guess,i
到o
map
的角度误差。
76.示例性的，假设在oi中，雷达i视场内的n个标定板的法向量可以记为中，雷达i视场内的n个标定板的法向量可以记为外参标定设备在获得ki和ji之后，可以得到以下公式(1)至(2)，其中r
guess,i
为oi到o
guess,i
的旋转矩阵，r
map,i
为oi到o
map
的旋转矩阵。
77.这里，r
guess,i
和r
map,i
的偏差矩阵用w
guess，i
表示，则通过公式(1)至(2)，可以得到公式(3)。
78.进一步地，根据最小二乘法，计算得到偏差矩阵w
guess，i
(也可以称为角度偏差矩阵)，如公式(4)所示。
79.ki＝r
guess,i
piꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
80.ji＝r
map,i
piꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)
[0081][0082][0083]
其中，为ki的转置矩阵，为ji的转置矩阵，为的逆矩阵，的转置矩阵。
[0084]
在一些可能的实施方式中，上述w
guess，i
还可以按照公式(5)进行奇异值分解(singular value decomposition，svd)分解，以对w
guess，i
进行优化。
[0085][0086]
其中，ui为正交矩阵，di为对角矩阵，vi为正交矩阵，为vi的转置矩阵；svd()为svd分解运算，
“→”
表示公式推导。
[0087]
在实际应用中，针对每台雷达均执行以上步骤，可以计算得到每台雷达从配准坐
标系到基准地图坐标系的角度偏差矩阵，即w
guess，1
、w
guess，2
、
…
、w
guess，m
。
[0088]
在一些可能的实施方式中，s502可以包括：根据第一点云数据，获得n个标定板中相交的s个标定板的第一交点数据，s为小于或等于n的正整数(如s＝3)；根据第二点云数据，获得s个标定板在基准地图坐标系中的第二交点数据；第一交点数据和第二交点数据，计算各台雷达从配准坐标系到基准地图坐标系的位移误差。
[0089]
可以理解的，仍以雷达i为例，在通过s302获得雷达i的第一点云数据和第二点云数据之后，外参标定设备可以根据第一点云数据，获得n个标定板中两两相交的s(如s＝3)个标定板的交点数据(即第一交点数据，可以记为n为正整数)。以及，外参标定设备可以根据第二点云数据，计算两两相交的s个标定板在o
map
中的交点数据(即第二交点数据，可以记为)。然后，外参标定设备可以按照以下公式(6)，根据以及计算雷达i从o
guess,i
到o
map
的位移误差
[0090][0091]
在实际应用中，针对每台雷达均执行以上步骤，可以计算得到每台雷达从配准坐标系到基准地图坐标系的位移误差，即
[0092]
在本技术实施例中，雷达i从o
guess,i
到o
map
的变换矩阵ti可以表示为以下公式(7)：
[0093][0094]
在实际应用中，针对每台雷达，可以计算得到每台雷达从配准坐标系到基准地图坐标系的变换矩阵，即t1、t2、
…
、ti、
…
、tm。
[0095]
至此，针对每台雷达，外参标定设备通过执行上述s501至s502，能够计算出各台雷达从各自的配准坐标系相对于基准地图坐标系的角度误差和位移误差。
[0096]
s304，至少根据每台雷达从各自的配准坐标系相对于基准地图坐标系的角度误差和位移误差，获得每台雷达之间的外参标定误差。
[0097]
可以理解的，通过s301至s303，外参标定设备计算出每台雷达的配准坐标系相对于基准地图坐标系的角度误差和位移误差。在此之后，为了对各台雷达的外参标定精度进行评估，外参标定设备需要进一步计算出各雷达之间的外参标定误差，即将各台雷达的雷达坐标系都统一映射至基准雷达的雷达坐标系下的外参标定误差。那么，s304可以包括：根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算每台雷达从配准坐标系到基准地图坐标系的变换矩阵；将m个雷达中的第m(m为大于或等于3，且小于或等于m的整数)台雷达确定为基准雷达；至少根据每台雷达从各自的配准坐标系到基准地图坐标系的变换矩阵和基准雷达从自身的配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达之间的外参标定误差。这里，每台雷达之间的外参标定误差是指各台雷达相对于基准雷达的角度误差和位移误差。
[0098]
在一些可能的实施方式中，上述计算每台雷达之间的外参标定误差的步骤可以通
过以下方式实现：
[0099]
示例性的，外参标定设备选取雷达1(即第m台雷达)作为基准雷达。
[0100]
相应的，参见以下公式(8)和(9)，计算得到雷达i经雷达1配准后的从oi到o
guess,i
的变换矩阵t
guess,1i
以及雷达i经雷达1配准后的从oi到o
map
的变换矩阵t
map,1i
。
[0101][0102][0103]
其中，图6为本技术实施例中的各类变换矩阵的关系示意图，参见图6所示，t
guess,1
为从雷达1的雷达坐标系o1到雷达1的配准坐标系o
guess,1
的变换矩阵，t
map,1
为从o1到o
map
的变换矩阵；t
guess,i
为从oi到o
guess,i
的变换矩阵，t
map,i
为从oi到o
map
的变换矩阵，t
guess,1i
也可以理解为从o1到oi的变换矩阵的测量值，t
map,1i
也可以理解为从o1到oi的变换矩阵的真实值。
[0104]
进一步地，t
guess,1i
与t
map,1i
的偏差矩阵t
1i
可以参见以下公式(10)所示：
[0105][0106]
其中，为t
guess,1i
的逆矩阵。
[0107]
进一步地，可以存在以下公式(11)和(12)：
[0108][0109][0110]
其中，t1为雷达1由o
guess,1
到o
map
的变换矩阵，ti为雷达i由o
guess,i
到o
map
的变换矩阵。
[0111]
那么，外参标定设备将公式(8)、(9)、(11)和(12)代入公式(10)，可以得到公式(13)，即t
guess,1i
与t
map,1i
的偏差矩阵t
1i
如下：
[0112][0113]
其中，w
1i
为从o1到oi的角度偏差矩阵，为从o1到oi的位移误差。
[0114]
进一步地，外参标定设备可以根据公式(13)得到雷达i从o1到oi的角度误差，参见公式(14)：
[0115]
θ
1i
＝arccos((tr(w
1i
)-1)/2)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(14)
[0116]
其中，tr()为迹(trace)运算。
[0117]
在一些可能的实施方式中，w
1i
可以按照公式(14)进行svd分解，以对w
1i
进行优化。
[0118][0119]
其中，u
1i
为正交矩阵，d
1i
为对角矩阵，v
1i
为正交矩阵，为v
1i
的转置矩阵。
[0120]
在本技术实施例中，每台雷达都执行上述步骤，得到各个雷达的t
12
、t
13
…
、t
1i
...、t
1m
，如此得到雷达间的外参标定误差，即各个雷达相对于雷达1的外参标定角度误差w
1i
和位移误差
[0121]
在一些可能的实施方式中，外参标定设备可以多次重复执行上述s301至s304，以
得到每台雷达的多个外参标定误差，进而将这些外参标定误差进行统计分析，可以得到如饼图、直方图、误差棒(error bar)等反映外参标定精度的统计分析结果。
[0122]
至此，便完成了对m台雷达的外参标定精度的评估过程。
[0123]
在本技术实施例中，通过计算多台雷达由外参标定后的配准坐标系到基准地图坐标系的角度误差和平移误差，评估多台雷达的外参标定精度。
[0124]
基于相同的发明构思，本技术实施例提供了一种雷达外参标定精度的评估装置，该评估装置可以为激光雷达的外参标定设备或者外参标定设备中的芯片或者片上系统，还可以为激光雷达的外参标定设备中用于实现上述各个实施例所述的方法的功能模块。该标定装置可以实现上述各实施例中标定设备所执行的功能，这些功能可以通过硬件执行相应的软件实现。这些硬件或软件包括一个或多个上述功能相应的模块。图7为本技术实施例中的雷达外参标定精度的评估装置的一种结构示意图，参见图7所示，该评估装置700，可以包括：外参标定模块701，用于基于点云配准获得m个雷达的配准坐标系、第一点云数据和第二点云数据，其中，配准坐标系为基于雷达外参标定得到的基准地图坐标系，第一点云数据为每台雷达视场内的n个标定板在配准坐标系中的点云数据，第二点云数据为n个标定板在基准地图坐标系中的点云数据；误差计算模块702，用于根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差；至少根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差。
[0125]
在一些可能的实施方式中，外参标定模块701，还用于采用点云提取算法，提取n个标定板在配准坐标系中的第一点云数据，以及提取n个标定板在基准地图坐标系的点云交叠区域中的第二点云数据；其中，点云交叠区域为基准地图坐标系统中点云数据与配准坐标系中点云数据的重叠区域。
[0126]
在一些可能的实施方式中，误差计算模块702，用于根据每台雷达的第一点云数据，计算n个标定板在配准坐标系中的第一法向量；从每台雷达的第二点云数据，计算n个在基准地图坐标系中的第二法向量；根据第一法向量和第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差。
[0127]
在一些可能的实施方式中，误差计算模块702，用于根据第一法向量和第二法向量，使用最小二乘法计算每台雷达从雷达坐标系到配准坐标系的旋转矩阵与从雷达坐标系到基准地图坐标系的旋转矩阵的偏差矩阵；偏差矩阵用于表征每台雷达从配准坐标系到基准地图坐标系的角度误差。
[0128]
在一些可能的实施方式中，误差计算模块702，用于根据第一点云数据，获得n个标定板中相交的s个标定板的第一交点数据，s为大于或等于3，且小于或等于n的整数；根据第二点云数据，s个标定板在基准地图坐标系中的第二交点数据；根据第一交点数据和第二交点数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差。
[0129]
在一些可能的实施方式中，误差计算模块702，还用于根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算每台雷达从配准坐标系到基准地图坐标系的变换矩阵；将m个雷达中的第m台雷达确定为基准雷达，m的取值为1、2、3、
…
、m；至少根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵和基准雷达从配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差。
[0130]
在一些可能的实施方式中，误差计算模块702，还用于根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵、基准雷达从配准坐标系到基准地图坐标系的变换矩阵和每台雷达雷达坐标系到配准坐标系的变换矩阵，计算每台雷达相对于基准雷达的角度误差和位移误差。
[0131]
需要说明的是，上述外参标定模块701和误差计算模块702的具体实现过程可参考图2至图6实施例的详细描述，为了说明书的简洁，这里不再赘述。
[0132]
本技术实施例中提到的外参标定模块701和误差计算模块702可以为一个或者多个处理器。
[0133]
基于相同的发明构思，本技术实施例提供一种激光雷达的标定设备，该通标定设备可以为上述一个或者多个实施例中所述的外参标定设备。图8为本技术实施例中的一种激光雷达的外参标定设备的结构示意图，参见图8所示，标定设备800，可以采用通用的计算机硬件，包括处理器801和存储器802。
[0134]
可选的，处理器801和存储器802可以通过总线803通信。
[0135]
在一些可能的实施方式中，至少一个处理器801可以构成具有对一个或多个输入执行逻辑运算的电路的任何物理设备。例如，至少一个处理器可以包括一个或多个集成电路(integrated circuit，ic)，包括专用集成电路(application specific integrated circuit，asic)、微芯片、微控制器、微处理器、中央处理单元(central processing unit，cpu)的全部或部分、图形处理单元(graphics processing unit，gpu)、数字信号处理器(digital signal process，dsp)、现场可编程门阵列(field programmable gate array，fpga)或者适于执行指令或执行逻辑运算的其它电路。由至少一个处理器执行的指令可以例如被预加载到与控制器集成的或嵌入在控制器中的存储器中，或者可以存储在分离的存储器中。存储器可以包括随机存取存储器(random access memory，ram)、只读存储器(read-only memory，rom)、硬盘、光盘、磁介质、闪存，其它永久、固定或易失性存储器，或者能够存储指令的任何其它机制。在一些实施例中，至少一个处理器可以包括多于一个处理器。每个处理器可以具有相似的结构，或者处理器可以具有彼此电连接或断开的不同构造。例如，处理器可以是分离的电路或集成在单个电路中。当使用多于一个处理器时，处理器可以被配置为独立地或协作地操作。处理器可以以电、磁、光学、声学、机械或通过允许它们交互的其它手段来耦合。根据本技术的一个实施例，本技术还提供了一种计算机可读存储介质，其上存储有计算机指令，该指令被处理器执行上述标定方法的步骤。存储器802可以包括以易失性和/或非易失性存储器形式的计算机存储媒体，如只读存储器和/或随机存取存储器。存储器802可以存储操作系统、应用程序、其他程序模块、可执行代码、程序数据、用户数据等。
[0136]
此外，上述存储器802中存储有用于实现图7中的外参标定模块701和误差计算模块702的功能的计算机执行指令。图7中的外参标定模块701和误差计算模块702的功能/实现过程均可以通过图8中的处理器801调用存储器802中存储的计算机执行指令来实现，具体实现过程和功能参考上述相关实施例。
[0137]
基于相同的发明构思，本技术实施例提供一种激光雷达的外参标定设备，包括：存储器，存储有计算机可执行指令；处理器，与存储器相连，用于通过执行计算机可执行指令，并能够实现如上述一个或者多个实施例所述的雷达外参标定精度的评估方法。
[0138]
基于相同的发明构思，本技术提供一种计算机存储介质，计算机存储介质存储有计算机可执行指令，计算机可执行指令被处理器执行后，能够实现如上述一个或者多个实施例所述的雷达外参标定精度的评估方法。
[0139]
本领域技术人员可以理解，上述实施例中各步骤的序号的大小并不意味着执行顺序的先后，各过程的执行顺序应以其功能和内在逻辑确定，而不应对本发明实施例的实施过程构成任何限定。
[0140]
以上所述实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解，其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围，均应包含在本发明的保护范围之内。

技术特征：
1.一种雷达外参标定精度的评估方法，其特征在于，包括：基于点云配准获得m台雷达的配准坐标系、第一点云数据和第二点云数据，所述第一点云数据为每台雷达视场内的n个标定板在配准坐标系中的点云数据，所述第二点云数据为所述n个标定板在基准地图坐标系中的点云数据，m为正整数，n为大于或等于3的整数；根据所述第一点云数据以及所述第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差；至少根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差。2.根据权利要求1所述的方法，其特征在于，所述获得m台雷达的第一点云数据和第二点云数据，包括：采用点云提取算法，提取所述n个标定板在配准坐标系中的所述第一点云数据，以及提取所述n个标定板在基准地图坐标系的点云交叠区域中的所述第二点云数据；其中，所述点云交叠区域为基准地图坐标系统中点云数据与配准坐标系中点云数据的重叠区域。3.根据权利要求1或2所述的方法，其特征在于，所述根据所述第一点云数据以及所述第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差，包括：根据每台雷达的所述第一点云数据，计算所述n个标定板在配准坐标系中的第一法向量；根据每台雷达的所述第二点云数据，计算所述n个标定板在基准地图坐标系中的第二法向量；根据所述第一法向量和所述第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差。4.根据权利要求3所述的方法，其特征在于，所述根据所述第一法向量和所述第二法向量，计算每台雷达从配准坐标系到基准地图坐标系的角度误差，包括：根据所述第一法向量和所述第二法向量，使用最小二乘法计算每台雷达从雷达坐标系到配准坐标系的旋转矩阵与从雷达坐标系到基准地图坐标系的旋转矩阵的偏差矩阵，所述偏差矩阵用于表征每台雷达从配准坐标系到基准地图坐标系的角度误差。5.根据权利要求1所述的方法，其特征在于，所述根据所述第一点云数据以及所述第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差，包括：根据所述第一点云数据，获得所述n个标定板中相交的s个标定板的第一交点数据，s为大于或等于3，且小于或等于n的整数；根据所述第二点云数据，获得所述s个标定板在基准地图坐标系中的第二交点数据；根据所述第一交点数据和所述第二交点数据，计算每台雷达从配准坐标系到基准地图坐标系的位移误差。6.根据权利要求1所述的方法，其特征在于，所述根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差，包括：根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算每台雷达从配准坐标系到基准地图坐标系的变换矩阵；将所述m个雷达中的第m台雷达确定为基准雷达，m为小于或等于m的正整数；
至少根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵和所述基准雷达从配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达相对于所述基准雷达的角度误差和位移误差。7.根据权利要求6所述的方法，其特征在于，所述至少根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵和所述基准雷达从配准坐标系到基准地图坐标系的变换矩阵，计算每台雷达相对于所述基准雷达的角度误差和位移误差，包括：根据每台雷达从配准坐标系到基准地图坐标系的变换矩阵、所述基准雷达从配准坐标系到基准地图坐标系的变换矩阵和每台雷达雷达坐标系到配准坐标系的变换矩阵，计算每台雷达相对于所述基准雷达的角度误差和位移误差。8.一种雷达外参标定精度的评估装置，其特征在于，包括：外参标定模块，用于基于点云配准获得m个雷达的配准坐标系、第一点云数据和第二点云数据，其中，所述配准坐标系为基于雷达外参标定得到的基准地图坐标系，所述第一点云数据为每台雷达视场内的n个标定板在配准坐标系中的点云数据，所述第二点云数据为所述n个标定板在基准地图坐标系中的点云数据，m为正整数，n为大于或等于3的整数；误差计算模块，用于根据所述第一点云数据以及所述第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差；至少根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差。9.一种外参标定设备，其特征在于，包括：存储器，存储有计算机可执行指令；处理器，与所述存储器相连，用于通过执行所述计算机可执行指令，以实现如权利要求1至7任一项所述的方法。10.一种计算机存储介质，所述计算机存储介质存储有计算机可执行指令，其特征在于，所述计算机可执行指令被处理器执行后能够实现如权利要求1至7任一项所述的方法。

技术总结
本申请公开一种雷达外参标定精度的评估方法、装置及设备。该评估方法包括：基于点云配准获得M台雷达的配准坐标系、第一点云数据和第二点云数据，第一点云数据为每台雷达视场内的N个标定板在配准坐标系中的点云数据，第二点云数据为N个标定板在基准地图坐标系中的点云数据；根据第一点云数据以及第二点云数据，计算每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差；至少根据每台雷达从配准坐标系到基准地图坐标系的角度误差和位移误差，计算各台雷达之间的外参标定误差。在本申请中，计算多台雷达之间的外参标定误差，以指导操作人员进行定量的判断，大大提高自动化效率。效率。效率。


技术研发人员：赵学思 夏冰冰 石拓
受保护的技术使用者：苏州一径科技有限公司
技术研发日：2021.11.19
技术公布日：2022/3/7