Sensor Information Fusion Method and Apparatus
20230258797 · 2023-08-17
Inventors
Cpc classification
G01S17/87
PHYSICS
G01S13/42
PHYSICS
International classification
G01S13/86
PHYSICS
G01S17/86
PHYSICS
Abstract
An embodiment sensor information fusion method includes acquiring a first sensor track from a first sensor mounted in a vehicle and setting a reference sector based on the first sensor track, selecting at least one target track included in the reference sector, and comparatively analyzing an angle between the at least one target track and the first sensor track and generating a fusion track through fusion with the first sensor track based on an analysis result value.
Claims
1. A sensor information fusion method comprising: acquiring a first sensor track from a first sensor mounted in a vehicle; setting a reference sector based on the first sensor track; selecting at least one target track included in the reference sector; comparatively analyzing an angle between the at least one target track and the first sensor track; and generating a fusion track through fusion with the first sensor track based on an analysis result value.
2. The sensor information fusion method according to claim 1, wherein setting the reference sector comprises: calculating first azimuth information from the first sensor track; extracting a resolution from the first azimuth information; and setting the reference sector based on the resolution.
3. The sensor information fusion method according to claim 2, wherein selecting the at least one target track comprises: acquiring a second sensor track from a second sensor different from the first sensor; determining whether or not the second sensor track is located inside the reference sector; and setting the second sensor track determined to be located inside the reference sector to the at least one target track.
4. The sensor information fusion method according to claim 3, wherein: the at least one target track comprises a first target track located inside the reference sector and a second target track located at a different position from the first target track inside the reference sector; and generating the fusion track comprises: comparatively analyzing a first angle calculated between the first target track and the first sensor track and a second angle calculated between the second target track and the first sensor track to determine comparative analysis angle results; and generating a first fusion track by fusing the first sensor track and the first target track or generating a second fusion track by fusing the first sensor track and the second target track, based on the comparative analysis angle results.
5. The sensor information fusion method according to claim 4, wherein, in generating the fusion track, when the first angle is less than the second angle, the first fusion track is generated by fusing the first target track with the first sensor track.
6. The sensor information fusion method according to claim 4, wherein, in generating the fusion track, when the first angle is greater than the second angle, the second fusion track is generated by fusing the second target track with the first sensor track.
7. The sensor information fusion method according to claim 4, wherein selecting the at least one target track further comprises: acquiring a third sensor track from a third sensor different from the second sensor; determining whether or not the third sensor track is located inside the reference sector; and setting the third sensor track determined to be located inside the reference sector to the at least one target track.
8. The sensor information fusion method according to claim 7, wherein: the at least one target track further comprises a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector; and generating the fusion track further comprises: comparatively analyzing a first distance calculated between the third target track and the first target track and a second distance calculated between the fourth target track and the first target track to determine comparative analysis distance results; and generating a third fusion track by fusing the first target track and the third target track or generating a fourth fusion track by fusing the first target track and the fourth target track, based on the comparative analysis distance results.
9. The sensor information fusion method according to claim 8, wherein, in generating the fusion track, when the first distance is less than the second distance, the third fusion track is generated by fusing the third target track with the first target track.
10. The sensor information fusion method according to claim 8, wherein, in generating the fusion track, when the first distance is greater than the second distance, the fourth fusion track is generated by fusing the fourth target track with the first target track.
11. The sensor information fusion method according to claim 7, wherein: the at least one target track excludes the first target track and the second target track not located inside the reference sector; the at least one target track comprises a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector; and generating the fusion track further comprises: analyzing third azimuth information calculated from the third target track and fourth azimuth information calculated from the fourth target track through comparison between first azimuth information calculated from the first sensor track and each of the third azimuth information and the fourth azimuth information; and generating a fifth fusion track by fusing the first sensor track and the third target track when the third azimuth information is equal to the first azimuth information.
12. The sensor information fusion method according to claim 7, wherein: the at least one target track excludes the first target track and the second target track not located inside the reference sector; the at least one target track comprises a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector; and generating the fusion track further comprises: analyzing third azimuth information calculated from the third target track and fourth azimuth information calculated from the fourth target track through comparison between first azimuth information calculated from the first sensor track and each of the third azimuth information and the fourth azimuth information; and generating the fusion track based on the first sensor track when the third azimuth information or the fourth azimuth information is not equal to the first azimuth information.
13. A non-transitory computer readable recording medium having recorded thereon a program to execute the sensor information fusion method according to claim 1.
14. A sensor information fusion apparatus comprising: a first sensor configured to acquire a first sensor track with respect to an object around a vehicle; and a fusion controller configured to: set a reference sector based on the first sensor track provided by the first sensor; select at least one target track included in the reference sector; comparatively analyze an angle between the at least one target track and the first sensor track; and generate a fusion track through fusion with the first sensor track based on an analysis result value.
15. The sensor information fusion apparatus according to claim 14, wherein the fusion controller is configured to: calculate first azimuth information from the first sensor track; extract a resolution from the first azimuth information; and set the reference sector based on the resolution.
16. The sensor information fusion apparatus according to claim 15, further comprising: a second sensor configured to acquire a second sensor track with respect to the object around the vehicle; and a third sensor configured to acquire a third sensor track with respect to the object around the vehicle; and wherein the fusion controller is configured to: determine whether or not at least one of the second sensor track or the third sensor track is located inside the reference sector; and set the second sensor track of the third sensor track determined to be located inside the reference sector to the at least one target track.
17. The sensor information fusion apparatus according to claim 16, wherein: the at least one target track comprises a first target track located inside the reference sector and a second target track located at a different position from the first target track inside the reference sector; and the fusion controller is configured to: comparatively analyze a first angle calculated between the first target track and the first sensor track and a second angle calculated between the second target track and the first sensor track to determine comparative analysis angle results; and generate a first fusion track by fusing the first sensor track and the first target track or generate a second fusion track by fusing the first sensor track and the second target track, based on the comparative analysis angle results.
18. The sensor information fusion apparatus according to claim 17, wherein: the at least one target track further comprises a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector; and the fusion controller is configured to: comparatively analyze a first distance calculated between the third target track and the first target track and a second distance calculated between the fourth target track and the first target track to determine comparative analysis distance results; and generate a third fusion track by fusing the first target track and the third target track or generate a fourth fusion track by fusing the first target track and the fourth target track, based on the comparative analysis distance results.
19. The sensor information fusion apparatus according to claim 17, wherein: the at least one target track excludes the first target track and the second target track not located inside the reference sector; the at least one target track comprises a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector; and the fusion controller is configured to: analyze third azimuth information calculated from the third target track and fourth azimuth information calculated from the fourth target track through comparison between first azimuth information calculated from the first target track and each of the third azimuth information and the fourth azimuth information; and generate a fifth fusion track by fusing the first sensor track and the third target track when the third azimuth information is equal to the first azimuth information.
20. The sensor information fusion apparatus according to claim 17, wherein: the at least one target track excludes the first target track and the second target track not located inside the reference sector; the at least one target track comprises a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector; and the fusion controller is configured to: analyze third azimuth information calculated from the third target track and fourth azimuth information calculated from the fourth target track through comparison between first azimuth information calculated from the first target track and each of the third azimuth information and the fourth azimuth information; and generate the fusion track based on the first sensor track when the third azimuth information or the fourth azimuth information is not equal to the first azimuth information.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0035] The accompanying drawings, which are included to provide a further understanding of embodiments of the invention and are incorporated in and constitute a part of this application, illustrate embodiments of the invention and together with the description serve to explain the principle of the invention. In the drawings:
[0036]
[0037]
[0038]
[0039]
[0040]
DETAILED DESCRIPTION OF ILLUSTRATIVE EMBODIMENTS
[0041] Reference will now be made in detail to the exemplary embodiments of the present invention, examples of which are illustrated in the accompanying drawings. However, the embodiments of the present invention may be implemented in various different forms, and the scope of the present invention is not limited to the embodiments disclosed hereinafter. The embodiments of the present invention are provided to make the description of the present invention thorough and to fully convey the scope of the present invention to those skilled in the art.
[0042] In the following description of the embodiments, it will be understood that, when positional relationships are expressed, for example, when an element is said to be “on” or “under” another element, the two elements may directly contact each other, or one or more other elements may be interposed between the two elements, unless the term “immediately” or “directly” is used.
[0043] Further, it will be understood that spatially relative terms, such as “on”, “under” and the like, can encompass both an orientation of above and below one element.
[0044] In addition, it will be understood that the relational terms “first”, “second”, “on”/“above”and “under”/“below”, etc. may not always require or encompass any physical or logical relations between substances or elements or the order thereof, and may be used only to distinguish any substance or element from other substances or elements.
[0045] Hereinafter, a sensor information fusion method according to one embodiment of the present invention will be described with reference to the accompanying drawings. Although, for convenience, the sensor information fusion method will be described using the Cartesian coordinate system (the x-axis, the y-axis and the z-axis being applied), the sensor information fusion method may be described based on other coordinate systems.
[0046]
[0047] As shown in
[0048] The sensor unit 110 may sense an object outside the vehicle. The sensor unit 110 may include one or more sensors configured to acquire information about a target object located around the vehicle. For example, the sensor unit no may include first to third sensors.
[0049] The sensor unit 110 may acquire at least one of information, such as the position of the target object, the moving speed of the target object, the moving direction of the target object, and the kind of the target object (for example, a vehicle, a pedestrian, a bicycle, a motorcycle or the like) depending on the kind of the sensor. For example, the sensor unit 110 may include various sensors, such as an ultrasonic sensor, Radio Detection and Ranging (RaDAR), a camera, a laser scanner, and Light Detection and Ranging (LiDAR). For example, the camera may be referred to as a first sensor, the LiDAR may be referred to as a second sensor, and the RaDAR may be referred to as a third sensor.
[0050] The fusion controller 130 may recognize an object by fusing sensor information acquired by the sensor unit 110. The fusion controller 130 may detect the object by processing detection points input from the respective sensors of the sensor unit 110, and may predict track information based on the detected object. For example, the fusion controller 130 may receive sensor tracks provided from the sensor unit 110, may set a reference sector based on the sensor tracks, and may select at least one target track included in the reference sector.
[0051] The fusion controller 130 may compare the angle of the at least one target track with the angle of a first sensor track, and may generate a fusion track by fusing the at least one target track and the first sensor track based on an analysis result value.
[0052] The fusion controller 130 may control a driver assistance and autonomous driving system based on the information of the at least one selected target track or the fusion track. The fusion controller 130 may output a control signal configured to control the driver assistance and autonomous driving system based on a pedestrian recognition result. However, the fusion controller 130 is not limited thereto, and a detailed description of the fusion controller 130 will be given later.
[0053]
[0054] Referring to
[0055] The pre-processor 131 may process the detection points input from the respective sensors into a fusion enabling form. The pre-processor 131 may correct coordinate systems of sensing values or sensing data acquired from the respective sensors into the same reference coordinate system. Further, the pre-processor 131 may remove detection points having data intensity or confidence which is less than a reference through filtering.
[0056] The track analyzer 133 may detect an object by processing the detection points input from the respective sensors and may predict track information based on the detected object. Here, a track may be generated in a box type fitting into the outside of the object, and may include information, such as a position, a speed and a class.
[0057] Each sensor may output one sensor track with respect to one object. For example, the first sensor may acquire a first sensor track, the second sensor may acquire a second sensor track, and the third sensor may acquire a third sensor track. However, the sensors are not limited thereto and, although the sensors sense the same object, the attributes, such as the sizes, positions, speeds, etc., of the generated sensor tracks may be different depending on characteristics of the respective sensors.
[0058] The associator 135 may determine similarity among the sensor tracks generated by the respective sensors and may fuse the sensor tracks into one fusion track. The associator 135 may generate the fusion track in consideration of a distance or an azimuth between central points of a reference track and a target track.
[0059] The reference track may be set by choosing or selecting one of the generated sensor tracks. For example, the associator 135 may set the first sensor track out of the first to third sensor tracks as the reference track. When the reference track is set, the associator 135 may set a reference sector based on the reference track. The configuration of the associator 135 will be described in detail below with reference to
[0060] The fusion output unit 137 may output or manage the fusion track generated by the associator 135.
[0061]
[0062] The associator 135 may update a target track to be associated, among gated sensor tracks, and may generate a fusion track having the highest similarity to the real object by calculating a combined cost by reflecting a distance or an azimuth between the reference track and the target track. The associator 135 may set the reference sector based on the reference track under the control of the fusion controller 130, may select at least one target track included in the reference sector, and may generate the fusion track having the highest similarity to the real object based on the at least one target track.
[0063] Referring to
[0064] The updater 135a may update the target track to be associated, by determining similarities between the reference track information and predicted track information generated by the respective sensors.
[0065] In order to determine similarities, the associator 135 may set a gate based on the reference track, and may determine whether or not a reference point of the target track is located inside the gate. The gate may be referred to as the reference sector. That is, the associator 135 may set the reference sector based on the reference track under the control of the fusion controller 130 and may select at least one target track inside the set reference sector.
[0066] The reference track may be the sensor track generated by one of a plurality of sensors, and a method for setting the sensor configured to generate the reference track may be set in advance. The sensor track may be referred to as a track. However, the present invention is not limited thereto, and a fusion track generated at a previous point in time may be set as the reference track depending on a surrounding environment or circumstances.
[0067] The gate may be a region set based on the reference track, and the sensor tracks, degrees of association of which will be calculated, may be selected depending on whether or not the reference points of the target tracks are located inside the gate.
[0068] When the reference point of the target track is located inside the gate under the control of the fusion controller 130, the associator 135 may update the target track of a corresponding sensor to a target, association of which with the reference track is to be calculated. When the reference point of the target track is located outside the gate, the associator 135 may determine that the target track of the corresponding sensor is not associated with the reference track, and may thus remove the target track.
[0069] The analyzer 135b may mathematically calculate degrees of association between target tracks located inside the reference track and the reference track, and may thus select a target track having the highest probability that the target track and the reference track are tracks with respect to the same object.
[0070] The analyzer 135b may analyze an azimuth and a distance between the reference track and the target track and may calculate an analysis result value. The analysis result value may be referred to as a cost. The analysis result value may be a value which is mathematically calculated so as to show similarity between two sensor tracks. For example, the analyzer 135b may calculate the analysis result value using the Euclidean distance or the Mahalanobis distance between the two sensor tracks under the control of the fusion controller 130. For example, the analyzer 135b may determine that the probability that the two sensor tracks are tracks with respect to the same object is increased as the azimuth between the two sensor tracks decreases and as the distance between the two sensor tracks decreases under the control of the fusion controller 130. Therefore, the analyzer 135b may select the target track having a small analysis result value under the control of the fusion controller 130. The target track may be referred to as an association track.
[0071] As described above, in order to select a sensor track having the highest probability that the sensor track and the reference track are tracks with respect to the same object, the sensor information fusion apparatus wo according to one embodiment may comparatively analyze an azimuth or a distance between the reference track and a target track and may calculate an analysis result value, thereby being capable of improving accuracy of a fusion track.
[0072] Further, one embodiment of the present invention may improve fusion performance between different kinds of sensors, and particularly, may improve fusion performance between sensors having similar attributes of raw data of sensor information.
[0073]
[0074] Referring to
[0075] First, a first sensor track may be acquired from a first sensor mounted in a vehicle, and a reference sector may be set based on the first sensor track (S110). The first sensor may be a camera or a front camera. The fusion controller 130 (with reference to
[0076] The fusion controller 130 (with reference to
[0077] The fusion controller 130 (with reference to
[0078] The fusion controller 130 (with reference to
[0079] Referring to
[0080] The fusion controller 130 (with reference to
[0081] The fusion controller 130 (with reference to
[0082] Here, the target tracks may include a first target track located inside the reference sector and a second target track located at a different position from the first target track inside the reference sector.
[0083] That is, referring to
[0084] Referring to
[0085] The fusion controller 130 (with reference to
[0086] The fusion controller 130 (with reference to
[0087] When the second target track, which is a LiDAR target, classified into another pedestrian or unknown further exists in the candidate sector, i.e., when LiDAR targets classified into a plurality of pedestrians or unknowns, as described above, exist in the candidate sector, the fusion controller 130 (with reference to
[0088] However, the present invention is not limited thereto, and the fusion controller 130 (with reference to
[0089] Thereafter, the fusion controller 130 (with reference to
[0090] The fusion controller 130 (with reference to
[0091] Here, the target tracks may include a third target track located inside the reference sector and a fourth target track located at a different position from the third target track inside the reference sector.
[0092] The fusion controller 130 (with reference to
[0093] The fusion controller 130 (with reference to
[0094] Referring to
[0095] However, the present invention is not limited thereto, and the fusion controller 130 (with reference to
[0096] The fusion controller 130 (with reference to
[0097] As described above, the fusion controller 130 (with reference to
[0098] Further, the fusion controller 130 (with reference to
[0099] The fusion controller 130 (with reference to
[0100] That is, the fusion controller 130 (with reference to
[0101] Further, the fusion controller 130 (with reference to
[0102] As described above, the sensor information fusion method and apparatus according to embodiments of the present invention may form a candidate sector using only the azimuth information of a camera in order to minimize inaccuracy in position information acquired by the camera and RaDAR, and may perform association of camera, RaDAR and LiDAR tracks located inside the candidate sector, when a LiDAR target classified as a pedestrian or an unknown exists in the corresponding candidate sector, thereby being capable of improving accuracy in position, classification, and speed information of the pedestrian through fusion of LiDAR, RaDAR, and camera sensors with respect to the pedestrian.
[0103] The present invention described above may be implemented as computer readable code in a computer readable recording medium in which programs are recorded. Such computer readable recording media may include all kinds of recording media in which data readable by computer systems is stored. For example, the computer readable recording media may include a Hard Disk Drive (HDD), a Solid-State Drive (SSD), a Silicon Disk Drive (SDD), a ROM, a RAM, a CD-ROM, a magnetic tape, a floppy disk, an optical data storage device, etc.
[0104] As is apparent from the above description, a sensor information fusion method and apparatus according to embodiments of the present invention may form a candidate sector using only the azimuth information of a camera in order to minimize inaccuracy in position information acquired by the camera and RaDAR, and may perform association of camera, RaDAR, and LiDAR tracks located inside the candidate sector, when a LiDAR target classified as a pedestrian or an unknown exists in the corresponding candidate sector, thereby being capable of improving accuracy in position, classification, and speed information of the pedestrian through fusion of LiDAR, RaDAR, and camera sensors with respect to the pedestrian.
[0105] It will be apparent to those skilled in the art that various modifications and variations can be made in the present invention without departing from the spirit or scope of the invention. Thus, it is intended that the present invention cover the modifications and variations of this invention provided they come within the scope of the appended claims and their equivalents.