Added motor ports
Refactored autonomous.

Added AutonCommand interface and developed and tested DriveStraight
command.