Calibration fixed, output to stereo_localisation is no longer origin at principal point