Faster, smoother swing leg trajectories

this branch let us increase the swing speed to 0.75m/s on Atlas, which is about twice as fast as before.