Drive subsystem now enables encoders.
Added SetEncoders command to enable/disable encoders, based on its template argument.
Commented out the squaring of inputs in drive with DriveWithJoystick.