Adds automated endgame sequence

[redPlover]

Purpose The purpose of this addition is to add an automated endgame sequence that makes alignment a lot faster.

Project Scope

• [ ] Add path-following to climbing setpoint (either basic PID or OTF)
• [ ] Implement scoring subsystem checks and simpler positions

[jkleiber]

Trap is out of scope for VAFAL, moving to DCMP