Systems for completing missing points in a three-dimensional (3D) point cloud. The systems include a 3D sensor for measuring point data of objects in a scene, a processor in connection with the 3D sensor and a memory storing a program and the point data, and a display monitor connected to the processor and the 3D sensor for displaying a completed 3D point cloud, wherein the processor executes instruction steps of the program. The instruction steps include acquiring the point data of the objects to generate the 3D point cloud, wherein the point data include a set of points on the objects, extracting planar segments from the 3D point cloud, identifying connectivity relations and missing points among the planar segments, and filling the missing points in the 3D point cloud to generate the completed 3D point cloud using the planar segments and the connectivity relations.