Fixed return the nearest accessible location to the target in 3D path finder