Worked on stereo_localisation package