Don't replan trapezoids if their entry and exit velocities haven't changed, fix bug in replanning running trapezoid, be slightly more generous about accepting replans