System and method for field calibrating video and lidar subsystems using independent measurements
A system uses range and Doppler velocity measurements from a lidar subsystem and images from a video subsystem to estimate a six degree-of-freedom trajectory of a target. The video subsystem and the lidar subsystem may be aligned with one another, and hence calibrated, by determining, for example, a centroid of an iris determined from the lidar subsystem and a centroid of the iris determined from the video subsystem and determining a calibration offset between the two centroids.
1. A method for calibrating a lidar subsystem with a video subsystem, the method comprising:
receiving a plurality of three-dimensional measurements generated by the lidar subsystem, each of the plurality of three-dimensional measurements corresponding to a point on a target, each of the plurality of three-dimensional measurements comprising a location of the point on the target and an amplitude of a return signal from the point on the target;
receiving at least one image of the target generated by the video subsystem;
determining a calibration offset between the lidar subsystem and the video subsystem from a misalignment between an iris of the target identified from the plurality of three-dimensional measurements generated by the lidar subsystem and the iris of the target found in the at least one image generated by the video subsystem, wherein the plurality of three-dimensional measurements generated by the lidar subsystem are independent from the at least one image generated by the video subsystem, wherein the calibration offset is determined by:
determining a lidar location of the iris of the target in the plurality of three-dimensional measurements from the amplitude of the return signal of at least some of the plurality of three-dimensional measurements,
determining a video location of the iris of the target in the at least one image of the target,
determining the calibration offset between the lidar subsystem and the video subsystem as the difference between the lidar location of the iris and the video location of the iris; and
calibrating the lidar subsystem with the video subsystem using the calibration offset.
2. The method of claim 1 , wherein a location of the point on the target comprises an azimuth, an elevation, and a range.
3. The method of claim 2 , wherein the location of the point on the target further comprises a Doppler velocity.
4. The method of claim 1 , wherein determining the lidar location of the iris of the target in the plurality of three-dimensional measurements from the amplitude of the return signal of at least some of the plurality of three-dimensional measurements comprises:
determining which of the plurality of three-dimensional measurements have a low amplitude of the return signal relative to the amplitude of the return signal of others of the plurality of three-dimensional measurements.
5. The method of claim 4 , wherein determining the lidar location of the iris of the target in the plurality of three-dimensional measurements from the amplitude of the return signal of at least some of the plurality of three-dimensional measurements further comprises:
for those of the plurality of three-dimensional measurements that have the low amplitude of the return signal, determining a centroid location from the respective locations of those of the plurality of three-dimensional measurements; and
wherein the lidar location is the centroid location.
6. The method of claim 1 , wherein determining the video location of the iris of the target in the at least one image of the target comprises:
determining an iris contour of the iris of the target in the at least one image of the target.
7. The method of claim 6 , wherein determining the video location of the iris of the target in the at least one image of the target further comprises:
determining a centroid location from the iris contour; and
wherein the video location is the centroid location.
8. The method of claim 1 , wherein determining a video location of the iris of the target in the at least one image of the target comprises:
performing Fraunhofer processing on the image of the target to identify a centroid location of the iris of the target; and
wherein the video location is the centroid location.
9. A system for calibrating a lidar subsystem with a video subsystem, the system comprising:
a lidar subsystem configured to generate a plurality of three-dimensional measurements, each of the plurality of three-dimensional measurements corresponding to a point on a target, each of the plurality of three-dimensional measurements comprising a location of the point on the target and an amplitude of a return signal from the point on the target;
a video subsystem configured to provide an image of the target; and
a processor configured to:
receive the plurality of three-dimensional measurements from the lidar subsystem,
receive the at least one image of the target from the video subsystem,
determine a calibration offset between the lidar subsystem and the video subsystem from a misalignment between an iris of the target identified from the plurality of three-dimensional measurements generated by the lidar subsystem and the iris of the target found in the at least one image generated by the video subsystem, wherein the plurality of three-dimensional measurements generated by the lidar subsystem are independent from the at least one image generated by the video subsystem, wherein the calibration offset is determined by:
determine a lidar location of the iris of the target in the plurality of three-dimensional measurements from the amplitude of the return signal of at least some of the plurality of three-dimensional measurements,
determine a video second location of the iris of the target in the at least one image of the target,
determine the calibration offset between the lidar subsystem and the video subsystem as the difference between the lidar location of the iris and the video location of the iris; and
calibrate the lidar subsystem with the video subsystem using the calibration offset.
10. The system of claim 9 , wherein a location of the point on the target comprises an azimuth, an elevation, and a range.
11. The system of claim 10 , wherein the location of the point on the target further comprises a Doppler velocity.
12. The system of claim 9 , wherein the processor configured to determine the lidar location of the iris of the target in the plurality of three-dimensional measurements from the amplitude of the return signal of at least some of the plurality of three-dimensional measurements comprises:
the processor configured to determine which of the plurality of three-dimensional measurements have a low amplitude of the return signal relative to the amplitude of the return signal of others of the plurality of three-dimensional measurements.
13. The system of claim 12 , wherein the processor configured to determine the lidar location of the iris of the target in the plurality of three-dimensional measurements from the amplitude of the return signal of at least some of the plurality of three-dimensional measurements further comprises:
the processor configured to, for those of the plurality of three-dimensional measurements that have the low amplitude, determine a centroid location from their respective locations, and
wherein the lidar location is the centroid location.
14. The system of claim 9 , wherein the processor configured to determine the video location of the iris of the target in the at least one image of the target comprises:
the processor configured to determine an iris contour of the iris of the target based on the image of the target.
15. The system of claim 14 , wherein the processor configured to determine the video location of the iris of the target in the at least one the image of the target further comprises:
the processor configured to determine a centroid location from the iris contour, and
wherein the video location is the centroid location.
16. The system of claim 9 , wherein the processor configured to determine the video location of the iris of the target in the at least one image of the target comprises:
the processor configured to perform Fraunhofer processing on the image of the target to identify a centroid location of the iris of the target; and
wherein the video location is the centroid location.
17. The method of claim 1 , wherein the calibrating aligns the lidar subsystem with the video subsystem.
18. The method of claim 1 , wherein the calibrating aligns the plurality of three-dimensional measurements generated by the lidar subsystem with the at least one image from the video subsystem.
19. The system of claim 9 , wherein the calibrating aligns the plurality of three-dimensional measurements generated by the lidar subsystem with the at least one image from the video subsystem.
20. A method for calibrating a lidar subsystem with a video subsystem, the method comprising:
receiving a plurality of three-dimensional measurements generated by the lidar subsystem, each of the plurality of three-dimensional measurements corresponding to a point on a target, each of the plurality of three-dimensional measurements comprising a location of the point on the target and an amplitude of a return signal from the point on the target;
receiving at least one image of the target generated by the video subsystem;
determining a calibration offset between the lidar subsystem and the video subsystem from a misalignment between an iris of the target identified from the plurality of three-dimensional measurements generated by the lidar subsystem and the iris of the target found in the at least one image generated by the video subsystem, wherein the plurality of three-dimensional measurements generated by the lidar subsystem are independent from the at least one image generated by the video subsystem, wherein the calibration offset is determined by:
determining a lidar location of the iris of the target in the plurality of three-dimensional measurements using the amplitude of the return signal of at least some of the plurality of three-dimensional measurements, wherein determining the lidar location comprises:
determining which of the plurality of three-dimensional measurements have a low amplitude of the return signal relative to the amplitude of the return signal of others of the plurality of three-dimensional measurements, and
determining the lidar location as a centroid location of the locations of the plurality of three-dimensional measurements with the low amplitude of the return signal;
determining a video location of the iris of the target in the at least one image of the target, wherein determining the video location comprises:
determining an iris contour of the iris of the target in the at least one image of the target, and
determining the video location as a centroid location of the iris contour;
determining the calibration offset between the lidar subsystem and the video subsystem as the difference between the lidar location of the iris and the video location of the iris; and
calibrating the lidar subsystem with the video subsystem using the calibration offset.