Fix bug in applying computed reach time.

A regression was introduced in which the reach time was not propagated to all
motion waypoints.