A method and system for determining the installation angle of intersection radar based on error compensation
By acquiring and filtering radar and camera tracking coordinates at different time frames, an error compensation function is constructed to correct the radar installation angle, thus solving the problem of large radar installation angle error and achieving higher precision radar installation.
Patent Information
- Application Number
- CN202210734213.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-06-27
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-06-27
AI Technical Summary
In existing methods for calculating radar installation angles, the installation angle error is relatively large due to the target line not being parallel to the longitudinal centerline of the vehicle body, which affects the accuracy of radar data.
By acquiring the radar tracking coordinates and camera tracking coordinates of the target in different time frames, filtering and error compensation are performed. The stability of the camera tracking coordinates is utilized to construct a camera distance error compensation function to correct the radar installation angle.
It improves the accuracy of radar installation angle determination, reduces errors, and enhances the accuracy and versatility of radar data.
Smart Images

Figure CN115128557B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of intelligent vehicle management at intersections, and in particular to a method and system for determining an installation angle of an intersection radar based on error compensation. Background Art
[0002] As the number of cars in cities continues to increase, road conditions are becoming more complex, especially at various intersections where vehicles, non-motor vehicles, pedestrians, etc. gather together. Therefore, radars are usually combined with cameras to track and detect vehicle targets at multiple intersections. In order to better combine the data of target points collected by the radar with the data of target points collected by the camera, strict requirements are placed on the installation angle of the radar.
[0003] At present, when obtaining the radar installation angle, two targets are usually placed on the left and right sides of the car, separated by a certain distance, and the line connecting the two targets is parallel to the longitudinal axis of the car. Then, the distance and angle measured by the radar on one side are output to determine the angle between the longitudinal axis of the car and the normal direction of the radar, and then the actual installation angle of the radar is obtained. However, since the calculation result of the installation angle depends on the line connecting the two targets being parallel to the longitudinal axis of the car, if the line connecting the two targets is not strictly parallel to the longitudinal center axis of the car body, it will lead to errors in the calculation results, resulting in large errors in the obtained radar installation angle. Summary of the invention
[0004] In order to solve the above technical problems, the present invention provides a method and system for determining the installation angle of an intersection radar based on error compensation, which can solve the problem of large errors in the existing radar installation angles.
[0005] To achieve the above object, on the one hand, the present invention provides a method for determining the installation angle of a road intersection radar based on error compensation, the method comprising:
[0006] Obtain the radar tracking coordinates and camera tracking coordinates corresponding to the target at different time frames;
[0007] Screening the camera tracking coordinates corresponding to the target in different time frames to obtain the real camera tracking coordinates;
[0008] According to the real camera tracking coordinates and the camera tracking coordinates of the previous preset frame, obtaining the camera tracking coordinates of the corresponding frame after filtering;
[0009] According to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame, obtaining the filtered camera coordinate error corresponding to the target;
[0010] Obtaining a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target;
[0011] According to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target in different time frames, the corrected real camera coordinates corresponding to the target are obtained, and according to the radar tracking coordinates corresponding to the target in different time frames and the corrected real camera coordinates corresponding to the target, the radar installation inclination angle is obtained.
[0012] Furthermore, the step of obtaining the filtered camera coordinate error corresponding to the target according to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame includes:
[0013] The difference between the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame is used as the filtered camera coordinate error corresponding to the target.
[0014] Furthermore, the step of obtaining a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target comprises:
[0015] A quadratic function curve fitting is performed on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target to obtain a camera distance error compensation function corresponding to the target.
[0016] Furthermore, the step of performing quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target to obtain the camera distance error compensation function corresponding to the target includes:
[0017] Constructing an error compensation quadratic function of the camera coordinate error changing with the camera tracking coordinates of the corresponding frame;
[0018] Obtaining a constant value of the error compensation quadratic function according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target;
[0019] A camera distance error compensation function corresponding to the target is obtained according to a constant value of the error compensation quadratic function.
[0020] Furthermore, the step of obtaining the corrected real camera coordinates corresponding to the target according to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target at different time frames includes:
[0021] According to the constant value of the camera distance error compensation quadratic function and the camera tracking coordinates corresponding to the target in different time frames, the corrected real camera coordinates corresponding to the target are obtained.
[0022] On the other hand, the present invention provides a system for determining an intersection radar installation angle based on error compensation, the system comprising:
[0023] An acquisition unit, used for acquiring radar tracking coordinates and camera tracking coordinates corresponding to the target in different time frames;
[0024] A screening unit, used for screening the camera tracking coordinates corresponding to the target in different time frames to obtain real camera tracking coordinates;
[0025] The acquisition unit is further used to acquire the camera tracking coordinates of the filtered corresponding frame according to the real camera tracking coordinates and the camera tracking coordinates of the previous preset frame;
[0026] The acquisition unit is further used to acquire the filtered camera coordinate error corresponding to the target according to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame;
[0027] The acquisition unit is further used to acquire a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target;
[0028] The acquisition unit is further used to acquire the corrected real camera coordinates corresponding to the target according to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target in different time frames, and to acquire the radar installation inclination angle according to the radar tracking coordinates corresponding to the target in different time frames and the corrected real camera coordinates corresponding to the target.
[0029] Furthermore, the acquisition unit is specifically configured to use the difference between the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame as the filtered camera coordinate error corresponding to the target.
[0030] Furthermore, the acquisition unit is specifically used to perform quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target, so as to acquire the camera distance error compensation function corresponding to the target.
[0031] Furthermore, the acquisition unit is specifically used to construct an error compensation quadratic function in which the camera coordinate error changes with the camera tracking coordinates of the corresponding frame; obtain a constant value of the error compensation quadratic function according to the camera tracking coordinates of the filtered corresponding frame corresponding to the target and the filtered camera coordinate error corresponding to the target; and obtain a camera distance error compensation function corresponding to the target according to the constant value of the error compensation quadratic function.
[0032] Furthermore, the acquisition unit is specifically used to acquire the corrected real camera coordinates corresponding to the target according to the constant value of the camera distance error compensation quadratic function and the camera tracking coordinates corresponding to the target in different time frames.
[0033] The present invention provides a method and system for determining the installation angle of an intersection radar based on error compensation. The method and system perform camera distance error compensation on camera tracking coordinates corresponding to the target in different time frames, and filter the installation angles obtained according to the compensated radar tracking coordinates and camera tracking coordinates corresponding to the different time frames, thereby realizing a radar installation angle determination method based on multi-dimensional compensation measures, which can improve the accuracy of determining the installation angle. At the same time, the present invention utilizes the advantage that the tracking target trajectory of the camera is stable and normal and is not affected by the deflection of the equipment. The camera coordinates are used as the standard quantity as the corrected coordinates, which have higher accuracy and versatility. At the same time, the camera coordinates are compensated using the least squares method to further improve the radar installation accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] Figure 1 It is a flow chart of a method for determining the installation angle of a road intersection radar based on error compensation provided by the present invention;
[0035] Figure 2 It is a structural schematic diagram of a system for determining the installation angle of a road intersection radar based on error compensation provided by the present invention;
[0036] Figure 3 This is a schematic diagram of a single intersection coordinate system provided by the present invention. DETAILED DESCRIPTION
[0037] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments.
[0038] like Figure 1 As shown, a method for determining an intersection radar installation angle based on error compensation provided by an embodiment of the present invention includes the following steps:
[0039] 101. Obtain the radar tracking coordinates and camera tracking coordinates corresponding to the target in different time frames.
[0040] For example, taking a single intersection as an example, Figure 3As shown, the origin o of the coordinate system is the position of the radar vision integrated device, x1oy1 is the corrected coordinate system, and the actual scene is in the skewed coordinate system of x1'oy1'. Specifically, there should be fewer road vehicles in the calibration scene; at the same time, a clear marker should be placed every 3 meters on the roadside until the farthest point of the calibration area; the calibration target is a vehicle that goes straight from near to far. Assuming that it takes N frames for the target to go straight from near to far, the same target can be determined by manually screening the radar target id, position, number and camera target id, position, number, thereby obtaining the radar tracking coordinates r of the same target. x 、r y and camera tracking coordinates Radar tracking x-coordinate: r x =[r x1 , r x2 , ..., r xi , ..., r xN ], i represents the i-th frame, y coordinate: r y =[r y1 , r y2 , ..., r yi , ..., r yN ], the camera tracks the x coordinate: y coordinate:
[0041] 102. Screen the camera tracking coordinates corresponding to the target in different time frames to obtain real camera tracking coordinates.
[0042] For the embodiment of the present invention, step 102 may be specifically as follows but is not limited thereto, including: firstly, selecting the coordinates within the calibration area; Less than Ymax meters, the farthest distance of the camera calibration point, the number of frames determined by the on-site calibration, assuming that the total number of frames that meet the screening conditions is n0, the corresponding measurement camera x coordinate is obtained and Then observe the actual position of the camera in the first n0 frames of the video, and filter out the moments when the target reaches the markers: if a target in a certain frame reaches the lth marker, the horizontal and vertical coordinates of the target in this frame are C yl =3l, C xl =c xl The target vertical coordinate is C′ y =[C ym , ..., Cy l, ..., C yn ], the horizontal coordinate is C′ x =[C xm , ..., C xl , ..., C xn ]: Cxm C ym is the horizontal and vertical coordinates of the mth frame when the target reaches the first landmark; C xl C yl is the horizontal and vertical coordinates of the Lth frame when the target reaches the intermediate marker; C xn C yn It is the horizontal and vertical coordinates of the nth frame when the target reaches the last landmark.
[0043] 103. Obtain the camera tracking coordinates of the filtered corresponding frame according to the real camera tracking coordinates and the camera tracking coordinates of the previous preset frame.
[0044] For the embodiment of the present invention, step 103 may specifically include: the selected real camera tracking coordinates C′ x , C′ y and the coordinates of the first n0 frames in the calibration area It can be known that the corresponding frame number of each marker passed by the target, from which the measurement camera tracking coordinate c′ of the corresponding frame can be obtained x =[c xm , ..., c xl , ..., c xn ], c′ y =[c ym , ..., c yl , ..., c yn ].
[0045] 104. Obtain a filtered camera coordinate error corresponding to the target according to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame.
[0046] For the embodiment of the present invention, step 104 may specifically include: taking the difference between the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame as the filtered camera coordinate error corresponding to the target.
[0047] Specifically, for example, the obtained filtered measurement camera tracking coordinates c' x 、c' y and the filtered real camera tracking coordinates C′ x , C′ y , calculate the camera coordinate error Δc of the target after screening x =[Δc xm , ..., Δc xl , ..., Δc xn ] and Δc y =[Δc ym , ..., Δc yl , ..., Δc yn ],
[0048] 105. Obtain a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target.
[0049] For the embodiment of the present invention, step 105 may specifically include: performing quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target, and obtaining the camera distance error compensation function corresponding to the target. The step of performing quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target, and obtaining the camera distance error compensation function corresponding to the target includes: constructing an error compensation quadratic function in which the camera coordinate error changes with the camera tracking coordinates of the corresponding frame; obtaining a constant value of the error compensation quadratic function according to the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target; and obtaining the camera distance error compensation function corresponding to the target according to the constant value of the error compensation quadratic function.
[0050] Specifically, for example, the coordinate c' is tracked by the screened measurement camera x 、c' y and the camera coordinate error Δc′ of a specific frame x , Δc′ y , let the specific frame number be n s , the least square method is used to compensate the distance. First, calculate Δc′ x , Δc′ y With the measured value c' x 、c' y The variation function f x and f y , where f x is the camera x-coordinate error as a function of the measured x-coordinate, f y is the function of the camera y coordinate error changing with the measured y coordinate, and is fitted with a quadratic function curve. Let f = a0 + a1*x + a2*x 2 , calculate f x When Δc′ x Take the absolute value to get Δc′ x_abs =[|Δc xm |, ..., |Δc xl |, ..., |Δc xn |], Δc′ x_abs Substituting f into c′ x =[c xm , ..., c xl, ..., c xn ] as x, the left formula can be written as:
[0051]
[0052] Then calculate the determinant of the matrix:
[0053]
[0054]
[0055]
[0056] You can get the expression of function f and assign a0, a1, and a2 to a x0 、a x1 、a x2 : f x =a x0 +a x1 *x+a x2 *x 2 Calculate f y When Δc′ y Take the absolute value to get Δc′ y_abs =[|Δ cym |, ..., |Δc yl |, ..., |Δc yn |], Δc′ y_abs Substituting f into c′ y =[c ym , ..., c yl , ..., c yn ] as x, the formula is the same, calculate the corresponding a0, a1, a2, and you can get f y The expression of the function assigns a0, a1, and a2 to a y0 、a y1 、a y2 :f y =a y0 +a y1 *x+a y2 *x 2 .
[0057] 106. Obtain the corrected real camera coordinates corresponding to the target according to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target at different time frames, and obtain the radar installation inclination angle according to the radar tracking coordinates corresponding to the target at different time frames and the corrected real camera coordinates corresponding to the target.
[0058] For the embodiment of the present invention, step 106 may specifically include: acquiring the corrected real camera coordinates corresponding to the target according to the constant value of the camera distance error compensation quadratic function and the camera tracking coordinates corresponding to the target in different time frames.
[0059] Specifically, for example, the error function f x 、f y and measure camera tracking coordinates Calculate the corrected real camera coordinates C x =[C x1 , C x2 , ..., C xi , ..., C xN ] and C y =[C y1 , C y2 , ..., C yi , ..., C yN ], Then the radar tracks the coordinates r x 、r y , the coordinates are the measured values under the inclined coordinates, and the corrected camera coordinates C x , C y , at this time the coordinates are the values under the correction coordinates, calculate the inclination angle θ of the installed radar: let the inclination angle vector be θ'=[θ1,θ2,...,θ i ,θ N ],θ i Calculate the tilt angle for the i-th frame: Then perform mean filtering on the tilt angle vector to obtain the final tilt angle.
[0060] An embodiment of the present invention provides a method for determining the installation angle of an intersection radar based on error compensation. The method performs camera distance error compensation on the camera tracking coordinates corresponding to the target in different time frames, and filters the installation angles obtained according to the compensated radar tracking coordinates and camera tracking coordinates corresponding to the different time frames, thereby realizing a method for determining the radar installation angle based on multi-dimensional compensation measures, which can improve the accuracy of determining the installation angle. At the same time, the present invention utilizes the advantage that the tracking target trajectory of the camera is stable and normal and is not affected by the deflection of the equipment, and uses the camera coordinates as the standard quantity as the corrected coordinates, which has higher accuracy and versatility. At the same time, the camera coordinates are compensated using the least squares method to further improve the radar installation accuracy.
[0061] To implement the method provided by the embodiment of the present invention, the embodiment of the present invention provides a system for determining the installation angle of a road intersection radar based on error compensation, such as Figure 2 As shown, the system includes: an acquisition unit 21, a screening unit 22;
[0062] The acquisition unit 21 is used to acquire the radar tracking coordinates and the camera tracking coordinates corresponding to the target in different time frames.
[0063] The screening unit 22 is used to screen the camera tracking coordinates corresponding to the target in different time frames to obtain real camera tracking coordinates.
[0064] The acquisition unit 21 is further configured to acquire the camera tracking coordinates of the filtered corresponding frame according to the real camera tracking coordinates and the camera tracking coordinates of the previous preset frame.
[0065] The acquisition unit 21 is further used to acquire the filtered camera coordinate error corresponding to the target according to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame.
[0066] The acquisition unit 21 is further used to acquire a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target.
[0067] The acquisition unit 21 is further used to acquire the corrected real camera coordinates corresponding to the target according to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target at different time frames, and to acquire the radar installation inclination angle according to the radar tracking coordinates corresponding to the target at different time frames and the corrected real camera coordinates corresponding to the target.
[0068] Furthermore, the acquisition unit 21 is specifically configured to use the difference between the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame as the filtered camera coordinate error corresponding to the target.
[0069] Furthermore, the acquisition unit 21 is further specifically used to perform quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target, so as to acquire the camera distance error compensation function corresponding to the target.
[0070] Furthermore, the acquisition unit 21 is specifically used to construct an error compensation quadratic function in which the camera coordinate error changes with the camera tracking coordinates of the corresponding frame; obtain a constant value of the error compensation quadratic function according to the camera tracking coordinates of the filtered corresponding frame corresponding to the target and the filtered camera coordinate error corresponding to the target; and obtain a camera distance error compensation function corresponding to the target according to the constant value of the error compensation quadratic function.
[0071] Furthermore, the acquisition unit 21 is further specifically configured to acquire the corrected real camera coordinates corresponding to the target according to the constant value of the camera distance error compensation quadratic function and the camera tracking coordinates corresponding to the target in different time frames.
[0072] An embodiment of the present invention provides a system for determining the installation angle of an intersection radar based on error compensation. The system performs camera distance error compensation on the camera tracking coordinates corresponding to the target in different time frames, and filters the installation angles obtained according to the compensated radar tracking coordinates and camera tracking coordinates corresponding to the different time frames, thereby realizing a radar installation angle determination method based on multi-dimensional compensation measures, which can improve the accuracy of determining the installation angle. At the same time, the present invention utilizes the advantage that the camera's tracking target trajectory is stable and normal and is not affected by the deflection of the equipment, and uses the camera coordinates as the standard quantity as the corrected coordinates, which has higher accuracy and versatility. At the same time, the camera coordinates are compensated using the least squares method to further improve the radar installation accuracy.
[0073] It should be understood that the specific order or hierarchy of steps in the disclosed process is an example of an exemplary method. Based on design preferences, it should be understood that the specific order or hierarchy of steps in the process can be rearranged without departing from the scope of protection of the present disclosure. The attached method claims present the elements of the various steps in an exemplary order and are not intended to be limited to the specific order or hierarchy described.
[0074] In the above detailed description, various features are grouped together in a single embodiment to simplify the disclosure. This method of disclosure should not be interpreted as reflecting an intention that the embodiments of the claimed subject matter require more features than are clearly stated in each claim. On the contrary, as reflected in the appended claims, the invention is in a state of having less than all the features of the disclosed individual embodiments. Therefore, the appended claims are hereby expressly incorporated into the detailed description, with each claim standing on its own as a separate preferred embodiment of the invention.
[0075] The disclosed embodiments are described above to enable any person skilled in the art to implement or use the present invention. Various modifications of these embodiments are obvious to those skilled in the art, and the general principles defined herein may also be applied to other embodiments without departing from the spirit and scope of the present disclosure. Therefore, the present disclosure is not limited to the embodiments given herein, but is consistent with the broadest scope of the principles and novel features disclosed in this application.
[0076] The above description includes examples of one or more embodiments. Of course, it is impossible to describe all possible combinations of components or methods for the purpose of describing the above embodiments, but it should be recognized by those skilled in the art that the various embodiments may be further combined and arranged. Therefore, the embodiments described herein are intended to cover all such changes, modifications and variations that fall within the scope of protection of the appended claims. In addition, with respect to the term "comprising" used in the specification or claims, the word is covered in a manner similar to the term "including", just as "including," is explained as a transitional word in the claims. In addition, any term "or" used in the specification of the claims is intended to mean "non-exclusive or".
[0077] Those skilled in the art may also understand that the various illustrative logical blocks, units, and steps listed in the embodiments of the present invention may be implemented by electronic hardware, computer software, or a combination of the two. In order to clearly demonstrate the interchangeability of hardware and software, the various illustrative components, units, and steps described above have generally described their functions. Whether such functions are implemented by hardware or software depends on the specific application and the design requirements of the entire system. Those skilled in the art may use various methods to implement the described functions for each specific application, but such implementation should not be understood as exceeding the scope of protection of the embodiments of the present invention.
[0078] The various illustrative logic blocks or units described in the embodiments of the present invention can be implemented or operated by a general-purpose processor, a digital signal processor, an application-specific integrated circuit (ASIC), a field programmable gate array or other programmable logic system, a discrete gate or transistor logic, a discrete hardware component, or any combination of the above. The general-purpose processor can be a microprocessor, and optionally, the general-purpose processor can also be any conventional processor, controller, microcontroller or state machine. The processor can also be implemented by a combination of computing systems, such as a digital signal processor and a microprocessor, a plurality of microprocessors, one or more microprocessors combined with a digital signal processor core, or any other similar configuration.
[0079] The steps of the method or algorithm described in the embodiments of the present invention can be directly embedded in hardware, a software module executed by a processor, or a combination of the two. The software module can be stored in a RAM memory, a flash memory, a ROM memory, an EPROM memory, an EEPROM memory, a register, a hard disk, a removable disk, a CD-ROM or other storage media of any form in the art. Exemplarily, the storage medium can be connected to the processor so that the processor can read information from the storage medium and can write information to the storage medium. Optionally, the storage medium can also be integrated into the processor. The processor and the storage medium can be arranged in an ASIC, and the ASIC can be arranged in a user terminal. Optionally, the processor and the storage medium can also be arranged in different components in the user terminal.
[0080] In one or more exemplary designs, the above functions described in the embodiments of the present invention can be implemented in hardware, software, firmware or any combination of the three. If implemented in software, these functions can be stored on a computer-readable medium, or transmitted in the form of one or more instructions or codes on a computer-readable medium. Computer-readable media include computer storage media and communication media that facilitate the transfer of computer programs from one place to another. The storage medium can be any available medium that can be accessed by any general or special computer. For example, such computer-readable media can include but are not limited to RAM, ROM, EEPROM, CD-ROM or other optical disk storage, disk storage or other magnetic storage systems, or any other medium that can be used to carry or store program codes in the form of instructions or data structures and other forms that can be read by general or special computers, or general or special processors. In addition, any connection can be appropriately defined as a computer-readable medium, for example, if the software is transmitted from a website site, server or other remote resource through a coaxial cable, fiber optic cable, twisted pair, digital subscriber line (DSL) or wirelessly, such as infrared, wireless and microwave, it is also included in the defined computer-readable medium. The disk and disc include compact disk, laser disk, optical disk, DVD, floppy disk and Blu-ray disk. Disks usually reproduce data magnetically, while discs usually reproduce data optically with lasers. Combinations of the above may also be included in computer readable media.
[0081] The specific implementation methods described above further illustrate the objectives, technical solutions and beneficial effects of the present invention in detail. It should be understood that the above description is only a specific implementation method of the present invention and is not intended to limit the scope of protection of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of protection of the present invention.
Claims
1. A method for determining the installation angle of a road intersection radar based on error compensation, characterized in that: The method comprises: Obtain the radar tracking coordinates and camera tracking coordinates corresponding to the target at different time frames; Screening the camera tracking coordinates corresponding to the target in different time frames to obtain the real camera tracking coordinates; According to the real camera tracking coordinates and the camera tracking coordinates of the previous preset frame, obtaining the camera tracking coordinates of the corresponding frame after filtering; According to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame, obtaining the filtered camera coordinate error corresponding to the target; Obtaining a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target; According to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target in different time frames, the corrected real camera coordinates corresponding to the target are obtained, and according to the radar tracking coordinates corresponding to the target in different time frames and the corrected real camera coordinates corresponding to the target, the radar installation inclination angle is obtained.
2. The method for determining the installation angle of a road intersection radar based on error compensation according to claim 1, characterized in that: The step of obtaining the filtered camera coordinate error corresponding to the target according to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame comprises: The difference between the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame is used as the filtered camera coordinate error corresponding to the target.
3. The method for determining the installation angle of a road intersection radar based on error compensation according to claim 1, characterized in that: The step of obtaining a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target comprises: A quadratic function curve fitting is performed on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target to obtain a camera distance error compensation function corresponding to the target.
4. The method for determining the installation angle of a road intersection radar based on error compensation according to claim 3, characterized in that: The step of performing quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target to obtain the camera distance error compensation function corresponding to the target comprises: Constructing an error compensation quadratic function of the camera coordinate error changing with the camera tracking coordinates of the corresponding frame; Obtaining a constant value of the error compensation quadratic function according to the camera tracking coordinates of the corresponding frame after filtering corresponding to the target and the camera coordinate error after filtering corresponding to the target; A camera distance error compensation function corresponding to the target is obtained according to a constant value of the error compensation quadratic function.
5. The method for determining the installation angle of a road intersection radar based on error compensation according to claim 4, characterized in that: The step of obtaining the corrected real camera coordinates corresponding to the target according to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target in different time frames comprises: According to the constant value of the camera distance error compensation quadratic function and the camera tracking coordinates corresponding to the target in different time frames, the corrected real camera coordinates corresponding to the target are obtained.
6. A system for determining the installation angle of a road intersection radar based on error compensation, characterized in that: The system comprises: An acquisition unit, used for acquiring radar tracking coordinates and camera tracking coordinates corresponding to the target in different time frames; A screening unit, used for screening the camera tracking coordinates corresponding to the target in different time frames to obtain real camera tracking coordinates; The acquisition unit is further used to acquire the camera tracking coordinates of the filtered corresponding frame according to the real camera tracking coordinates and the camera tracking coordinates of the previous preset frame; The acquisition unit is further used to acquire the filtered camera coordinate error corresponding to the target according to the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame; The acquisition unit is further used to acquire a camera distance error compensation function corresponding to the target according to the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target; The acquisition unit is further used to acquire the corrected real camera coordinates corresponding to the target according to the camera distance error compensation function corresponding to the target and the camera tracking coordinates corresponding to the target in different time frames, and to acquire the radar installation inclination angle according to the radar tracking coordinates corresponding to the target in different time frames and the corrected real camera coordinates corresponding to the target.
7. The intersection radar installation angle determination system based on error compensation according to claim 6, characterized in that: The acquisition unit is specifically used to use the difference between the filtered real camera tracking coordinates and the filtered camera tracking coordinates of the corresponding frame as the filtered camera coordinate error corresponding to the target.
8. The intersection radar installation angle determination system based on error compensation according to claim 6, characterized in that: The acquisition unit is further specifically used to perform quadratic function curve fitting on the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target, so as to acquire the camera distance error compensation function corresponding to the target.
9. The intersection radar installation angle determination system based on error compensation according to claim 7, characterized in that: The acquisition unit is further configured to construct an error compensation quadratic function in which the camera coordinate error changes with the camera tracking coordinates of the corresponding frame; and obtain a constant value of the error compensation quadratic function according to the camera tracking coordinates of the corresponding frame after screening corresponding to the target and the camera coordinate error after screening corresponding to the target; A camera distance error compensation function corresponding to the target is obtained according to a constant value of the error compensation quadratic function.
10. The intersection radar installation angle determination system based on error compensation according to claim 9, characterized in that: The acquisition unit is further specifically used to acquire the corrected real camera coordinates corresponding to the target according to the constant value of the camera distance error compensation quadratic function and the camera tracking coordinates corresponding to the target in different time frames.
Citation Information
Patent Citations
Angle calibration method, device and system for automobile millimeter-wave radar and storage medium
CN111679256A
Radar data accuracy judgment method and device and computer equipment
CN112255604A
Radar data and camera data fusion method and system
CN114488123A
Misalignment estimation for a vehicle radar system
EP3104189A1
Apparatus for correcting error of radar sensor for vehicle and method thereof
US20210132216A1
