Ground truth configuration of robot poses and cube points.
Registering successive robot position using ICP for calculating the transformation or odometry.
Registering point clouds from all robot positions to the first frame.
Optimization using Multiview ICP formulation. And registering all point clouds to the first frame.