enabled odometrycorrection
adjusted extraneous doubles to floats (in method headers) to make code work with OdometryCorrection
Added OdometryCorrection. LS works. Correction values off but pending fix