Fixed bug in Drivetrain.cpp

Logic Changes -
Discovered and Fixed bug in error range in multiple functions due to
copy and pasting code.

Other Changes -
Corrected, added, and formatted comments.
Added Comments

Logic Changes -
Stored joystick values in double types in case of need to debug.

Other Changes -
Added comments to OI.h
Added comments to DriveCMD::Execute()