Correct the time incrementation for control recomputation

This modification allows to avoid a strange stairs shape of the controller.
Merge pull request #28 from mehdi-benallegue/master

Correct the time incrementation for control recomputation