Planning Locally Optimal, Curvature-Constrained Trajectories in 3D Using Sequential Convex Optimization

doi 10.1109/icra.2014.6907726