wirking planner + path simplification
fix path simplification test