katana_kinect_calibration: fix bug

The calibration produced an error when the last pose of the
dance does not complete successfully