https://123dok.com/za/docs/a-focussed-dynamic-path-finding-algorithm-with-constraints.11339316