MotionPlanner: fix bug introduced in previous commit.
We need to add the total time of the command to 'time', not just the
constant
motion time.