WO2021000544A1 - Calibration apparatus, and radar and camera joint calibration method and system - Google Patents

Calibration apparatus, and radar and camera joint calibration method and system Download PDF

Info

Publication number
WO2021000544A1
WO2021000544A1 PCT/CN2019/128584 CN2019128584W WO2021000544A1 WO 2021000544 A1 WO2021000544 A1 WO 2021000544A1 CN 2019128584 W CN2019128584 W CN 2019128584W WO 2021000544 A1 WO2021000544 A1 WO 2021000544A1
Authority
WO
WIPO (PCT)
Prior art keywords
radar
camera
calibration
calibration board
deviation
Prior art date
Application number
PCT/CN2019/128584
Other languages
French (fr)
Chinese (zh)
Inventor
蔡樱贤
李理
欧敏辉
柯志达
陈卫强
苏亮
Original Assignee
厦门金龙联合汽车工业有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 厦门金龙联合汽车工业有限公司 filed Critical 厦门金龙联合汽车工业有限公司
Publication of WO2021000544A1 publication Critical patent/WO2021000544A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/80Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration

Definitions

  • the present invention relates to the technical field of calibration, in particular to a calibration device and a combined calibration method and system of radar and camera.
  • Sensor fusion is a trend in the development of automobile safety.
  • the combined use of cameras and radars can synthesize the characteristics of vision sensors and distance sensors, learn from each other, and improve the overall perception and safety performance of automobiles. Specifically, for example, vehicle forward collision warning.
  • the present invention aims to provide a calibration device and a combined radar and camera calibration method and system, which convert the displacement deviation into the characteristic displacement deviation of the calibration device, which is more convenient to measure and obtain better measurement accuracy.
  • the deviation of the installation angle is also considered to ensure that the information obtained by the radar and the camera can be unified, which can achieve more accurate obstacle recognition and tracking.
  • a joint calibration method of radar and camera includes the following steps:
  • S1 Provide a calibration device, the calibration device includes a camera calibration board and a radar calibration board, so that the calibration device is in the calibration position;
  • S2 Collect pictures of the calibration device in different states through the camera, and at the same time detect the calibration device by radar.
  • the different states include that the camera calibration board and the radar calibration board are both in the same plane and both rotate differently around the first rotation axis.
  • the angle of and the camera calibration board rotates at different angles around the second rotation axis;
  • S3 Calculate and output calibration data according to the radar detection data corresponding to the moment when the camera collects the picture.
  • the calibration data includes the yaw angle, the pitch angle and the translation vector between the radar and the camera.
  • the reflectivity of the radar to the radar calibration board is different from the reflectivity of the radar to other components in the calibration device.
  • first rotation axis is perpendicular to the horizontal plane, and the second rotation axis is not parallel to the first rotation axis.
  • the internal parameters of the camera are calculated by Zhang Zhengyou's calibration method.
  • the internal parameters include the pixel ratio in the x direction, the pixel ratio in the y direction, the focal length and the distance between the center pixel coordinates of the picture and the origin pixel coordinates The number of horizontal and vertical pixels that differ;
  • the yaw angle between the radar and the camera is the sum of the yaw angle installed by the radar and the yaw angle installed by the camera; the yaw angle installed by the radar is based on the sum of the data of the radar calibration board area in the calibration device detected by the radar. The relationship between the radar coordinate system and the radar calibration board coordinate system is calculated.
  • the translation vector between the radar and the camera includes: lateral deviation, longitudinal deviation and height deviation;
  • the calculation process of the lateral deviation and the longitudinal deviation includes:
  • the height deviation is calculated manually by a measuring tool, and the height deviation is the difference between the installation height of the camera and the installation height of the radar.
  • a radar and camera joint calibration system includes a calibration device, a camera, a radar, and a processing terminal.
  • the processing terminal includes a processor, a memory, and a computer program stored in the memory and running on the processor. The system implements the steps of the method described in the embodiment of the present invention.
  • a calibration device characterized in that it comprises a camera calibration board and a radar calibration board, the camera calibration board can rotate around a second rotation axis, the camera calibration board and the radar calibration board can be in the same plane and both They rotate together around the first rotation axis.
  • the calibration device includes a bracket, an inner frame mounted on the bracket and capable of rotating, a radar calibration board fixedly mounted on the inner frame, and a radar calibration board mounted on the inner frame and capable of rotating around a direction that is not parallel to the direction of rotation of the inner frame Rotating camera calibration board.
  • FIG. 1 is a schematic flowchart of Embodiment 1 of the present invention.
  • Figure 2 shows a schematic diagram of the structure of the calibration plate in this embodiment.
  • Fig. 3 is a schematic diagram showing the relationship between the radar coordinate system and the metal plate coordinate system in this embodiment.
  • Figure 4 shows a schematic diagram of the relationship between the black and white grid coordinates and the metal plate coordinates in this embodiment.
  • the present invention provides a joint calibration method of radar and camera, which includes the following steps:
  • Step 1 Set up the calibration device.
  • the calibration device includes a bracket 1, an inner frame mounted on the bracket 1 and capable of rotating around the vertical direction 2, a metal plate 4 fixedly mounted on the inner frame 2 and a rotating direction perpendicular to the direction of rotation of the inner frame 2.
  • the metal plate 4 is different from the metal plate 4
  • the other parts of the s are made of different materials, that is, the metal plate 4 is made of metal, and the other parts except the metal plate 4 in the calibration device are made of non-metallic materials. The two can be interchanged.
  • the rotation axis of the inner frame 2 is vertical, and the rotation axis of the metal plate 4 is in the horizontal plane.
  • the specific structure is shown in Figure 2.
  • the bracket 1 is a rectangular frame structure, and the bottom includes two feet for stable placement on the ground.
  • the frame is vertically arranged at the middle of the two horizontal frames of the rectangular frame for the inner frame 2 to rotate.
  • the inner frame 2 also has a rectangular frame structure, and the middle positions of the upper and lower horizontal frames are respectively connected to the first rotary shaft 5, so that the inner frame 2 can rotate around the first rotary shaft 5.
  • the metal plate 4 and the black and white grid plate 3 are both arranged in the inner frame 2, wherein the black and white grid plate 3 is arranged above, and the metal plate 4 is arranged below.
  • the two vertical frames on the left and right of the inner frame 2 are used for vertical installation.
  • the second rotating shaft 6 on which the black and white grid plate 3 rotates and the middle position of the blackboard divider are respectively connected to the second rotation shaft 6 so that the black and white grid plate 3 can rotate around the second rotation axis 6.
  • the metal plate 4 and the second rotating shaft 6 are arranged in the same plane, so that the metal plate 4 and the black-and-white grid plate 3 can be in the same plane and both rotate around the first rotating shaft 5 together.
  • first rotation axis 5 and the second rotation axis 6 are arranged perpendicular to each other, that is, one is perpendicular to the horizontal plane, and the other is parallel to the horizontal plane. In other embodiments, both can be At other suitable angles.
  • the above-mentioned embodiment of the calibration device is only a preferred structure of the calibration device, and there are no restrictions on the shape, size, and connection position of each component in the calibration device.
  • Step 2 Set the calibration device at the calibration position in front of the vehicle.
  • the calibration device is set in front of the vehicle at a position corresponding to the center of the vehicle, and the black-and-white grid 3 in the calibration device is located in the center of the camera screen and occupies roughly one-half of the screen size.
  • the bracket of the calibration device 1 Parallel to the front of the vehicle.
  • Step 3 Take a picture of the calibration device through the camera, and detect the calibration device through the millimeter wave radar.
  • each group of pictures is taken by a camera fixedly arranged on the vehicle, and each group of pictures includes 5 pictures. among them:
  • the horizontal rotation angle of the inner frame 2 is 0°
  • the vertical flip angle of the black and white grid 3 is 0°, ⁇ 20°, and ⁇ 45°, respectively.
  • the horizontal rotation angle of the inner frame 2 is 45°
  • the vertical flip angle of the black and white grid 3 is 0°, ⁇ 20°, and ⁇ 45°, respectively.
  • the horizontal rotation angle of the inner frame 2 is -45°
  • the vertical flip angle of the black and white grid 3 is 0°, ⁇ 20°, and ⁇ 45°, respectively.
  • the horizontal rotation angle is the angle at which the inner frame 2 rotates relative to the support 1
  • the up and down flip angle is the angle at which the black and white grid plate 3 rotates relative to the inner frame 2.
  • Step 4 Extract and filter out the data corresponding to the metal plate 4 in the millimeter wave radar information according to the detection data of the millimeter wave radar.
  • the first picture is extracted (the horizontal rotation angle of the inner frame 2 is 0°, and the vertical flip angle of the black and white grid 3 is 0°), and the sixth picture (inner The horizontal rotation angle of the frame 2 is 45°, the vertical flip angle of the black and white grid 3 is 0°) and the 11th picture (the horizontal rotation angle of the inner frame 2 is -45°, and the vertical flip angle of the black and white grid 3 is 0
  • the radar detection data is filtered, leaving only the radar detection data of the metal plate 4 area.
  • Step 5 Calculate the yaw angle ⁇ of the millimeter wave radar installation.
  • the relationship between the millimeter wave radar coordinate system and the metal plate 4 coordinate system is:
  • X r -Y r represents the millimeter wave radar coordinate system
  • X p -Y p represents the metal plate 4 coordinate system
  • l 0 is the Y r value when X r is 0,
  • is the yaw angle of the millimeter wave radar installation.
  • the installation yaw angle ⁇ of the millimeter wave radar is calculated.
  • Step 6 Calculate the internal parameters of the camera.
  • the internal parameters of the camera are calculated using the Zhang Zhengyou calibration method: x-direction pixel ratio 1/dx, y-direction pixel ratio 1/dy, focal length f, the center pixel coordinates of the picture and The number of horizontal and vertical pixels u 0 , v 0 that differ between the pixel coordinates of the origin.
  • Step 7 Calculate the external parameters of the camera.
  • the pitch angle ⁇ 0 , ⁇ 1 , ⁇ 2 and the yaw angle ⁇ 0 of the camera coordinate system relative to the black and white grid 3 coordinate system are obtained.
  • ⁇ 1 , ⁇ 2 ⁇ 1 , ⁇ 2 .
  • Step 8 Calculate the deviation between the coordinates of the black and white grid 3 and the metal plate 4 according to the positional relationship between the black and white grid 3 and the metal plate 4.
  • X W -Y W is the black and white grid 3 coordinate system (ie the camera coordinate system)
  • X p -Y p is the metal plate 4 coordinate system
  • a is the lateral deviation between the black and white grid 3 coordinates and the metal plate 4 coordinates
  • B is the longitudinal deviation between the coordinates of the black and white grid plate 3 and the metal plate 4.
  • the origin of the coordinates of the black and white grid 3 is the first corner point in the upper left corner
  • the origin of the coordinates of the metal plate 4 is the center of the metal plate 4.
  • Step 9 Obtain the lateral deviation lx and the longitudinal deviation ly of the millimeter wave radar and camera installation.
  • the horizontal rotation angle of the inner frame 2 of the calibration device is set to 0°, so that the vehicle moves slowly and straight back, and the camera and the millimeter wave radar collect data at the same time during the backward process.
  • Extract the synchronization frame data of 3-5 cameras and millimeter wave radar after the metal plate 4 also enters the camera screen, and project the radar detection data to the picture taken by the camera according to the relationship between the millimeter wave radar coordinates and the camera coordinate system :
  • the yaw angle ⁇ is obtained in step 5
  • 1/dx, 1/dy, f, u 0 , and v 0 are obtained in step 6
  • R and T are selected from R 0 and T 0 in step 6
  • a and b are obtained from steps Eight obtained.
  • the longitudinal deviation l y is obtained , and then the horizontal deviation l x is obtained according to the triangle similarity principle.
  • Step 10 Measure the height installation deviation l z .
  • Step 11 Output calibration data.
  • the translation vector (l x , l y , l z ) is obtained by step 9 and step 10 respectively.
  • the method in the first embodiment of the present invention can be used in any intelligent driving system that uses both radar and camera sensors, such as AEBS.
  • a calibration device is designed, and a strong reflection wave metal plate 4 is fixed on the calibration device at the same time. While calibrating the internal parameters of the camera, it can calibrate the yaw angle of the millimeter wave radar.
  • the present invention also provides a radar and camera joint calibration system, including the calibration device as described in the first embodiment, a camera, a radar, and a processing terminal.
  • the processing terminal includes a memory, a processor, and a bus.
  • the memory stores at least A piece of program, the system implements the radar and camera joint calibration method as described in the first embodiment of the present invention.
  • the processor includes one or more processing cores, the processor is connected to the memory through a bus, and the memory is used to store program instructions.
  • the processor executes the program instructions in the memory, the radar and camera joint calibration described in the first embodiment of the present invention are implemented. method.
  • the so-called processor may be a central processing unit (Central Processing Unit, CPU), or other general-purpose processors, digital signal processors (Digital Signal Processors, DSPs), and application-specific integrated circuits (Central Processing Unit, CPU).
  • CPU Central Processing Unit
  • ASIC Application Specific Integrated Circuit
  • FPGA Field-Programmable Gate Array
  • the general-purpose processor can be a microprocessor or the processor can also be any conventional processor, etc.
  • the processor is the control center of the radar and camera joint calibration system, which uses various interfaces and lines to connect the entire radar and camera All parts of the joint calibration system.
  • the memory may be used to store the computer program and/or module, and the processor realizes the radar by running or executing the computer program and/or module stored in the memory and calling the data stored in the memory.
  • the memory may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating system and an application program required by at least one function; the data storage area may store data created according to the use of the mobile phone, etc.
  • the memory may include high-speed random access memory, and may also include non-volatile memory, such as hard disk, memory, plug-in hard disk, Smart Media Card (SMC), Secure Digital (SD) card , Flash Card, at least one magnetic disk storage device, flash memory device, or other volatile solid-state storage device.
  • non-volatile memory such as hard disk, memory, plug-in hard disk, Smart Media Card (SMC), Secure Digital (SD) card , Flash Card, at least one magnetic disk storage device, flash memory device, or other volatile solid-state storage device.

Abstract

Disclosed are a calibration apparatus, and a radar and camera joint calibration method and system. The method comprises: S1: providing a calibration apparatus, wherein the calibration apparatus comprises a camera calibration target and a radar calibration target, and the calibration apparatus is located at a calibration position; S2: acquiring, by means of a camera, pictures of the calibration apparatus in different states, and testing the calibration apparatus by means of a radar, wherein the different states comprise the camera calibration target and the radar calibration target being located in the same plane and the two jointly rotating around a first rotation shaft at different angles, and the camera calibration target rotating around a second rotation shaft at a different angle; and S3: calculating calibration data according to radar test data corresponding to the time when the camera acquires the pictures, and outputting the calibration data, wherein the calibration data comprises: a yaw angle, a pitch angle and a translation vector between the radar and the camera. According to the method, the deviation of a mounting angle is taken into consideration, so that the unification of information obtained by a radar and a camera can be ensured, and more accurate obstacle recognition and tracking can be realized.

Description

一种标定装置及一种雷达与摄像头联合标定方法及系统A calibration device and a combined calibration method and system of radar and camera 技术领域Technical field
本发明涉及标定技术领域,尤其涉及一种标定装置及一种雷达与摄像头联合标定方法及系统。The present invention relates to the technical field of calibration, in particular to a calibration device and a combined calibration method and system of radar and camera.
背景技术Background technique
传感器融合在汽车安全发展中是一种趋势,摄像头和雷达的结合使用,能够对视觉传感器和测距传感器的特点进行综合,取长补短,提高汽车整体的感知能力、安全性能。具体的,例如车辆前向碰撞预警。Sensor fusion is a trend in the development of automobile safety. The combined use of cameras and radars can synthesize the characteristics of vision sensors and distance sensors, learn from each other, and improve the overall perception and safety performance of automobiles. Specifically, for example, vehicle forward collision warning.
多传感器感知系统中,实现各个传感器的信息融合,需要有统一的坐标系,摄像头和毫米波雷达的外参联合标定,直接影响车辆障碍物检测的准确性。目前国内外对双目摄像头和毫米波雷达联合标定的相关研究较少,现有技术中,毫米波雷达到摄像头之间的外参通常通过直接量取位移偏差所得,角度偏差一般被忽略。In a multi-sensor sensing system, to realize the information fusion of each sensor, a unified coordinate system is required. The external parameters of the camera and millimeter wave radar are jointly calibrated, which directly affects the accuracy of vehicle obstacle detection. At present, there is little research on the joint calibration of binocular camera and millimeter wave radar at home and abroad. In the prior art, the external parameters between the millimeter wave radar and the camera are usually obtained by directly measuring the displacement deviation, and the angle deviation is generally ignored.
发明内容Summary of the invention
针对上述问题,本发明旨在提供一种标定装置及一种雷达与摄像头联合标定方法及系统,将位移偏差转化为标定装置特征的位移偏差,更加方便量取,获得更好的测量精度,另外还考虑了安装角度的偏差,以确保雷达与摄像头获得的信息可以实现统一,能够实现更准确的障碍物识别和跟踪。In view of the above problems, the present invention aims to provide a calibration device and a combined radar and camera calibration method and system, which convert the displacement deviation into the characteristic displacement deviation of the calibration device, which is more convenient to measure and obtain better measurement accuracy. The deviation of the installation angle is also considered to ensure that the information obtained by the radar and the camera can be unified, which can achieve more accurate obstacle recognition and tracking.
具体方案如下:The specific plan is as follows:
一种雷达与摄像头联合标定方法,包括以下步骤:A joint calibration method of radar and camera includes the following steps:
S1:提供标定装置,标定装置包括摄像头标定板和雷达标定板,使标定装 置处于标定位置;S1: Provide a calibration device, the calibration device includes a camera calibration board and a radar calibration board, so that the calibration device is in the calibration position;
S2:通过摄像头采集标定装置处于不同状态下的图片,同时通过雷达检测标定装置,所述不同状态包括摄像头标定板和雷达标定板两者处于同一平面内且两者共同绕第一旋转轴旋转不同的角度和摄像头标定板绕第二旋转轴旋转不同的角度;S2: Collect pictures of the calibration device in different states through the camera, and at the same time detect the calibration device by radar. The different states include that the camera calibration board and the radar calibration board are both in the same plane and both rotate differently around the first rotation axis. The angle of and the camera calibration board rotates at different angles around the second rotation axis;
S3:根据摄像头采集图片的时刻所对应的雷达检测数据来计算标定数据,并输出,所述标定数据包括:雷达和摄像头之间的偏航角、俯仰角和平移向量。S3: Calculate and output calibration data according to the radar detection data corresponding to the moment when the camera collects the picture. The calibration data includes the yaw angle, the pitch angle and the translation vector between the radar and the camera.
进一步的,雷达对雷达标定板的反射率与雷达对标定装置中的其他组件的反射率不同。Further, the reflectivity of the radar to the radar calibration board is different from the reflectivity of the radar to other components in the calibration device.
进一步的,所述第一旋转轴垂直于水平面,第二旋转轴与第一旋转轴不平行。Further, the first rotation axis is perpendicular to the horizontal plane, and the second rotation axis is not parallel to the first rotation axis.
进一步的,俯仰角的计算过程为:Further, the calculation process of the pitch angle is:
(1)根据摄像头拍摄的处于不同状态下的图片,通过张正友标定法计算摄像头的内参,所述内参包括x方向像素比、y方向像素比、焦距和图片的中心像素坐标与原点像素坐标之间相差的横向和纵向像素数;(1) According to the pictures taken by the camera in different states, the internal parameters of the camera are calculated by Zhang Zhengyou's calibration method. The internal parameters include the pixel ratio in the x direction, the pixel ratio in the y direction, the focal length and the distance between the center pixel coordinates of the picture and the origin pixel coordinates The number of horizontal and vertical pixels that differ;
(2)选取图片中的摄像头标定板和雷达标定板两者处于同一平面内但两者绕第一旋转轴旋转不同角度的多张图片,针对每张图片:计算该图片的旋转矩阵和平移矩阵,根据旋转矩阵计算摄像头坐标系相对摄像头标定板坐标系的俯仰角和偏航角,计算偏航角与该图片中摄像头标定板和雷达标定板两者绕第一旋转轴旋转角度的差值;(2) Select multiple pictures where the camera calibration board and radar calibration board in the picture are both in the same plane but rotated around the first axis of rotation at different angles, for each picture: calculate the rotation matrix and translation matrix of the picture Calculate the pitch angle and yaw angle of the camera coordinate system relative to the camera calibration board coordinate system according to the rotation matrix, and calculate the difference between the yaw angle and the rotation angle of the camera calibration board and the radar calibration board in the picture around the first rotation axis;
(3)将选取的多张图片的偏航角与图片中摄像头标定板和雷达标定板两者绕第一旋转轴旋转角度的差值的平均值作为摄像头安装的偏航角;(3) The average value of the yaw angle of the selected multiple pictures and the rotation angle of the camera calibration board and the radar calibration board around the first rotation axis in the picture is used as the yaw angle of the camera installation;
(4)将选取的多张图片的摄像头坐标系相对摄像头标定板坐标系的俯仰角的平均值作为摄像头安装的俯仰角。(4) The average value of the elevation angle of the camera coordinate system of the selected multiple pictures relative to the camera calibration board coordinate system is used as the elevation angle of the camera installation.
进一步的,雷达和摄像头之间的偏航角为雷达安装的偏航角与摄像头安装的偏航角之和;雷达安装的偏航角根据雷达检测到的标定装置中雷达标定板区域的数据和雷达坐标系与雷达标定板坐标系之间的关系计算获得。Further, the yaw angle between the radar and the camera is the sum of the yaw angle installed by the radar and the yaw angle installed by the camera; the yaw angle installed by the radar is based on the sum of the data of the radar calibration board area in the calibration device detected by the radar. The relationship between the radar coordinate system and the radar calibration board coordinate system is calculated.
进一步的,雷达和摄像头之间的平移向量包括:横向偏差、纵向偏差和高度偏差;Further, the translation vector between the radar and the camera includes: lateral deviation, longitudinal deviation and height deviation;
所述横向偏差和纵向偏差的计算过程包括:The calculation process of the lateral deviation and the longitudinal deviation includes:
(1)根据摄像头标定板与雷达标定板两者处于同一平面内时两者的位置关系计算摄像头标定板坐标和雷达标定板坐标的偏差;(1) Calculate the deviation between the coordinates of the camera calibration board and the radar calibration board according to the positional relationship between the camera calibration board and the radar calibration board when they are in the same plane;
(2)设定标定装置中摄像头标定板和雷达标定板两者处于同一平面内且该平面与摄像头的像平面平行,使摄像头和雷达同时边采集数据边远离标定装置;(2) Set the camera calibration board and the radar calibration board in the calibration device to be in the same plane and the plane is parallel to the image plane of the camera, so that the camera and radar are away from the calibration device while collecting data at the same time;
(3)提取摄像头拍摄的图片中的包含雷达标定板的多张图片,并提取图片拍摄时刻对应的雷达检测数据,根据雷达坐标系与摄像头坐标系之间的关系,将雷达检测数据投射到对应的图片上;(3) Extract multiple pictures including the radar calibration board from the pictures taken by the camera, and extract the radar detection data corresponding to the time the picture was taken. According to the relationship between the radar coordinate system and the camera coordinate system, project the radar detection data to the corresponding On the picture
(4)根据每张图片中雷达检测数据的中间值点与雷达标定板原点的像素坐标差计算获得纵向偏差后,根据三角形相似原理计算获得横向偏差;(4) After calculating the longitudinal deviation according to the pixel coordinate difference between the median point of the radar detection data in each picture and the origin of the radar calibration board, the horizontal deviation is calculated according to the triangle similarity principle;
(5)将多张图片的纵向偏差和横向偏差的平均值设定为雷达和摄像头之间的纵向偏差和横向偏差。(5) Set the average value of the longitudinal deviation and the horizontal deviation of the multiple pictures as the longitudinal deviation and the horizontal deviation between the radar and the camera.
进一步的,通过测量工具手动量取来计算高度偏差,所述高度偏差为摄像头安装高度与雷达的安装高度的差值。Further, the height deviation is calculated manually by a measuring tool, and the height deviation is the difference between the installation height of the camera and the installation height of the radar.
一种雷达与摄像头联合标定系统,包括标定装置、摄像头、雷达、以及处 理终端,所述处理终端包括处理器、存储器以及存储在所述存储器中并在所述处理器上运行的计算机程序,所述系统实现本发明实施例上述的方法的步骤。A radar and camera joint calibration system includes a calibration device, a camera, a radar, and a processing terminal. The processing terminal includes a processor, a memory, and a computer program stored in the memory and running on the processor. The system implements the steps of the method described in the embodiment of the present invention.
一种标定装置,其特征在于,包括摄像头标定板和雷达标定板,所述摄像头标定板能够绕第二旋转轴进行旋转,所述摄像头标定板和雷达标定板两者能够处于同一平面内且两者共同绕第一旋转轴进行旋转。A calibration device, characterized in that it comprises a camera calibration board and a radar calibration board, the camera calibration board can rotate around a second rotation axis, the camera calibration board and the radar calibration board can be in the same plane and both They rotate together around the first rotation axis.
进一步的,所述标定装置包括支架、安装于支架上且能够旋转的内框架、固定安装于内框架上的雷达标定板和安装于内框架上且能够绕与内框架的旋转方向不平行的方向旋转的摄像头标定板。Further, the calibration device includes a bracket, an inner frame mounted on the bracket and capable of rotating, a radar calibration board fixedly mounted on the inner frame, and a radar calibration board mounted on the inner frame and capable of rotating around a direction that is not parallel to the direction of rotation of the inner frame Rotating camera calibration board.
本发明采用如上技术方案,并具有有益效果:The present invention adopts the above technical scheme and has beneficial effects:
(1)可以在标定摄像头内参的同时,联合标定雷达和摄像头之间的外参,统一雷达坐标系和摄像头坐标系,提高标定工序的效率。(1) While calibrating the internal parameters of the camera, it is possible to jointly calibrate the external parameters between the radar and the camera, unify the radar coordinate system and the camera coordinate system, and improve the efficiency of the calibration process.
(2)将一向被忽略的毫米波雷达安装偏航角和摄像头安装偏航角也考虑在内,得到的标定效果更佳。(2) Taking into account the millimeter-wave radar installation yaw angle and the camera installation yaw angle, which have always been ignored, the calibration effect is better.
(3)通过标定板的坐标关系反解得到雷达坐标系和摄像头坐标的三维变换关系,改进了二者安装的夹角关系和水平位移关系较难直接量取的问题,得到的标定效果更精确。(3) The three-dimensional transformation relationship between the radar coordinate system and the camera coordinate is obtained through the inverse solution of the coordinate relationship of the calibration board, which improves the problem that the angle relationship and horizontal displacement relationship between the two installations are difficult to directly measure, and the calibration effect obtained is more accurate .
(4)方法简单易操作,装置简易。(4) The method is simple and easy to operate, and the device is simple.
(5)标定过程中,通过图片可以直接观察到摄像头和雷达两者的融合验证,标定效果有保障。(5) During the calibration process, the fusion verification of the camera and the radar can be directly observed through the pictures, and the calibration effect is guaranteed.
附图说明Description of the drawings
图1所示为本发明实施例一的流程示意图。FIG. 1 is a schematic flowchart of Embodiment 1 of the present invention.
图2所示为该实施例中标定板的结构示意图。Figure 2 shows a schematic diagram of the structure of the calibration plate in this embodiment.
图3所示为该实施例中雷达坐标系与金属板坐标系之间的关系示意图。Fig. 3 is a schematic diagram showing the relationship between the radar coordinate system and the metal plate coordinate system in this embodiment.
图4所示为该实施例中黑白格板坐标和金属板坐标之间的关系示意图。Figure 4 shows a schematic diagram of the relationship between the black and white grid coordinates and the metal plate coordinates in this embodiment.
具体实施方式Detailed ways
为进一步说明各实施例,本发明提供有附图。这些附图为本发明揭露内容的一部分,其主要用以说明实施例,并可配合说明书的相关描述来解释实施例的运作原理。配合参考这些内容,本领域普通技术人员应能理解其他可能的实施方式以及本发明的优点。To further illustrate the embodiments, the present invention is provided with drawings. These drawings are a part of the disclosure of the present invention, which are mainly used to illustrate the embodiments, and can cooperate with the relevant description in the specification to explain the operation principle of the embodiments. With reference to these contents, those of ordinary skill in the art should be able to understand other possible implementations and advantages of the present invention.
现结合附图和具体实施方式对本发明进一步说明。The present invention will now be further described with reference to the drawings and specific embodiments.
实施例一:Example one:
参考图1所示,本发明提供了一种雷达与摄像头联合标定方法,包括以下步骤:Referring to Fig. 1, the present invention provides a joint calibration method of radar and camera, which includes the following steps:
步骤一:设定标定装置。Step 1: Set up the calibration device.
所述标定装置包括支架1、安装于支架1上且能够绕竖直方向旋转的内框架2、固定安装于内框架2上的金属板4和绕与内框架2的旋转方向垂直的方向旋转的黑白格板3。The calibration device includes a bracket 1, an inner frame mounted on the bracket 1 and capable of rotating around the vertical direction 2, a metal plate 4 fixedly mounted on the inner frame 2 and a rotating direction perpendicular to the direction of rotation of the inner frame 2. Black and white grid 3.
由于毫米波雷达对金属和非金属的反射率不同,为了从采集的雷达数据中更好的提取出金属板4区域的数据,因此,该实施例中将金属板4和除金属板4之外的其他部件分别采用不同的材质,即金属板4采用金属材质,标定装置中除金属板4之外的其他部件均采用非金属材质。两者互换也可以。Because the millimeter wave radar has different reflectivity for metal and non-metal, in order to better extract the data of the metal plate 4 area from the collected radar data, therefore, in this embodiment, the metal plate 4 is different from the metal plate 4 The other parts of the s are made of different materials, that is, the metal plate 4 is made of metal, and the other parts except the metal plate 4 in the calibration device are made of non-metallic materials. The two can be interchanged.
该实施例中设定支架1放置于地面上,则内框架2旋转的旋转轴为竖直方向,金属板4旋转的旋转轴在水平面内。具体结构如图2所示,支架1为长方形框架结构,其下方包括两个用于平稳放置于地面的放置脚,在长方形框架的 两条水平框架的中间位置处垂直设置用于内框架2旋转的第一旋转轴5,内框架2也为长方形框架结构,其上下两条水平框架的中间位置处分别连接第一旋转轴5,以使内框架2能够绕第一旋转轴5旋转。所述金属板4和黑白格板3均设置于内框架2内,其中,黑白格板3设置于上方,金属板4设置于下方,在内框架2的左右两条竖直框架上垂直设置用于黑白格板3旋转的第二旋转轴6,黑板隔板的中间位置处分别连接第二旋转轴6,以使黑白格板3能够绕第二旋转轴6旋转。In this embodiment, if the support 1 is placed on the ground, the rotation axis of the inner frame 2 is vertical, and the rotation axis of the metal plate 4 is in the horizontal plane. The specific structure is shown in Figure 2. The bracket 1 is a rectangular frame structure, and the bottom includes two feet for stable placement on the ground. The frame is vertically arranged at the middle of the two horizontal frames of the rectangular frame for the inner frame 2 to rotate. The inner frame 2 also has a rectangular frame structure, and the middle positions of the upper and lower horizontal frames are respectively connected to the first rotary shaft 5, so that the inner frame 2 can rotate around the first rotary shaft 5. The metal plate 4 and the black and white grid plate 3 are both arranged in the inner frame 2, wherein the black and white grid plate 3 is arranged above, and the metal plate 4 is arranged below. The two vertical frames on the left and right of the inner frame 2 are used for vertical installation. The second rotating shaft 6 on which the black and white grid plate 3 rotates and the middle position of the blackboard divider are respectively connected to the second rotation shaft 6 so that the black and white grid plate 3 can rotate around the second rotation axis 6.
所述金属板4和第二旋转轴6设置于同一平面内,以使金属板4与黑白格板3两者能够处于同一平面内且两者共同绕第一旋转轴5旋转。The metal plate 4 and the second rotating shaft 6 are arranged in the same plane, so that the metal plate 4 and the black-and-white grid plate 3 can be in the same plane and both rotate around the first rotating shaft 5 together.
该实施例中为了方便设置和计算,所述第一旋转轴5与第二旋转轴6相互垂直设置,即一者垂直于水平面,另一者平行于水平面,在其他的实施例中两者可以呈其他合适的角度。In this embodiment, for the convenience of setting and calculation, the first rotation axis 5 and the second rotation axis 6 are arranged perpendicular to each other, that is, one is perpendicular to the horizontal plane, and the other is parallel to the horizontal plane. In other embodiments, both can be At other suitable angles.
上述标定装置的实施例仅为标定装置的一种较佳的结构,针对标定装置中各组件的外形、尺寸、连接位置等均不受限制。The above-mentioned embodiment of the calibration device is only a preferred structure of the calibration device, and there are no restrictions on the shape, size, and connection position of each component in the calibration device.
步骤二:将标定装置设置于车辆前方的标定位置。Step 2: Set the calibration device at the calibration position in front of the vehicle.
该实施例中,将标定装置设置于车辆前方的对应于车辆中心的位置,且标定装置中的黑白格板3位于摄像头画面的中心,且大致占画面大小的二分之一,标定装置的支架1平行于车辆的车头。In this embodiment, the calibration device is set in front of the vehicle at a position corresponding to the center of the vehicle, and the black-and-white grid 3 in the calibration device is located in the center of the camera screen and occupies roughly one-half of the screen size. The bracket of the calibration device 1 Parallel to the front of the vehicle.
步骤三:通过摄像头拍摄标定装置的图片,同时通过毫米波雷达检测标定装置。Step 3: Take a picture of the calibration device through the camera, and detect the calibration device through the millimeter wave radar.
该实施例中,通过车辆上固定设置的摄像头拍摄3组图片,每组图片中包括5张图片。其中:In this embodiment, three groups of pictures are taken by a camera fixedly arranged on the vehicle, and each group of pictures includes 5 pictures. among them:
第一组的5张图片中内框架2的水平旋转角均为0°,黑白格板3的上下翻转角分别为0°、±20°、±45°。In the first group of 5 pictures, the horizontal rotation angle of the inner frame 2 is 0°, and the vertical flip angle of the black and white grid 3 is 0°, ±20°, and ±45°, respectively.
第二组的5张图片中内框架2的水平旋转角均为45°,黑白格板3的上下翻转角分别为0°、±20°、±45°。In the 5 pictures of the second group, the horizontal rotation angle of the inner frame 2 is 45°, and the vertical flip angle of the black and white grid 3 is 0°, ±20°, and ±45°, respectively.
第三组的5张图片中内框架2的水平旋转角均为-45°,黑白格板3的上下翻转角分别为0°,±20°,±45°。In the third group of 5 pictures, the horizontal rotation angle of the inner frame 2 is -45°, and the vertical flip angle of the black and white grid 3 is 0°, ±20°, and ±45°, respectively.
所述水平旋转角为内框架2相对于支架1旋转的角度,所述上下翻转角为黑白格板3相对于内框架2旋转的角度。The horizontal rotation angle is the angle at which the inner frame 2 rotates relative to the support 1, and the up and down flip angle is the angle at which the black and white grid plate 3 rotates relative to the inner frame 2.
步骤四:根据毫米波雷达的检测数据提取过滤出毫米波雷达信息中的金属板4对应的数据。Step 4: Extract and filter out the data corresponding to the metal plate 4 in the millimeter wave radar information according to the detection data of the millimeter wave radar.
该实施例中,根据拍摄时的时间戳,提取出拍摄第1张图片(内框架2的水平旋转角为0°,黑白格板3的上下翻转角为0°),第6张图片(内框架2的水平旋转角为45°,黑白格板3的上下翻转角为0°)和第11张图片(内框架2的水平旋转角为-45°,黑白格板3的上下翻转角为0°)的时刻所对应的雷达检测数据,对雷达检测数据进行滤波处理,只留下金属板4区域的雷达检测数据。In this embodiment, according to the time stamp at the time of shooting, the first picture is extracted (the horizontal rotation angle of the inner frame 2 is 0°, and the vertical flip angle of the black and white grid 3 is 0°), and the sixth picture (inner The horizontal rotation angle of the frame 2 is 45°, the vertical flip angle of the black and white grid 3 is 0°) and the 11th picture (the horizontal rotation angle of the inner frame 2 is -45°, and the vertical flip angle of the black and white grid 3 is 0 For the radar detection data corresponding to the time of °), the radar detection data is filtered, leaving only the radar detection data of the metal plate 4 area.
步骤五:计算毫米波雷达安装的偏航角α。Step 5: Calculate the yaw angle α of the millimeter wave radar installation.
如图3所示,毫米波雷达坐标系与金属板4坐标系之间的关系为:As shown in Figure 3, the relationship between the millimeter wave radar coordinate system and the metal plate 4 coordinate system is:
Figure PCTCN2019128584-appb-000001
Figure PCTCN2019128584-appb-000001
Y P=0 Y P =0
Figure PCTCN2019128584-appb-000002
Figure PCTCN2019128584-appb-000002
其中,X r-Y r表示毫米波雷达坐标系,X p-Y p表示金属板4坐标系,l 0为X r为0时的Y r值,α为毫米波雷达安装的偏航角。 Among them, X r -Y r represents the millimeter wave radar coordinate system, X p -Y p represents the metal plate 4 coordinate system, l 0 is the Y r value when X r is 0, and α is the yaw angle of the millimeter wave radar installation.
通过毫米波雷达检测所得的金属板4对应的数据,计算得到毫米波雷达的安装偏航角α。Through the data corresponding to the metal plate 4 detected by the millimeter wave radar, the installation yaw angle α of the millimeter wave radar is calculated.
步骤六:计算摄像头内参。Step 6: Calculate the internal parameters of the camera.
该实施例中根据摄像头拍摄的3组15张图片,利用张正友标定法,计算出摄像头的内参:x方向像素比1/dx、y方向像素比1/dy、焦距f、图片的中心像素坐标和原点像素坐标之间相差的横向和纵向像素数u 0、v 0In this embodiment, according to the 3 groups of 15 pictures taken by the camera, the internal parameters of the camera are calculated using the Zhang Zhengyou calibration method: x-direction pixel ratio 1/dx, y-direction pixel ratio 1/dy, focal length f, the center pixel coordinates of the picture and The number of horizontal and vertical pixels u 0 , v 0 that differ between the pixel coordinates of the origin.
并计算第1张图片的旋转矩阵R 0和平移矩阵T 0,第6张图片的旋转矩阵R 1和平移矩阵T 1,第11张图片的旋转矩阵R 2和平移矩阵T 2And calculate the rotation matrix R 0 and translation matrix T 0 of the first picture, the rotation matrix R 1 and translation matrix T 1 of the sixth picture, and the rotation matrix R 2 and translation matrix T 2 of the 11th picture.
步骤七:计算摄像头外参。Step 7: Calculate the external parameters of the camera.
针对上述第1、6和11张图片的旋转矩阵R 0、R 1、R 2得到摄像头坐标系相对黑白格板3坐标系的俯仰角β 0、β 1、β 2,及偏航角α 0、α 1、α 2。分别计算偏航角α 0与0°的偏差Δ 0,α 1与45°的偏差Δ 1,α 2与-45°的偏差Δ 2。取Δ 0、Δ 1、Δ 2的平均值Δ作为摄像头安装的偏航角。取β 0、β 1、β 2的平均值β作为摄像头安装的俯仰角。 For the rotation matrices R 0 , R 1 , and R 2 of the above-mentioned pictures 1, 6 and 11, the pitch angle β 0 , β 1 , β 2 and the yaw angle α 0 of the camera coordinate system relative to the black and white grid 3 coordinate system are obtained. , Α 1 , α 2 . Calculate yaw angle α 0 and 0 ° deviation Δ 0, α 1 and 45 ° deviation of Δ 1, and a deviation of -45 ° α 2 Δ 2. Take the average value Δ of Δ 0 , Δ 1 , and Δ 2 as the yaw angle of the camera installation. Take the average value β of β 0 , β 1 , and β 2 as the pitch angle of the camera installation.
步骤八:根据黑白格板3和金属板4之间的位置关系计算黑白格板3坐标和金属板4坐标的偏差。Step 8: Calculate the deviation between the coordinates of the black and white grid 3 and the metal plate 4 according to the positional relationship between the black and white grid 3 and the metal plate 4.
X W=X P+a X W =X P +a
Z P=0 Z P =0
Y W=b-Z P=b Y W =bZ P =b
Z W=Y P=0 Z W =Y P =0
其中,X W-Y W为黑白格板3坐标系(即摄像头坐标系),X p-Y p为金属板4坐标系,a为黑白格板3坐标和金属板4坐标之间的横向偏差,b为黑白格板3坐标和金属板4坐标之间的纵向偏差。 Among them, X W -Y W is the black and white grid 3 coordinate system (ie the camera coordinate system), X p -Y p is the metal plate 4 coordinate system, and a is the lateral deviation between the black and white grid 3 coordinates and the metal plate 4 coordinates , B is the longitudinal deviation between the coordinates of the black and white grid plate 3 and the metal plate 4.
如图4所示,该实施例中黑白格板3坐标原点为左上角第一个角点,金属 板4坐标原点为金属板4的中心。用直尺量取黑白格板3坐标和金属板4坐标之间的横向偏差a和纵向偏差和b。As shown in Fig. 4, in this embodiment, the origin of the coordinates of the black and white grid 3 is the first corner point in the upper left corner, and the origin of the coordinates of the metal plate 4 is the center of the metal plate 4. Measure the horizontal deviation a and the vertical deviation sum b between the coordinates of the black and white grid plate 3 and the metal plate 4 with a ruler.
步骤九:获取毫米波雷达和摄像头安装的横向偏差lx及纵向偏差ly。Step 9: Obtain the lateral deviation lx and the longitudinal deviation ly of the millimeter wave radar and camera installation.
设定标定装置的内框架2的水平旋转角为0°,使车辆缓慢直行后退,后退过程中摄像头和毫米波雷达同时采集数据。The horizontal rotation angle of the inner frame 2 of the calibration device is set to 0°, so that the vehicle moves slowly and straight back, and the camera and the millimeter wave radar collect data at the same time during the backward process.
提取当金属板4也进入摄像头画面之后的3-5幅摄像头和毫米波雷达的同步帧数据,根据毫米波雷达坐标与摄像头坐标系之间的关系,将雷达检测数据投射到摄像头拍摄的图片上:Extract the synchronization frame data of 3-5 cameras and millimeter wave radar after the metal plate 4 also enters the camera screen, and project the radar detection data to the picture taken by the camera according to the relationship between the millimeter wave radar coordinates and the camera coordinate system :
Figure PCTCN2019128584-appb-000003
Figure PCTCN2019128584-appb-000003
其中,偏航角α由步骤五获得,1/dx、1/dy、f、u 0、v 0由步骤六获得,R、T选用步骤六中的R 0和T 0,a、b由步骤八获得。 Among them, the yaw angle α is obtained in step 5, 1/dx, 1/dy, f, u 0 , and v 0 are obtained in step 6, R and T are selected from R 0 and T 0 in step 6, and a and b are obtained from steps Eight obtained.
据此根据图片中毫米波雷达检测数据的中间值点与金属板4原点的像素坐标差反求得到纵向偏差l y,然后根据三角形相似原理得到横向偏差l xAccordingly, according to the pixel coordinate difference between the intermediate value point of the millimeter wave radar detection data in the picture and the origin of the metal plate 4, the longitudinal deviation l y is obtained , and then the horizontal deviation l x is obtained according to the triangle similarity principle.
步骤十:量取高度安装偏差l zStep 10: Measure the height installation deviation l z .
该实施例中通过直尺量取毫米波雷达的安装高度h 1,摄像头安装高度h 2,高度安装偏差l z=h 2-h 1In this embodiment, a ruler is used to measure the installation height h 1 of the millimeter wave radar, the camera installation height h 2 , and the height installation deviation l z =h 2 -h 1 .
步骤十一:输出标定数据。Step 11: Output calibration data.
毫米波雷达坐标系到摄像头坐标系的转换为刚体变换,可以看做毫米波雷达先相对摄像机进行了平移变换,再进行旋转变换,其中,雷达的安装俯仰角和横滚角忽略不计,摄像头安装的横滚角忽略不计。那么毫米波雷达和摄像头 之间的偏航角=α+Δ,俯仰角为β,横滚角为0,分别由步骤五和步骤七获得。平移向量(l x,l y,l z)分别由步骤九、步骤十获得。把毫米波雷达和摄像头之间的偏航角α+Δ,俯仰角β,横滚角0,平移向量(l x,l y,l z)作为毫米波雷达和摄像头联合标定的数据输出,以供车辆后续感知模块使用。 The conversion of the millimeter wave radar coordinate system to the camera coordinate system is a rigid body transformation, which can be regarded as the millimeter wave radar first has a translation transformation relative to the camera, and then a rotation transformation. Among them, the installation pitch and roll angles of the radar are ignored, and the camera is installed The roll angle is ignored. Then the yaw angle between the millimeter wave radar and the camera = α + Δ, the pitch angle is β, and the roll angle is 0, which are obtained by steps 5 and 7 respectively. The translation vector (l x , l y , l z ) is obtained by step 9 and step 10 respectively. Take the yaw angle α+Δ, pitch angle β, roll angle 0, and translation vector (l x , l y , l z ) between the millimeter wave radar and the camera as the data output of the millimeter wave radar and camera joint calibration. Used by the vehicle's subsequent perception module.
本发明实施例一中方法可以用于AEBS等同时用到雷达和摄像头两种传感器的任何智能驾驶系统中。The method in the first embodiment of the present invention can be used in any intelligent driving system that uses both radar and camera sensors, such as AEBS.
该实施例进行了以下改进:This embodiment has the following improvements:
(1)基于张正友标定法做了改进,通过固定3个标定装置角度,在标定摄像头内参的同时,获取摄像头安装的俯仰角和偏航角。(1) Improved based on Zhang Zhengyou's calibration method. By fixing the angles of three calibration devices, while calibrating the internal parameters of the camera, the pitch angle and yaw angle of the camera installation are obtained.
(2)设计了一种标定装置,标定装置上同时固连一块强反射波金属板4障碍物,在标定摄像头内参的同时,可以标定毫米波雷达安装的偏航角。(2) A calibration device is designed, and a strong reflection wave metal plate 4 is fixed on the calibration device at the same time. While calibrating the internal parameters of the camera, it can calibrate the yaw angle of the millimeter wave radar.
(3)通过标定装置的坐标关系反解得到雷达坐标系和摄像头坐标的三维变换关系,改进了二者安装的夹角关系和水平位移关系较难直接量取的问题。(3) Through the inverse solution of the coordinate relationship of the calibration device, the three-dimensional transformation relationship between the radar coordinate system and the camera coordinate is obtained, which improves the problem that the angle relationship and the horizontal displacement relationship between the two installations are difficult to directly measure.
其具有以下优点:It has the following advantages:
(1)可以在标定摄像头内参的同时,联合标定雷达和摄像头之间的外参,统一雷达坐标系和摄像头坐标系,提高标定工序的效率。(1) While calibrating the internal parameters of the camera, it is possible to jointly calibrate the external parameters between the radar and the camera, unify the radar coordinate system and the camera coordinate system, and improve the efficiency of the calibration process.
(2)将一向被忽略的毫米波雷达安装偏航角和摄像头安装偏航角也考虑在内,得到的标定效果更佳。(2) Taking into account the millimeter-wave radar installation yaw angle and the camera installation yaw angle, which have always been ignored, the calibration effect is better.
(3)通过标定装置的坐标关系反解得到雷达坐标系和摄像头坐标的三维变换关系,改进了二者安装的夹角关系和水平位移关系较难直接量取的问题,得到的标定效果更精确。(3) Through the inverse solution of the coordinate relationship of the calibration device, the three-dimensional transformation relationship between the radar coordinate system and the camera coordinate is obtained, which improves the problem that the angle relationship and horizontal displacement relationship between the two installations are difficult to directly measure, and the obtained calibration effect is more accurate .
(4)方法简单易操作,装置简易。(4) The method is simple and easy to operate, and the device is simple.
(5)标定过程中,通过图片可以直接观察到两传感器数据的融合验证,标定效果有保障。(5) During the calibration process, the fusion verification of the two sensor data can be directly observed through the pictures, and the calibration effect is guaranteed.
实施例二:Embodiment two:
本发明还提供一种雷达与摄像头联合标定系统,包括如实施例一所述的标定装置、摄像头、雷达、以及处理终端,所述处理终端包括存储器、处理器和总线,所述存储器存储有至少一段程序,所述系统实现如本发明实施例一所述的雷达与摄像头联合标定方法。The present invention also provides a radar and camera joint calibration system, including the calibration device as described in the first embodiment, a camera, a radar, and a processing terminal. The processing terminal includes a memory, a processor, and a bus. The memory stores at least A piece of program, the system implements the radar and camera joint calibration method as described in the first embodiment of the present invention.
所述处理器包括一个或一个以上处理核心,处理器通过总线与存储器相连,存储器用于存储程序指令,处理器执行存储器中的程序指令时实现本发明实施例一所述的雷达与摄像头联合标定方法。The processor includes one or more processing cores, the processor is connected to the memory through a bus, and the memory is used to store program instructions. When the processor executes the program instructions in the memory, the radar and camera joint calibration described in the first embodiment of the present invention are implemented. method.
进一步地,作为一个可执行方案,所称处理器可以是中央处理单元(Central Processing Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等,所述处理器是所述雷达与摄像头联合标定系统的控制中心,利用各种接口和线路连接整个雷达与摄像头联合标定系统的各个部分。Further, as an executable solution, the so-called processor may be a central processing unit (Central Processing Unit, CPU), or other general-purpose processors, digital signal processors (Digital Signal Processors, DSPs), and application-specific integrated circuits (Central Processing Unit, CPU). Application Specific Integrated Circuit (ASIC), Field-Programmable Gate Array (FPGA) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components, etc. The general-purpose processor can be a microprocessor or the processor can also be any conventional processor, etc. The processor is the control center of the radar and camera joint calibration system, which uses various interfaces and lines to connect the entire radar and camera All parts of the joint calibration system.
所述存储器可用于存储所述计算机程序和/或模块,所述处理器通过运行或执行存储在所述存储器内的计算机程序和/或模块,以及调用存储在存储器内的数据,实现所述雷达与摄像头联合标定系统的各种功能。所述存储器可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序;存储数据区可存储根据手机的使用所创建的数据等。此外, 存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如硬盘、内存、插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)、至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。The memory may be used to store the computer program and/or module, and the processor realizes the radar by running or executing the computer program and/or module stored in the memory and calling the data stored in the memory. Various functions of the calibration system in conjunction with the camera. The memory may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating system and an application program required by at least one function; the data storage area may store data created according to the use of the mobile phone, etc. In addition, the memory may include high-speed random access memory, and may also include non-volatile memory, such as hard disk, memory, plug-in hard disk, Smart Media Card (SMC), Secure Digital (SD) card , Flash Card, at least one magnetic disk storage device, flash memory device, or other volatile solid-state storage device.
尽管结合优选实施方案具体展示和介绍了本发明,但所属领域的技术人员应该明白,在不脱离所附权利要求书所限定的本发明的精神和范围内,在形式上和细节上可以对本发明做出各种变化,均为本发明的保护范围。Although the present invention has been specifically shown and described in conjunction with the preferred embodiments, those skilled in the art should understand that the present invention can be modified in form and detail without departing from the spirit and scope of the present invention as defined by the appended claims. Various changes are within the protection scope of the present invention.

Claims (10)

  1. 一种雷达与摄像头联合标定方法,其特征在于,包括以下步骤:A joint calibration method of radar and camera is characterized in that it comprises the following steps:
    S1:提供标定装置,标定装置包括摄像头标定板和雷达标定板,使标定装置处于标定位置;S1: Provide a calibration device, the calibration device includes a camera calibration board and a radar calibration board, so that the calibration device is in the calibration position;
    S2:通过摄像头采集标定装置处于不同状态下的图片,同时通过雷达检测标定装置,所述不同状态包括摄像头标定板和雷达标定板两者处于同一平面内且两者共同绕第一旋转轴旋转不同的角度和摄像头标定板绕第二旋转轴旋转不同的角度;S2: Collect pictures of the calibration device in different states through the camera, and at the same time detect the calibration device by radar. The different states include that the camera calibration board and the radar calibration board are both in the same plane and both rotate differently around the first rotation axis. The angle of and the camera calibration board rotates at different angles around the second rotation axis;
    S3:根据摄像头采集图片的时刻所对应的雷达检测数据来计算标定数据,并输出,所述标定数据包括:雷达和摄像头之间的偏航角、俯仰角和平移向量。S3: Calculate and output calibration data according to the radar detection data corresponding to the moment when the camera collects the picture. The calibration data includes the yaw angle, the pitch angle and the translation vector between the radar and the camera.
  2. 根据权利要求1所述的方法,其特征在于:雷达对雷达标定板的反射率与雷达对标定装置中的其他组件的反射率不同。The method according to claim 1, wherein the reflectivity of the radar to the radar calibration plate is different from the reflectivity of the radar to other components in the calibration device.
  3. 根据权利要求1所述的方法,其特征在于:所述第一旋转轴垂直于水平面,第二旋转轴与第一旋转轴不平行。The method according to claim 1, wherein the first rotation axis is perpendicular to the horizontal plane, and the second rotation axis is not parallel to the first rotation axis.
  4. 根据权利要求1所述的方法,其特征在于:俯仰角的计算过程为:The method according to claim 1, wherein the calculation process of the pitch angle is:
    (1)根据摄像头拍摄的处于不同状态下的图片,通过张正友标定法计算摄像头的内参,所述内参包括x方向像素比、y方向像素比、焦距和图片的中心像素坐标与原点像素坐标之间相差的横向和纵向像素数;(1) According to the pictures taken by the camera in different states, the internal parameters of the camera are calculated by Zhang Zhengyou's calibration method. The internal parameters include the pixel ratio in the x direction, the pixel ratio in the y direction, the focal length and the distance between the center pixel coordinates of the picture and the origin pixel coordinates The number of horizontal and vertical pixels that differ;
    (2)选取图片中的摄像头标定板和雷达标定板两者处于同一平面内但两者绕第一旋转轴旋转不同角度的多张图片,针对每张图片:计算该图片的旋转矩阵和平移矩阵,根据旋转矩阵计算摄像头坐标系相对摄像头标定板坐标系的俯仰角和偏航角,计算偏航角与该图片中摄像头标定板和雷达标定板两者绕第一旋转轴旋转角度的差值;(2) Select multiple pictures where the camera calibration board and radar calibration board in the picture are both in the same plane but rotated around the first axis of rotation at different angles, for each picture: calculate the rotation matrix and translation matrix of the picture Calculate the pitch angle and yaw angle of the camera coordinate system relative to the camera calibration board coordinate system according to the rotation matrix, and calculate the difference between the yaw angle and the rotation angle of the camera calibration board and the radar calibration board in the picture around the first rotation axis;
    (3)将选取的多张图片的偏航角与图片中摄像头标定板和雷达标定板两者绕第一旋转轴旋转角度的差值的平均值作为摄像头安装的偏航角;(3) The average value of the yaw angle of the selected multiple pictures and the rotation angle of the camera calibration board and the radar calibration board around the first rotation axis in the picture is used as the yaw angle of the camera installation;
    (4)将选取的多张图片的摄像头坐标系相对摄像头标定板坐标系的俯仰角的平均值作为摄像头安装的俯仰角。(4) The average value of the elevation angle of the camera coordinate system of the selected multiple pictures relative to the camera calibration board coordinate system is used as the elevation angle of the camera installation.
  5. 根据权利要求4所述的方法,其特征在于:雷达和摄像头之间的偏航角为雷达安装的偏航角与摄像头安装的偏航角之和;雷达安装的偏航角根据雷达检测到的标定装置中雷达标定板区域的数据和雷达坐标系与雷达标定板坐标系之间的关系计算获得。The method according to claim 4, wherein the yaw angle between the radar and the camera is the sum of the yaw angle installed by the radar and the yaw angle installed by the camera; the yaw angle installed by the radar is based on the yaw angle detected by the radar The data of the radar calibration board area in the calibration device and the relationship between the radar coordinate system and the radar calibration board coordinate system are calculated.
  6. 根据权利要求1所述的方法,其特征在于:雷达和摄像头之间的平移向量包括:横向偏差、纵向偏差和高度偏差;The method according to claim 1, wherein the translation vector between the radar and the camera includes: lateral deviation, longitudinal deviation and height deviation;
    所述横向偏差和纵向偏差的计算过程包括:The calculation process of the lateral deviation and the longitudinal deviation includes:
    (1)根据摄像头标定板与雷达标定板两者处于同一平面内时两者的位置关系计算摄像头标定板坐标和雷达标定板坐标的偏差;(1) Calculate the deviation between the coordinates of the camera calibration board and the radar calibration board according to the positional relationship between the camera calibration board and the radar calibration board when they are in the same plane;
    (2)设定标定装置中摄像头标定板和雷达标定板两者处于同一平面内且该平面与摄像头的像平面平行,使摄像头和雷达同时边采集数据边远离标定装置;(2) Set the camera calibration board and the radar calibration board in the calibration device to be in the same plane and the plane is parallel to the image plane of the camera, so that the camera and radar are away from the calibration device while collecting data at the same time;
    (3)提取摄像头拍摄的图片中的包含雷达标定板的多张图片,并提取图片拍摄时刻对应的雷达检测数据,根据雷达坐标系与摄像头坐标系之间的关系,将雷达检测数据投射到对应的图片上;(3) Extract multiple pictures including the radar calibration board from the pictures taken by the camera, and extract the radar detection data corresponding to the time the picture was taken. According to the relationship between the radar coordinate system and the camera coordinate system, project the radar detection data to the corresponding On the picture
    (4)根据每张图片中雷达检测数据的中间值点与雷达标定板原点的像素坐标差计算获得纵向偏差后,根据三角形相似原理计算获得横向偏差;(4) After calculating the longitudinal deviation according to the pixel coordinate difference between the median point of the radar detection data in each picture and the origin of the radar calibration board, the horizontal deviation is calculated according to the triangle similarity principle;
    (5)将多张图片的纵向偏差和横向偏差的平均值设定为雷达和摄像头之间的纵向偏差和横向偏差。(5) Set the average value of the longitudinal deviation and the horizontal deviation of the multiple pictures as the longitudinal deviation and the horizontal deviation between the radar and the camera.
  7. 根据权利要求6所述的方法,其特征在于:通过测量工具手动量取来计算高度偏差,所述高度偏差为摄像头安装高度与雷达的安装高度的差值。The method according to claim 6, characterized in that the height deviation is manually measured by a measuring tool, and the height deviation is the difference between the installation height of the camera and the installation height of the radar.
  8. 一种雷达与摄像头联合标定系统,其特征在于:包括标定装置、摄像头、雷达、以及处理终端,所述处理终端包括处理器、存储器以及存储在所述存储器中并在所述处理器上运行的计算机程序,所述系统实现如权利要求1~7中任一所述方法的步骤。A combined radar and camera calibration system, which is characterized in that it includes a calibration device, a camera, a radar, and a processing terminal. The processing terminal includes a processor, a memory, and a device stored in the memory and running on the processor. A computer program that implements the steps of the method as claimed in any one of claims 1-7.
  9. 一种标定装置,其特征在于,包括摄像头标定板和雷达标定板,所述摄像头标定板能够绕第二旋转轴进行旋转,所述摄像头标定板和雷达标定板两者能够处于同一平面内且两者共同绕第一旋转轴进行旋转。A calibration device, characterized in that it comprises a camera calibration board and a radar calibration board, the camera calibration board can rotate around a second rotation axis, the camera calibration board and the radar calibration board can be in the same plane and both They rotate together around the first rotation axis.
  10. 根据权利要求9所述的标定装置,其特征在于:所述标定装置包括支架、安装于支架上且能够旋转的内框架、固定安装于内框架上的雷达标定板和安装于内框架上且能够绕与内框架的旋转方向不平行的方向旋转的摄像头标定板。The calibration device according to claim 9, characterized in that: the calibration device comprises a bracket, a rotatable inner frame installed on the bracket, a radar calibration board fixedly installed on the inner frame, and a radar calibration board installed on the inner frame and capable of A camera calibration board that rotates around a direction that is not parallel to the rotation direction of the inner frame.
PCT/CN2019/128584 2019-07-04 2019-12-26 Calibration apparatus, and radar and camera joint calibration method and system WO2021000544A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201910597770.1A CN110310339B (en) 2019-07-04 2019-07-04 Calibration device and radar and camera combined calibration method and system
CN201910597770.1 2019-07-04

Publications (1)

Publication Number Publication Date
WO2021000544A1 true WO2021000544A1 (en) 2021-01-07

Family

ID=68079734

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/128584 WO2021000544A1 (en) 2019-07-04 2019-12-26 Calibration apparatus, and radar and camera joint calibration method and system

Country Status (2)

Country Link
CN (1) CN110310339B (en)
WO (1) WO2021000544A1 (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110310339B (en) * 2019-07-04 2021-05-04 厦门金龙联合汽车工业有限公司 Calibration device and radar and camera combined calibration method and system
CN111435162B (en) * 2020-03-03 2021-10-08 深圳市镭神智能系统有限公司 Laser radar and camera synchronization method, device, equipment and storage medium
CN111381215A (en) * 2020-03-25 2020-07-07 中国科学院地质与地球物理研究所 Phase correction method and meteor position acquisition method
CN112270718B (en) * 2020-11-13 2022-11-15 苏州智加科技有限公司 Camera calibration method, device, system and storage medium
CN113256734B (en) * 2021-05-20 2023-05-09 岚图汽车科技有限公司 Vehicle-mounted sensing sensor calibration method and system and electronic equipment
CN113486795A (en) * 2021-07-06 2021-10-08 广州小鹏自动驾驶科技有限公司 Visual identification performance test method, device, system and equipment
CN113766211B (en) * 2021-08-24 2023-07-25 武汉极目智能技术有限公司 Camera installation angle detection system and method of ADAS (advanced automatic attachment system) equipment
CN115799140B (en) * 2022-07-20 2023-12-01 拓荆键科(海宁)半导体设备有限公司 Calibration method and device, combined microscope and wafer bonding method
CN115438208A (en) * 2022-08-23 2022-12-06 成都智元汇信息技术股份有限公司 Method and device for improving package association accuracy

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016176487A1 (en) * 2015-04-28 2016-11-03 Henri Johnson Systems to track a moving sports object
CN108226906A (en) * 2017-11-29 2018-06-29 深圳市易成自动驾驶技术有限公司 A kind of scaling method, device and computer readable storage medium
WO2019015847A1 (en) * 2017-07-18 2019-01-24 Robert Bosch Gmbh Calibration device and method for calibrating motor vehicle environment sensors
CN109828262A (en) * 2019-03-15 2019-05-31 苏州天准科技股份有限公司 Laser radar and the automatic combined calibrating method of camera based on plane and space characteristics
CN109828250A (en) * 2019-03-28 2019-05-31 森思泰克河北科技有限公司 A kind of Radar Calibration method, caliberating device and terminal device
CN110310339A (en) * 2019-07-04 2019-10-08 厦门金龙联合汽车工业有限公司 A kind of caliberating device and a kind of radar and camera combined calibrating method and system

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9134402B2 (en) * 2012-08-13 2015-09-15 Digital Signal Corporation System and method for calibrating video and lidar subsystems
CN106228537A (en) * 2016-07-12 2016-12-14 北京理工大学 A kind of three-dimensional laser radar and the combined calibrating method of monocular-camera
CN206258931U (en) * 2016-11-02 2017-06-16 北京中科慧眼科技有限公司 Caliberating device
CN106740872A (en) * 2017-01-13 2017-05-31 驭势科技(北京)有限公司 Intelligent automobile sensor self-checking system and method, accessory system and intelligent automobile
CN107167790B (en) * 2017-05-24 2019-08-09 北京控制工程研究所 A kind of two step scaling method of laser radar based on Calibration Field
CN109270534B (en) * 2018-05-07 2020-10-27 西安交通大学 Intelligent vehicle laser sensor and camera online calibration method
CN109061610A (en) * 2018-09-11 2018-12-21 杭州电子科技大学 A kind of combined calibrating method of camera and radar

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016176487A1 (en) * 2015-04-28 2016-11-03 Henri Johnson Systems to track a moving sports object
WO2019015847A1 (en) * 2017-07-18 2019-01-24 Robert Bosch Gmbh Calibration device and method for calibrating motor vehicle environment sensors
CN108226906A (en) * 2017-11-29 2018-06-29 深圳市易成自动驾驶技术有限公司 A kind of scaling method, device and computer readable storage medium
CN109828262A (en) * 2019-03-15 2019-05-31 苏州天准科技股份有限公司 Laser radar and the automatic combined calibrating method of camera based on plane and space characteristics
CN109828250A (en) * 2019-03-28 2019-05-31 森思泰克河北科技有限公司 A kind of Radar Calibration method, caliberating device and terminal device
CN110310339A (en) * 2019-07-04 2019-10-08 厦门金龙联合汽车工业有限公司 A kind of caliberating device and a kind of radar and camera combined calibrating method and system

Also Published As

Publication number Publication date
CN110310339B (en) 2021-05-04
CN110310339A (en) 2019-10-08

Similar Documents

Publication Publication Date Title
WO2021000544A1 (en) Calibration apparatus, and radar and camera joint calibration method and system
US11157766B2 (en) Method, apparatus, device and medium for calibrating pose relationship between vehicle sensor and vehicle
CN110146869B (en) Method and device for determining coordinate system conversion parameters, electronic equipment and storage medium
CN109035320B (en) Monocular vision-based depth extraction method
US10339390B2 (en) Methods and apparatus for an imaging system
US9197866B2 (en) Method for monitoring a traffic stream and a traffic monitoring device
CN102930544B (en) Parameter calibration system of vehicle-mounted camera
CN111383279B (en) External parameter calibration method and device and electronic equipment
CN112419385A (en) 3D depth information estimation method and device and computer equipment
CN113034612B (en) Calibration device, method and depth camera
CN109118537B (en) Picture matching method, device, equipment and storage medium
CN108429908B (en) Camera module testing method, device, equipment and medium
CN109683170A (en) A kind of image traveling area marking method, apparatus, mobile unit and storage medium
US10482626B2 (en) Around view monitoring systems for vehicle and calibration methods for calibrating image capture devices of an around view monitoring system using the same
WO2023185250A1 (en) Obstacle distance measurement method, mobile robot, device and medium
CN111508027A (en) Method and device for calibrating external parameters of camera
CN112233188A (en) Laser radar-based roof panoramic camera and calibration method thereof
CN112799091A (en) Algorithm evaluation method, device and storage medium
CN112419405A (en) Target tracking joint display method, security system and electronic equipment
CN113763478B (en) Unmanned vehicle camera calibration method, device, equipment, storage medium and system
CN111382591A (en) Binocular camera ranging correction method and vehicle-mounted equipment
Kinzig et al. Real-time seamless image stitching in autonomous driving
CN110986887B (en) Monocular camera-based distance measurement method, storage medium and monocular camera
CN110188665B (en) Image processing method and device and computer equipment
CN110310492B (en) Speed measuring method and device for mobile vehicle

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19936407

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19936407

Country of ref document: EP

Kind code of ref document: A1