Changed DriveTrain.cpp and .h, Added new file EncodeDistance

Basically, we modified DriveTrain.cpp with actual code (although autoTurn is purely an algorithm atm).

also, we added EncodeDistance files in order to use encoder functions, as well as a distance converter.