Correct the time incrementation for control recomputation

This modification allows to avoid a strange stairs shape of the control of the SoT (I don't understand where it comes from).