Added refinement of ground plane based on point cloud also when ground plane from calibration is chosen.