implement led mode colors

[cjv17003]

Starts up
LED - blue/green
Sets up navigation
LED - blue
Starts an internal countdown of 30 seconds
LQR and Kalman inactive
All navigation based on sensors
Start recording data
LED - blue
At T-10 s
LED - blink blue (1 Hz)
At T-2.5 s
Activate LQR
Allow TVC to move
At T-0 s
Activate Kalman filter
Set a new timer
LED - green
At T+10 s
Freeze the TVC
Stop recording data
Start transferring data to the SD card
LED - blue
Once data transfer is complete
LED - blue/green