Alignment Lock

When a button on the controller is pressed, lock the rotation (theta) of the robot to a specified angle.

We will have multiple angle set-points, each driven by a different button press.

Have logic to choose between a red and blue version of the angle, referencing the alliance color provided by fms.