Method and system for calibrating a conversion relationship between two roadside sensors
By performing time alignment and trajectory matching of roadside sensors and calculating the one-strain transformation matrix, the problems of low calibration efficiency, high cost and safety risks in the prior art are solved, and low-cost and efficient roadside sensor coordinate conversion is achieved.
Patent Information
- Application Number
- CN202411228161.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-03
- Publication Date
- 2025-09-02
- Estimated Expiration
- 2044-09-03
AI Technical Summary
The prior art has low efficiency, high cost and safety risks when calibrating roadside sensors, especially the need for road closure or relying on high-precision maps or expensive equipment.
By timely aligning the first and second roadside sensors, target tracking is performed separately, trajectory sets are obtained, matching trajectories are sampled, single-strain transformation matrix is calculated, and the final matrix is determined through distance judgment, so as to realize coordinate conversion between different roadside sensors.
It realizes more accurate and low-cost coordinate conversion between roadside sensors, simplifies the calibration process, reduces dependence on road closures and expensive equipment, and improves calibration efficiency.
Smart Images

Figure CN119399288B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of roadside sensor calibration, and in particular to a method and system for calibrating a conversion relationship between two roadside sensors. Background Art
[0002] Roadside sensors are used to detect information about traffic participants on the road. They need to provide accurate location information for traffic participants and are a crucial component of vehicle-road collaboration and digital twin systems. The current technical solutions for calibrating different roadside sensors are as follows:
[0003] 1) The invention patent, publication number "CN111383285A," titled "A Method and System for Calibration Based on Millimeter-Wave Radar and Camera Sensor Fusion," requires manual calibration, such as requiring an engineer to walk a straight line through different areas of the scene with a handheld corner reflector. Collecting data at urban intersections or highways poses a risk. If road closures require approval from traffic control authorities, not only does this disrupt normal traffic flow, but replacing roadside sensors also requires additional road closures, which is inefficient.
[0004] 2) The invention patent with publication number "CN112558023A" and subject name "Sensor calibration method and device" proposes a method that does not require road closures. Specifically, the mapping relationship between sensors is established through high-precision maps. However, there are often no high-precision maps for reference on actual roads.
[0005] 3) The invention patent with publication number "CN112836737A" and subject name "A method for online calibration of roadside combined perception equipment based on vehicle-road data fusion", as well as the invention patent with publication number "WO2022206978A1" and subject name "A method for calibration of roadside millimeter-wave radar based on vehicle-mounted positioning device", both propose technical solutions for calculating sensor mapping relationships by providing calibration target data through vehicle-mounted high-precision positioning equipment, but require relatively expensive professional equipment to record and feedback data in real time, and also require the vehicle equipped with the positioning equipment to drive multiple times within the detection range to complete the calibration. Summary of the Invention
[0006] The technical problem to be solved by the present invention is to address the deficiencies of the existing technology and specifically provide a method and system for calibrating the conversion relationship between two roadside sensors, as follows:
[0007] 1) In a first aspect, the present invention provides a method for calibrating a conversion relationship between two roadside sensors. The specific technical solution is as follows:
[0008] After time alignment of the first preset roadside sensor and the second preset roadside sensor, the first preset roadside sensor and the second preset roadside sensor are used to track a target in the same preset area, thereby obtaining a first trajectory set corresponding to the first preset roadside sensor and a second trajectory set corresponding to the second preset roadside sensor;
[0009] Sampling is performed from the first trajectory set and the second trajectory set respectively, wherein the target corresponding to the trajectory sampled from the first trajectory set is the same as the target corresponding to the trajectory sampled from the second trajectory set;
[0010] Determine the current homography transformation matrix based on multiple trajectories obtained from the current sampling;
[0011] Calculate, based on the current homography transformation matrix, a third trajectory set of all unsampled trajectories in the second trajectory set in a coordinate system used by the first preset roadside sensor;
[0012] Calculating an average distance between the first trajectory set and the third trajectory set, and determining whether the average distance is less than a preset distance threshold to obtain a determination result;
[0013] When the judgment result is yes, the current homography transformation matrix is determined as the final homography transformation matrix.
[0014] The beneficial effects of the method for calibrating the conversion relationship between two roadside sensors provided by the present invention are as follows:
[0015] The target position coordinates obtained by any roadside sensor are the coordinates of the coordinate system used by that roadside sensor. In practical applications, the target position coordinates obtained by different roadside sensors need to be converted. Since the conversion between the target position coordinates obtained by any two roadside sensors requires the use of the homography transformation matrix corresponding to the two roadside sensors, the accuracy of the homography transformation matrix determines whether the position coordinate conversion is accurate. The present invention can obtain a more accurate homography transformation matrix based on distance judgment. The homography transformation matrix acquisition process is simpler and less costly than existing technologies (for example, invention patents with publication number "CN112836737A" and title "A Method for Online Calibration of Roadside Combined Perception Device Based on Vehicle-Road Data Fusion" and invention patent publication number "WO2022206978A1" and title "A Method for Calibrating Roadside Millimeter-Wave Radar Based on a Vehicle-Mounted Positioning Device"). Using the homography transformation matrix, precise conversion of position coordinates in different coordinate systems (the coordinate systems used by different roadside sensors) can be achieved.
[0016] Based on the above solution, the method for calibrating the conversion relationship between two roadside sensors of the present invention can be further improved as follows.
[0017] Furthermore, it also includes:
[0018] When the judgment result is no, sampling is performed again from the first trajectory set and the second trajectory set respectively.
[0019] Furthermore, sampling is performed from the first trajectory set and the second trajectory set respectively, including:
[0020] The trajectories of two targets are obtained by random sampling from the first trajectory set, and the trajectories of two targets are selected from the second trajectory set.
[0021] Furthermore, the first preset roadside sensor is a camera device, and the second preset roadside sensor is a radar, or the first preset roadside sensor is a radar, and the second preset roadside sensor is a camera device.
[0022] 2) In a second aspect, the present invention further provides a system for calibrating the conversion relationship between two roadside sensors. The specific technical solution is as follows:
[0023] It includes a trajectory set acquisition module, a sampling module, a homography transformation matrix calculation module, a trajectory transformation module, a calculation and judgment module and a homography transformation matrix determination module;
[0024] The trajectory set acquisition module is configured to: after time alignment of a first preset roadside sensor and a second preset roadside sensor, respectively use the first preset roadside sensor and the second preset roadside sensor to track a target in the same preset area, thereby obtaining a first trajectory set corresponding to the first preset roadside sensor and a second trajectory set corresponding to the second preset roadside sensor;
[0025] The sampling module is used to: sample from the first trajectory set and the second trajectory set respectively, and the target corresponding to the trajectory sampled from the first trajectory set is the same as the target corresponding to the trajectory sampled from the second trajectory set;
[0026] The homography transformation matrix calculation module is used to: determine the current homography transformation matrix based on multiple trajectories obtained from the current sampling;
[0027] The trajectory transformation module is used to calculate a third trajectory set of all unsampled trajectories in the second trajectory set in a coordinate system used by the first preset roadside sensor according to the current homography transformation matrix;
[0028] The calculation and judgment module is used to: calculate the average distance between the first trajectory set and the third trajectory set, and determine whether the average distance is less than a preset distance threshold to obtain a judgment result;
[0029] The homography transformation matrix determination module is used to: when the judgment result is yes, determine the current homography transformation matrix as the final homography transformation matrix.
[0030] Based on the above solution, the system for calibrating the conversion relationship between two roadside sensors of the present invention can be further improved as follows.
[0031] Furthermore, the method further includes a calling module, which is used to: when the judgment result is negative, call the sampling module to resample from the first trajectory set and the second trajectory set respectively.
[0032] Furthermore, the sampling module is specifically configured to: randomly sample from the first trajectory set to obtain the trajectories of the two targets, and select the trajectories of the two targets from the second trajectory set.
[0033] Furthermore, the first preset roadside sensor is a camera device, and the second preset roadside sensor is a radar, or the first preset roadside sensor is a radar, and the second preset roadside sensor is a camera device.
[0034] 3) In a third aspect, the present invention also provides an electronic device, which includes a processor, the processor is coupled to a memory, and the memory stores at least one computer program, and the at least one computer program is loaded and executed by the processor so that the electronic device implements any of the above-mentioned methods for calibrating the conversion relationship between two roadside sensors.
[0035] 4) In a fourth aspect, the present invention further provides a computer-readable storage medium, in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor so that the computer implements any of the above-mentioned methods for calibrating the conversion relationship between two roadside sensors.
[0036] It should be noted that the beneficial effects achieved by the technical solutions of the second to fourth aspects of the present invention and the corresponding possible implementation methods can be found in the above-mentioned technical effects of the first aspect and its corresponding possible implementation methods, and will not be repeated here. BRIEF DESCRIPTION OF THE DRAWINGS
[0037] Other features, objects and advantages of the present invention will become more apparent upon reading the detailed description of non-limiting embodiments made with reference to the following drawings:
[0038] Figure 1 A schematic flow chart of a method for calibrating a conversion relationship between two roadside sensors according to an embodiment of the present invention;
[0039] Figure 2 Schematic diagram of the structure of a system for calibrating a conversion relationship between two roadside sensors according to an embodiment of the present invention;
[0040] Figure 3 The figure is a schematic structural diagram of an electronic system according to an embodiment of the present invention. DETAILED DESCRIPTION
[0041] To make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be described in further detail below with reference to the accompanying drawings.
[0042] like Figure 1 As shown, a method for calibrating a conversion relationship between two roadside sensors according to an embodiment of the present invention includes the following steps:
[0043] S1. After time alignment of a first preset roadside sensor and a second preset roadside sensor, track a target in the same preset area using the first preset roadside sensor and the second preset roadside sensor, respectively, to obtain a first trajectory set corresponding to the first preset roadside sensor and a second trajectory set corresponding to the second preset roadside sensor;
[0044] Among them, the preset area can be set according to actual conditions, such as a designated road area.
[0045] Among them, the first trajectory set corresponding to the first preset roadside sensor includes: the trajectory of each target obtained after the first preset roadside sensor tracks the target in the preset area, and the trajectory of each target in the first trajectory set is generated in the coordinate system used by the first preset roadside sensor. The coordinate system used by the first preset roadside sensor can be established according to actual conditions.
[0046] Among them, the second trajectory set corresponding to the second preset roadside sensor includes: the trajectory of each target obtained after the second preset roadside sensor tracks the target in the preset area, and the trajectory of each target in the second trajectory set is generated in the coordinate system used by the second preset roadside sensor. The coordinate system used by the second preset roadside sensor can be established according to actual conditions.
[0047] S2. Sampling is performed from the first trajectory set and the second trajectory set respectively. The target corresponding to the trajectory sampled from the first trajectory set is the same as the target corresponding to the trajectory sampled from the second trajectory set. Specifically:
[0048] For example, two target trajectories are obtained by random sampling from the first trajectory set, and the trajectories of the two targets are selected from the second trajectory set.
[0049] The number of target trajectories obtained by random sampling from the first trajectory set can be set according to actual conditions.
[0050] S3, determining the current homography transformation matrix based on the multiple trajectories obtained from the current sampling;
[0051] S4. Calculate, based on the current homography transformation matrix, a third trajectory set of all unsampled trajectories in the second trajectory set in the coordinate system used by the first preset roadside sensor;
[0052] S5. Calculate the average distance between the first trajectory set and the third trajectory set, and determine whether the average distance is less than a preset distance threshold to obtain a determination result;
[0053] S6. When the judgment result is yes, the current homography transformation matrix is determined as the final homography transformation matrix.
[0054] Optionally, in the above technical solution, the following is further included:
[0055] S7 . When the judgment result is no, resample from the first trajectory set and the second trajectory set respectively, and return to execute S3 until the judgment result is yes.
[0056] Optionally, in the above technical solution, the first preset roadside sensor is a camera device, and the second preset roadside sensor is a radar, or the first preset roadside sensor is a radar, and the second preset roadside sensor is a camera device, wherein the camera device can be a camera, and the radar can be a millimeter-wave radar, or other radars can be selected according to actual conditions.
[0057] The invention is illustrated by the following examples.
[0058] In this embodiment, the first preset roadside sensor is a camera device, and the second preset roadside sensor is a radar. A method for calibrating a conversion relationship between the two roadside sensors in an embodiment of the present invention specifically includes:
[0059] S10. First, the camera device and the radar are time-aligned. Then, the camera device is used to track the target to obtain tracking data, and the tracking data is tracked by Kalman filter. After a certain period of time (such as 1 hour), a first trajectory set P of all targets is obtained. The first trajectory set P includes: the trajectory of each target monitored by the camera device. At the same time, the radar is used to track the target to obtain tracking data. The tracking data is tracked by Kalman filter. After a certain period of time (such as 1 hour), a second trajectory set Q of all targets is obtained. The second trajectory set Q includes the trajectory of each target monitored by the radar.
[0060] Among them, the camera device and the radar track targets in the same preset area, which can be vehicles or pedestrians, etc., and can be set according to actual conditions.
[0061] S11. Sampling:
[0062] 1) Randomly sample the first trajectory set P to obtain the trajectories of two targets. The two targets are recorded as the first target and the second target. The trajectory of the first target is recorded as The trajectory of the second target is recorded as The length of is m1, Length is m2;
[0063] 2) Randomly sample the second trajectory set Q to obtain the trajectories of two targets, which are recorded as the third target and the fourth target. The trajectory of the third target is recorded as The trajectory of the fourth target is recorded as The length of is n1, The length of is n2;
[0064] It should be noted that the first goal and the third goal are the same goal, and the second goal and the fourth goal are the same goal.
[0065] S12. Get array P s and Q s :
[0066] Let k = min{m1,n1,m2,n2}, that is, k is the minimum value among m1, m2, n1 and n2, and we get the array P s and Q s :
[0067]
[0068] in, Represents: the trajectory of the first target The first position coordinate in Represents: the trajectory of the first target The second position coordinates in Represents: the trajectory of the first target The m1-k+1th position coordinate in, Represents: The trajectory of the second target The first position coordinate in Indicates: the trajectory of the second target The second position coordinate in, Represents: The trajectory of the second target The second position coordinates in Indicates: the trajectory of the second target The m2-k+1th position coordinate in, Indicates: the trajectory of the third target The first position coordinate in Indicates: the trajectory of the third target The second position coordinate in, Indicates: the trajectory of the third target The third position coordinate in, Indicates: the trajectory of the third target The n1-k+1th position coordinate in, Indicates: The trajectory of the fourth target The first position coordinate in Indicates: The trajectory of the fourth target The second position coordinate in, Indicates: The trajectory of the fourth target The third position coordinate in, Indicates: The trajectory of the fourth target The n2-k+1th position coordinate in .
[0069] S13, according to P s and Q s Able to calculate the current homography transformation matrix.
[0070] S14. Mark any position coordinate in the radar coordinate system as (x ′ ,y ′ ), (x ′ ,y ′ ) In the equation (x ′ ,y ′ ) in the coordinate system used by the camera device (u ′ ,v ′ ) until the position coordinates of each position coordinate of all unsampled trajectories in the second trajectory set in the coordinate system used by the camera device are obtained. The position coordinates of each position coordinate of each unsampled trajectory in the second trajectory set in the coordinate system used by the camera device respectively constitute a new trajectory. The set of all new trajectories is the third trajectory set, which will be recorded as Q ′ .
[0071] in, is the current homography transformation matrix, h 00 、h 01 、h 02 、h 10 、h 11 、h 12 、h 20 、h 21 and h 22 is the element in the current homography transformation matrix, and s represents the coefficient of the homogeneous coordinate.
[0072] S15. Calculate the first trajectory set P and the third trajectory set Q ′ The average distance D between them is calculated by the following formula:
[0073]
[0074] Where M represents the number of trajectories in the first trajectory set P, N represents the number of trajectories in the second trajectory set Q, and d(P i ,Q′ j )=DWT(P i ,Q′ j ), d(P i ,Q′ j ) represents the i-th trajectory P in the first trajectory set P i With the third trajectory Q ′ j trajectories Q′ in j The DWT (Dynamic Time Warping) distance between them.
[0075] S16. Determine whether the average distance D is less than a preset distance threshold th. If a determination result is obtained, then:
[0076] 1) When the judgment result is yes, the current homography transformation matrix is determined as the final homography transformation matrix, and the final homography transformation matrix is saved. At this time, the time-aligned camera device and radar are used to track the target. The position coordinates of the same target monitored at any same time in the corresponding coordinate system meet the following requirements: Among them, the position coordinates in the coordinate system used by the camera device are (u, v), and the position coordinates in the coordinate system used by the radar are (x, y), and (u, v) and (x, y) are: the position coordinates of the same target monitored by the camera device and radar after time alignment at any same time.
[0077] 2) When the judgment result is no, re-sampling is performed from the first trajectory set and the second trajectory set respectively, and the process returns to S12 until the judgment result is yes, and the final homography transformation matrix is determined.
[0078] The beneficial effects of the present invention are as follows:
[0079] The target position coordinates obtained by any roadside sensor are the coordinates of the coordinate system used by that roadside sensor. In practical applications, the target position coordinates obtained by different roadside sensors need to be converted. Since the conversion between the target position coordinates obtained by any two roadside sensors requires the use of the homography transformation matrix corresponding to the two roadside sensors, the accuracy of the homography transformation matrix determines whether the position coordinate conversion is accurate. The present invention can obtain a more accurate homography transformation matrix based on distance judgment. The homography transformation matrix acquisition process is simpler and less costly than existing technologies (for example, invention patents with publication number "CN112836737A" and title "A Method for Online Calibration of Roadside Combined Perception Device Based on Vehicle-Road Data Fusion" and invention patent publication number "WO2022206978A1" and title "A Method for Calibrating Roadside Millimeter-Wave Radar Based on a Vehicle-Mounted Positioning Device"). Using the homography transformation matrix, precise conversion of position coordinates in different coordinate systems (the coordinate systems used by different roadside sensors) can be achieved.
[0080] In the above embodiments, although the steps are numbered S1, S2, etc., these are only specific embodiments given by the present invention. Those skilled in the art may adjust the execution order of S1, S2, etc. according to actual conditions, which is also within the scope of protection of the present invention. It can be understood that in some embodiments, some or all of the above embodiments may be included.
[0081] like Figure 2 As shown, a system 200 for calibrating the conversion relationship between two roadside sensors according to an embodiment of the present invention includes a trajectory set acquisition module 201, a sampling module 202, a homography transformation matrix calculation module 203, a trajectory transformation module 204, a calculation and judgment module 205, and a homography transformation matrix determination module 206;
[0082] The trajectory set acquisition module 201 is configured to: after time alignment of a first preset roadside sensor and a second preset roadside sensor, respectively use the first preset roadside sensor and the second preset roadside sensor to track a target in the same preset area, thereby obtaining a first trajectory set corresponding to the first preset roadside sensor and a second trajectory set corresponding to the second preset roadside sensor;
[0083] The sampling module 202 is configured to: perform sampling from the first trajectory set and the second trajectory set respectively, wherein the target corresponding to the trajectory sampled from the first trajectory set is the same as the target corresponding to the trajectory sampled from the second trajectory set;
[0084] The homography transformation matrix calculation module 203 is used to: determine the current homography transformation matrix based on multiple trajectories obtained from the current sampling;
[0085] The trajectory transformation module 204 is configured to calculate a third trajectory set of all unsampled trajectories in the second trajectory set in the coordinate system used by the first preset roadside sensor according to the current homography transformation matrix;
[0086] The calculation and judgment module 205 is used to: calculate the average distance between the first trajectory set and the third trajectory set, and determine whether the average distance is less than a preset distance threshold to obtain a judgment result;
[0087] The homography transformation matrix determining module 206 is configured to: when the judgment result is yes, determine the current homography transformation matrix as the final homography transformation matrix.
[0088] Optionally, the above technical solution further includes a calling module, which is used to: when the judgment result is no, call the sampling module to re-sample from the first trajectory set and the second trajectory set respectively, and then continue the homography transformation matrix calculation module 203, the trajectory transformation module 204, the calculation and judgment module 205 and the homography transformation matrix determination module 206 until the judgment result is yes.
[0089] Optionally, in the above technical solution, the sampling module 202 is specifically configured to: randomly sample from the first trajectory set to obtain the trajectories of two targets, and select the trajectories of two targets from the second trajectory set.
[0090] It should be noted that the beneficial effects of the system 200 for calibrating the conversion relationship between two roadside sensors provided in the above embodiment are the same as the beneficial effects of the method for calibrating the conversion relationship between two roadside sensors, and will not be repeated here. In addition, when implementing its functions, the system provided in the above embodiment is only illustrated by the division of the above functional modules. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the system can be divided into different functional modules according to actual conditions to complete all or part of the functions described above. In addition, the system and method embodiments provided in the above embodiment belong to the same concept. The specific implementation process is detailed in the method embodiment and will not be repeated here.
[0091] like Figure 3 As shown, an electronic device 300 according to an embodiment of the present invention includes a processor 320, which is coupled to a memory 310. The memory 310 stores at least one computer program 330. The at least one computer program 330 is loaded and executed by the processor 320 to enable the electronic device 300 to implement any of the above-mentioned methods for calibrating a conversion relationship between two roadside sensors. Specifically:
[0092] The electronic device 300 may vary significantly due to different configurations or performance, and may include one or more processors 320 (Central Processing Units, CPUs) and one or more memories 310, wherein the one or more memories 310 store at least one computer program 330, which is loaded and executed by the one or more processors 320 to enable the electronic device 300 to implement any of the methods for calibrating the conversion relationship between two roadside sensors provided in the above embodiments. Of course, the electronic device 300 may also have components such as a wired or wireless network interface, a keyboard, and an input / output interface for input and output. The electronic device 300 may also include other components for implementing device functions, which will not be detailed here. The electronic device may specifically be a computer, etc.
[0093] The computer-readable storage medium of an embodiment of the present invention stores at least one computer program, and the at least one computer program is loaded and executed by a processor to enable the computer to implement any of the above-mentioned methods for calibrating the conversion relationship between two roadside sensors.
[0094] Alternatively, the computer-readable storage medium may be a read-only memory (ROM), a random access memory (RAM), a compact disc (CD-ROM), a magnetic tape, a floppy disk, an optical data storage device, or the like.
[0095] In an exemplary embodiment, a computer program product or computer program is also provided. The computer program product or computer program includes computer instructions stored in a computer-readable storage medium. A processor of an electronic device reads the computer instructions from the computer-readable storage medium and executes the computer instructions, causing the electronic device to perform any of the aforementioned methods for calibrating a conversion relationship between two roadside sensors.
[0096] It should be noted that the terms "first," "second," and the like in the specification and claims of this application are used to distinguish similar objects and to define a specific order or precedence. Where appropriate, the order used for similar objects may be interchanged, such that the embodiments of the present application described herein can be implemented in an order other than the order shown or described.
[0097] Those skilled in the art will appreciate that the present invention may be implemented as a system, method, or computer program product. Therefore, the present invention may be implemented in the following forms: entirely in hardware, entirely in software (including firmware, resident software, microcode, etc.), or in a combination of hardware and software, generally referred to herein as a "circuit," "module," or "system." Furthermore, in some embodiments, the present invention may be implemented in the form of a computer program product embodied in one or more computer-readable media containing computer-readable program code.
[0098] Any combination of one or more computer-readable media can be used. The computer-readable medium can be a computer-readable signal medium or a computer-readable storage medium. The computer-readable storage medium can be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or component, or any combination thereof. More specific examples of computer-readable storage media (a non-exhaustive list) include: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination thereof. In the present invention, a computer-readable storage medium can be any tangible medium containing or storing a program that can be used by or in conjunction with an instruction execution system, device or device.
[0099] Although the embodiments of the present invention have been shown and described above, it will be understood that the above embodiments are illustrative and are not to be construed as limitations on the present invention. A person skilled in the art may change, modify, replace and modify the above embodiments within the scope of the present invention.
Claims
1. A method for calibrating the conversion relationship between two roadside sensors, characterized in that: include: After time alignment of a first preset roadside sensor and a second preset roadside sensor, tracking a target in the same preset area using the first preset roadside sensor and the second preset roadside sensor, respectively, to obtain a first track set corresponding to the first preset roadside sensor and a second track set corresponding to the second preset roadside sensor; Sampling is performed from the first trajectory set and the second trajectory set respectively, where the target corresponding to the trajectory sampled from the first trajectory set is the same as the target corresponding to the trajectory sampled from the second trajectory set; Determine the current homography transformation matrix based on multiple trajectories obtained from the current sampling; Calculating, according to the current homography transformation matrix, a third trajectory set of all unsampled trajectories in the second trajectory set in the coordinate system used by the first preset roadside sensor; Any position coordinate in the coordinate system used by the first preset roadside sensor is marked as (x ′ ,y ′ ), (x ′ ,y ′ ) In the equation (x ′ ,y ′ ) in the coordinate system used by the second preset roadside sensor (u ′ ,v ′ ) until the position coordinates of each position coordinate of all unsampled trajectories in the second trajectory set in the coordinate system used by the camera device are obtained, and the position coordinates of each position coordinate of each unsampled trajectory in the second trajectory set in the coordinate system used by the first preset roadside sensor respectively constitute a new trajectory, and the set of all new trajectories is the third trajectory set; in, is the current homography transformation matrix, h 00 、h 01 、h 02 、h 10 、h 11 、h 12 、h 20 、h 21 and h 22 is the element in the current homography transformation matrix, and s represents the coefficient of the homogeneous coordinate; Calculating an average distance between the first trajectory set and the third trajectory set, and determining whether the average distance is less than a preset distance threshold to obtain a determination result; When the judgment result is yes, the current homography transformation matrix is determined as the final homography transformation matrix.
2. The method for calibrating the conversion relationship between two roadside sensors according to claim 1, characterized in that: Also includes: When the judgment result is no, sampling is performed again from the first trajectory set and the second trajectory set respectively.
3. The method for calibrating the conversion relationship between two roadside sensors according to claim 1, characterized in that: Sampling from the first trajectory set and the second trajectory set respectively includes: The trajectories of two targets are obtained by random sampling from the first trajectory set, and the trajectories of the two targets are selected from the second trajectory set.
4. A method for calibrating the conversion relationship between two roadside sensors according to claim 1 or 2, characterized in that: The first preset roadside sensor is a camera device, and the second preset roadside sensor is a radar, or the first preset roadside sensor is a radar, and the second preset roadside sensor is a camera device.
5. A system for calibrating the conversion relationship between two roadside sensors, characterized in that: It includes a trajectory set acquisition module, a sampling module, a homography transformation matrix calculation module, a trajectory transformation module, a calculation and judgment module and a homography transformation matrix determination module; The trajectory set acquisition module is configured to: after time alignment of a first preset roadside sensor and a second preset roadside sensor, respectively use the first preset roadside sensor and the second preset roadside sensor to track a target in the same preset area, thereby obtaining a first trajectory set corresponding to the first preset roadside sensor and a second trajectory set corresponding to the second preset roadside sensor; The sampling module is configured to: perform sampling from the first trajectory set and the second trajectory set respectively, wherein the target corresponding to the trajectory sampled from the first trajectory set is the same as the target corresponding to the trajectory sampled from the second trajectory set; The homography transformation matrix calculation module is used to: determine the current homography transformation matrix according to the multiple trajectories obtained by current sampling; The trajectory transformation module is configured to calculate, based on the current homography transformation matrix, a third trajectory set of all unsampled trajectories in the second trajectory set in the coordinate system used by the first preset roadside sensor; Any position coordinate in the coordinate system used by the first preset roadside sensor is marked as (x ′ ,y ′ ), (x ′ ,y ′ ) In the equation (x ′ ,y ′ ) in the coordinate system used by the second preset roadside sensor (u ′ ,v ′ ) until the position coordinates of each position coordinate of all unsampled trajectories in the second trajectory set in the coordinate system used by the camera device are obtained, and the position coordinates of each position coordinate of each unsampled trajectory in the second trajectory set in the coordinate system used by the first preset roadside sensor respectively constitute a new trajectory, and the set of all new trajectories is the third trajectory set; in, is the current homography transformation matrix, h 00 、h 01 、h 02 、h 10 、h 11 、h 12 、h 20 、h 21 and h 22 is the element in the current homography transformation matrix, and s represents the coefficient of the homogeneous coordinate; The calculation and judgment module is used to: calculate the average distance between the first trajectory set and the third trajectory set, and determine whether the average distance is less than a preset distance threshold to obtain a judgment result; The homography transformation matrix determination module is used to: when the judgment result is yes, determine the current homography transformation matrix as the final homography transformation matrix.
6. The system for calibrating the conversion relationship between two roadside sensors according to claim 5, characterized in that: The method further includes a calling module, wherein the calling module is configured to: when the judgment result is negative, call the sampling module to resample from the first trajectory set and the second trajectory set respectively.
7. A system for calibrating the conversion relationship between two roadside sensors according to claim 5 or 6, characterized in that: The sampling module is specifically configured to randomly sample from the first trajectory set to obtain the trajectories of two targets, and select the trajectories of the two targets from the second trajectory set.
8. A system for calibrating the conversion relationship between two roadside sensors according to claim 5 or 6, characterized in that: The first preset roadside sensor is a camera device, and the second preset roadside sensor is a radar, or the first preset roadside sensor is a radar, and the second preset roadside sensor is a camera device.
9. An electronic device, characterized in that The electronic device includes a processor, the processor is coupled to a memory, and the memory stores at least one computer program. The at least one computer program is loaded and executed by the processor so that the electronic device implements a method for calibrating the conversion relationship between two roadside sensors as described in any one of claims 1 to 4.
10. A computer-readable storage medium, characterized in that The computer-readable storage medium stores at least one computer program, which is loaded and executed by a processor to enable the computer to implement a method for calibrating a conversion relationship between two roadside sensors as described in any one of claims 1 to 4.
Citation Information
Patent Citations
Calibration method and system based on millimeter-wave radar and camera sensor fusion
CN111383285A
Sensor calibration method and device
CN112558023A
Roadside combined sensing equipment online calibration method based on vehicle-road data fusion
CN112836737A
Roadside millimeter-wave radar calibration method based on vehicle-mounted positioning apparatus
WO2022206978A1
Radar deflection angle determination method and device
JP2022067071A