Corrected small error of timming management in robotStep.
Merge pull request #141 from DavidMansolino/Step

Corrected small error of timing management in robotStep.