[논문 리뷰] Safe Trajectory Generation for Complex Urban Environments Using Spatio-temporal Semantic Corridor

Wenchao Ding, Lu Zhang외 2명|arXiv (Cornell University)|2019. 06. 24.

Robotic Path Planning Algorithms참고 문헌 20인용 수 5

한 줄 요약

이 논문은 복잡한 도심 환경에서 안전한 경로 생성을 위한 통합된 시공간 의미론적 통로(SSC) 프레임워크를 제안한다. 동적 에이전트, 신호등, 속도 제한 등 다양한 의미론적 요소를 시공간 도메인 내 연결된 충돌 방지 입방체로 모델링함으로써, 조각별 베지에 곡선을 사용해 볼록 2차 프로그래밍(QP) 문제로 경로 최적화를 수립함으로써 모든 의미론적 제약 조합에 대해 이론적 안전성과 타당성 보장을 확보한다.

ABSTRACT

Planning safe trajectories for autonomous vehicles in complex urban environments is challenging since there are numerous semantic elements (such as dynamic agents, traffic lights and speed limits) to consider. These semantic elements may have different mathematical descriptions such as obstacle, constraint and cost. It is non-trivial to tune the effects from different combinations of semantic elements for a stable and generalizable behavior. In this paper, we propose a novel unified spatio-temporal semantic corridor (SSC) structure, which provides a level of abstraction for different types of semantic elements. The SSC consists of a series of mutually connected collision-free cubes with dynamical constraints posed by the semantic elements in the spatio-temporal domain. The trajectory generation problem then boils down to a general quadratic programming (QP) formulation. Thanks to the unified SSC representation, our framework can generalize to any combination of semantic elements. Moreover, our formulation provides a theoretical guarantee that the entire trajectory is safe and constraint-satisfied, by using the convex hull and hodograph properties of piecewise Bezier curve parameterization. We also release the code of our method to accommodate benchmarking.

연구 동기 및 목표

• 자율주행차 경로 계획에서 다양한 의미론적 요소(예: 신호등, 속도 제한, 동적 에이전트)를 통합하는 도전 과제를 해결한다.
• 기존 방법들이 샘플링된 점들에서만 제약 조건을 확인하는 데서 비롯되는 한계를 극복하여, 샘플 간의 타당하지 않은 세그먼트를 놓치지 않는다.
• 재조정이 필요 없이 임의의 조합을 지원하는 일반화 가능한 의미론적 요소의 통합 표현 방식을 제공한다.
• 이론적 안전성과 제약 조건 충족을 전체 경로에 대해 보장하며, 이산적인 점들 뿐 아니라 전체 경로에 대해 보장한다.
• 다양한 상호작용과 제약 조건이 존재하는 복잡한 도심 시뮬레이션 환경에서 실시간으로 고성능 경로 생성을 가능하게 한다.

제안 방법

• 시공간 도메인 내 의미론적 요소를 연결된 충돌 방지 입방체로 표현하는 통합된 시공간 의미론적 통로(SSC)를 도입한다.
• 동적 SSC 생성 프로세스를 통해 입방체를 분할하고 특정 의미론적 제약 조건(예: 속도 제한, 정지 신호)에 연결한다.
• SSC 내에서 볼록 2차 프로그래밍(QP) 문제로 경로 생성을 수립하여 매끄러움, 안전성, 제약 조건 준수를 최적화한다.
• 조각별 베지에 곡선의 볼록 셸 및 호도그래프 성질을 활용하여 전체 경로가 SSC 내에 머물러 있고 운동학적 제약 조건을 충족한다는 것을 수학적으로 보장한다.
• 다중 에이전트 도심 시뮬레이션 플랫폼에서 실시간 기능을 구현한다.
• 공개 소스 코드를 제공하여 벤치마킹과 재현 가능성을 지원한다.

실험 결과

연구 질문

• RQ1 도심 환경의 다양한 의미론적 요소를 경로 계획을 위해 통합적이고 일반화 가능한 방식으로 표현할 수 있는가?
• RQ2 경로의 전체 영역에서 안전성과 타당성을 보장할 수 있는 경로 생성 방법은 가능한가? 특히 샘플링된 점들 뿐 아니라 전체 경로에 대해 보장한다.
• RQ3 다양한 에이전트와 제약 조건이 존재하는 복잡한 동적 상호작용 상황에서 제안된 SSC 기반 QP 수식은 어떻게 성능을 발휘하는가?
• RQ4 격자 기반 방법 대비 SSC 표현 방식은 매끄러움, 안전성, 계산 효율성 측면에서 어떤 성능 향상을 보이는가?
• RQ5 고속 충돌 회피, 높은 진입 속도에서 정확한 정지, 엄격한 속도 제한을 동시에 처리할 수 있는가?

주요 결과

• 제안된 SSC 프레임워크는 동적 에이전트, 신호등, 속도 제한 등 의미론적 요소의 임의의 조합에 대해 안전하고 타당한 경로 생성을 가능하게 한다.
• 혼잡한 환경에서 기준 대비 14초 빨리 빨간 신호등에 도착했으며, 운동학적 제한 내에서 더 매끄러운 가속도 프로파일을 기록했다.
• 진입 속도 13 m/s 상황에서 최대 감속 제한을 엄격히 준수하면서 정확한 정지를 달성했으며, 기준 대비 동적 목표 상태 계산 방식에서 관찰된 굴곡 불안정성을 피했다.
• 4 m/s 속도 제한 조건 하에서도 제약 조건을 전체 경로에 걸쳐 엄격히 준수하여 저속 주행 상황에서의 강건성을 입증했다.
• 특히 장애물이 많은 환경에서 기준 대비 타당성과 매끄러움 측면에서 우수한 성능을 발휘했으며, 기준에서 많은 프리미티브들이 타당하지 않아지는 상황에서도 유연하게 대응했다.
• 공개 소스 구현을 통해 재현 가능성과 벤치마킹이 가능해져 향후 자율주행차 경로 계획 분야의 개발을 지원한다.