Wrote test for linear speed for TwoWheelOdometryManager
Wrote linear velocity function for two-wheel odometry
Refactored linear velocity function
Added concept of direction to Encoder class
Odometry now works for wheels in opposite directions