Added encoders to drive system

Added encoders to drive (PID needs calibration).
Added methods to control encoders.
Changed LogSystem to print seconds values in front of messages.