Changed the camera offset correction to use the vslam orientation