online path planning in a continuous gaussian process occupancy map .
3D Field D: Improved Path Planning and Replanning in Three Dimensions