Implement LED subsystem

[jkleiber]

Purpose
The purpose of this addition is to implement the LED subsystem.

We should leverage new WPILib features to do this, read more in this PR: wpilibsuite/allwpilib#6344

Project Scope

• Come up with LED light codes
• Implement LED subsystem
• Simulate LEDs
• Test on HITL

[minhnguyenbhs]

Are there LED simulation capabilities on Glass/Advantagekit?

[jkleiber]

@minhnguyenbhs there are ways to simulate LEDs in Glass yeah

[minhnguyenbhs]

LED signals required:

• (rainbow) turned off/on
• climb locked on bars (bar LEDs)
• target found on reef (middle/bottom); specific additional cues for level chosen
• target found on coral source (middle/bottom)
• target found on algae processor (middle/bottom)
• target found on net (middle/bottom)
• holding algae (top left?)
• holding coral (top right?)