Simplify the computation of the map -> odom correction and also compute it for saving to .bag file, instead of saving the map position directly.
Suppress some compiler warnings from Karto SDK.
Parameter tuning