A fast algorithm for finding an optimal path in a collection of safe boxes - View it on GitHub