feat(goal_planner): reject candidate path whose start pose direction is not aligned with ego path (#6935)#1297