Some more comments for future work and review in simulation
Calibration loop FSM complete