implementing odometry, added a constants class, small modifications and general work towards the lab