Refactored OdometryIntegrator such that data mutex locks were smaller
and were in every function that needed protection, rather than relying
on one larger block around a group of functions.
Removed a commented out include.