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

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