CONTROL DEVICE

The present disclosure provides a control device that generates a control command for controlling a mobile body by using three-dimensional point cloud data of the mobile body measured by a distance measurement device. The control device includes an estimation unit configured to, in a case where a defective portion is generated in the three-dimensional point cloud data acquired from the distance measurement device, execute matching between a substantial point cloud portion obtained by excluding a defect corresponding portion corresponding to the defective portion from a template point cloud and the three-dimensional point cloud data, to estimate at least one of a position and an orientation of the mobile body.