Implement REV Blinkin

[JavaBlendPhilippe]

https://www.revrobotics.com/content/docs/REV-11-1105-UM.pdf Demonstrate LED Light control on Kitbot. Could be used for Driver Feedback/Updates on Robot. Different Light Colors and/or Patterns for different statuses.

Requirements

• [x] lights should be red when going in reverse
• [x] lights should be blue when going forward
• [x] when in slow-mode, lights should be blinking
• [x] when not in slow-mode, lights should be solid
• [x] when not moving, lights should be white
• [x] when turning clockwise, lights should be orange
• [x] when turning counterclockwise, lights should be green
• [x] move light code out of drivecommand to blinkincommand

[glucko]

1/28/23 notes

I added the direction to shuffleboard and experimented with the simulation. If the robot is not available, using the simulation is encouraged for testing things such as direction.

To use simulator, build the code and type in ">wpilib simulate" in vscode command palette, click "ok" when the "extensions to run" tab pops up, and click "teleoperated" in the simulation window. You can use the keyboard to simulate joysticks, and open up shuffleboard to see direction and power. You can also change keyboard bindings in the "DS" tab on the top of the simulation window.