Add LED control trigger implementation

* The LEDs are controlled by a method called from FunCommand that checks the
  robot state and updates the robot accordingly
* Add isExtended() methods to SweeperSubsystem and CatcherSubsystem
* Make SweeperSusbsystem.MotorState.state public and add value constants
* Add hashCode() and equals() implementations to SweeperSusbsystem.MotorState
Fiexed motor directions and a SmartDashboard print.
Merge branch 'leds' into better-drive.
Fix autonomous and wheel inversions.

* Make autonomous move in the correct direction
* Move wheel inversions to DriveSubsystem constructor