Implemented interface for using external odometry data to enhance pose estimation.
Changed pose results to output in CSV.
Re-added error capping for map point generation to avoid inaccurate map points messing up pose estimation.