explicitly plan swing velocities and make trajectory linear in flight