Set sampling period wrt foot flight time during first animation.

   * The sampling period is set to 5ms when animating the whole path
     to produce the final trajectory.