Added Odometry class refactored from old code. Updated manifest for dependencies.
Added odometry publishing to controller. Needs test with navigation.