US Patent 9134402 System and method for calibrating video and lidar subsystems

A system uses range and Doppler velocity measurements from a lidar system and images from a video system to estimate a six degree-of-freedom trajectory of a target. The system calibrates the lidar subsystem with the video subsystem in two stages. In a first stage, the system calibrates the lidar subsystem so that lidar measurements provide 3D lidar coordinates. In a second stage, the system relates the 3D lidar coordinates with a video image obtained from the video subsystem.