3D Cruise Trajectory Optimization Inspired by a Shortest Path ...