- Finalize main control logic-state machine - Finalize PID Auto-tune - Finalize Modes-control logic - Finalize Commands