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