STITCHER: 모션 프리미티브 탐색을 통한 실시간 궤적 계획

초록

STITCHER는 수치 최적화에 의존하지 않고 그래프 탐색을 활용하여, 짧은 궤적 세그먼트(모션 프리미티브)를 실시간으로 연결함으로써 장거리 동역학적 궤적을 생성하는 새로운 계획 프레임워크입니다. 3단계 계획 구조와 효율적인 휴리스틱을 통해 복잡한 환경에서도 밀리초 단위로 안전한 궤적을 생성하며, 기존 최적화 기반 플래너보다 빠른 성능을 보입니다.

상세 분석

STITCHER의 핵심 기술적 혁신은 실시간 성능을 보장하는 3단계 계획 아키텍처와 이를 가능하게 하는 알고리즘적 발전에 있습니다. 첫 번째 단계에서는 A* 탐색을 통해 환경을 통과하는 희소한 웨이포인트 집합을 생성합니다. 이는 탐색 공간을 제한하는 가이드 역할을 합니다. 두 번째이자 가장 중요한 단계는 ‘속도 그래프’를 구성하고 동적 프로그래밍을 통해 각 노드(위치-속도 쌍)에 대한 ‘도달 비용(cost-to-go)‘을 계산하는 것입니다. 이때 사용되는 모델은 제어 입력이 제한된 이중 적분기 모델로, 복잡한 상태 제약이나 충돌 검사 없이 최소 시간 궤적을 빠르게 계산할 수 있습니다. 여기서 계산된 도달 비용은 세 번째 단계의 모션 프리미티브 탐색을 위한 ‘허용 가능한 휴리스틱(admissible heuristic)‘으로 작용합니다. 이 휴리스틱은 A* 탐색의 효율을 극적으로 높여 실시간 성능을 가능하게 하는 열쇠입니다.

세 번째 단계에서는 더 높은 차수의 동역학 모델(예: 쿼드로터의 미분 평탄성 활용)을 기반으로 한 모션 프리미티브를 사용하여 A* 탐색을 수행합니다. 이 단계에서 비로소 충돌 검사와 복잡한 상태/구동기 제약(추력 크기, 틸트 각도 등)이 샘플링 기반으로 평가되어 궤적이 실질적으로 실행 가능하고 안전한지 확인합니다. 또한, 이전 궤적 평가에서 알려진 자유 공간 정보를 재활용하는 지능적인 충돌 검사 최적화는 계산 부하를 추가로 줄입니다.

이 방법론의 강점은 최적화 기반 방법과 모션 프리미티브 기반 방법의 단점을 동시에 해결했다는 점입니다. 최적화 기반 방법의 수치적 불안정성과 예측 불가능한 계산 시간 문제를 피하면서도, 단순한 모션 프리미티브 재계획의 근시안적/차선책 행동을 장거리 최적 탐색으로 극복했습니다. 특히 그래프가 유한함을 증명하고 허용 가능한 휴리스틱을 사용함으로써 사전에 시간 및 메모리 복잡도 상한을 알 수 있어 안전-중요 시스템에 적용하기에 유리합니다.