Hierarchical Dast algorithm with materialization of costs for robot path planning