Bug-fix on the period of ServoMotion