https://123dok.org/document/yev3xxm0-heuristic-planning-for-hybrid-systems.html