Inventors:
Shunguang Wu - Robbinsville NJ, US
Theodore Camus - Marlton NJ, US
Chang Peng - West Windsor NJ, US
International Classification:
G08G 1/16
G01S 13/08
G01S 13/00
US Classification:
701301, 342146, 342118, 342 53, 342 54
Abstract:
A system and method for fusing depth and radar data to estimate at least a position of a threat object relative to a host object is disclosed. At least one contour is fitted to a plurality of contour points corresponding to the plurality of depth values corresponding to a threat object. A depth closest point is identified on the at least one contour relative to the host object. A radar target is selected based on information associated with the depth closest point on the at least one contour. The at least one contour is fused with radar data associated with the selected radar target based on the depth closest point to produce a fused contour. Advantageously, the position of the threat object relative to the host object is estimated based on the fused contour. More generally, a method is provided for aligns two possibly disparate sets of 3D points.