can now get point in map and summon path planner FSM