Hybrid-A* SMAC planner