[논문 리뷰] Safe Interval Path Planning With Kinodynamic Constraints

Zain Alabedeen Ali, Konstantin Yakovlev|arXiv (Cornell University)|2023. 02. 01.

Robotic Path Planning Algorithms인용 수 4

한 줄 요약

이 논문은 비가속성 제약 조건—특히 즉각적인 가속도 및 감속이 아닌 경우—를 다루기 위해 안전 간격 경로 계획(SIPP)의 증명 가능하게 완전하고 최적인 확장판인 SIPP-IP를 제안한다. 이는 시간별 정지 시간과 가속 시간을 고려하기 위해 간격 투영을 도입함으로써 시간에 따른 정지 및 가속 가능성을 분석한다. 기존 SIPP나 단순한 변형과 달리 SIPP-IP는 동적 타당성에 기반한 안전 간격 모델링을 통해 불완전성 문제를 피하며, A* 대비 두 배수의 속도 향상을 이끌어내고 복잡한 동적 환경에서 불완전한 SIPP 변형들보다 완전성과 해의 품질 면에서 뛰어나다.

ABSTRACT

Safe Interval Path Planning (SIPP) is a powerful algorithm for solving single-agent pathfinding problem when the agent is confined to a graph and certain vertices/edges of this graph are blocked at certain time intervals due to dynamic obstacles that populate the environment. Original SIPP algorithm relies on the assumption that the agent is able to stop instantaneously. However, this assumption often does not hold in practice, e.g. a mobile robot moving with a cruising speed is not able to stop immediately but rather requires gradual deceleration to a full stop that takes time. In other words, the robot is subject to kinodynamic constraints. Unfortunately, as we show in this work, in such a case original SIPP is incomplete. To this end, we introduce a novel variant of SIPP that is provably complete and optimal for planning with acceleration/deceleration. In the experimental evaluation we show that the key property of the original SIPP still holds for the modified version -- it performs much less expansions compared to A* and, as a result, is notably faster.

연구 동기 및 목표

• 비가속성 가속 및 감속을 갖는 에이전트에 적용했을 때 기존 SIPP의 불완전성을 해결하기 위해.
• 시간에 따라 변화하는 장애물을 포함한 동적 환경에서 운동역학 제약 조건을 고려한 증명 가능하게 완전하고 최적의 경로 계획 알고리즘을 개발하기 위해.
• 실제 운동 역학 동역학을 고려하면서도 정확성을 확보하면서도 노드 확장을 최소화함으로써 SIPP의 효율성을 유지하기 위해.
• SIPP-IP가 성공률, 해 비용, 실행 시간 면에서 A*와 불완전한 SIPP 변형들보다 뛰어나다는 것을 경험적으로 검증하기 위해.

제안 방법

• 운동역학 제약 조건에 기반해 에이전트가 안전하게 정지하거나 가속할 수 있는 시간 간격을 모델링하기 위해 간격 투영을 도입한다.
• 시간별 정지 및 가속 시간을 고려해 SIPP의 안전 간격 전파를 수정함으로써 동적으로 타당한 전이만 고려하도록 보장한다.
• 부분적으로 겹치더라도 이동하는 장애물에 의해 차지된 간격을 보존하는 보수적인 충돌 검사 기법을 사용하며, 비정수 시간 제한은 안전을 확보하기 위해 가장 가까운 정수로 반올림한다.
• 다양한 지점에서 대기 행동을 고려할 수 있도록 하는 새로운 노드 확장 전략을 도입하여, 비타당한 경로로의 조기 결정을 피한다.
• SIPPwRT의 기법을 활용해 효율적인 재확장 및 비타당한 경로의 잘라내기를 지원하는 SIPP-IP를 구현한다.
• 다양한 지도에서 동적 장애물을 포함한 실험을 수행하여 SIPP-IP를 A*, SIPP1(운동역학 제약 조건이 있는 SIPP), SIPP2(재확장 강화된 SIPP)와 비교한다.

실험 결과

연구 질문

• RQ1 SIPP는 비가속성 가속 및 감속과 같은 운동역학 제약 조건을 다룰 수 있도록 확장될 수 있으며, 이때 완전성과 최적성을 유지할 수 있는가?
• RQ2 표준적인 SIPP 확장 방식은 운동역학 제약 조건이 도입되었을 때 왜 실패하는가? 완전성을 복원하기 위해 필요한 구조적 변경 사항은 무엇인가?
• RQ3 추가된 운동역학 타당성의 복잡성에도 불구하고 SIPP-IP는 노드 확장 수와 실행 시간 면에서 SIPP의 효율성을 유지하는가?
• RQ4 다양한 환경에서 SIPP-IP는 A*와 불완전한 SIPP 변형들에 비해 성공률, 해 비용, 계산 효율성 면에서 어떻게 비교되는가?

주요 결과

• SIPP-IP는 모든 테스트 지도에서 100%의 성공률를 기록했으며, A*는 많은 실행에서 노드 수 제한을 초과했고, SIPP1과 SIPP2는 불완전성으로 인해 낮은 성공률를 보였다.
• 평균적으로 SIPP-1과 SIPP-2가 해결하지 못한 모든 인스턴스를 SIPP-IP가 해결함으로써 운동역학 제약 조건 하에서의 완전성을 입증했다.
• 비용 비교 결과, SIPP1과 SIPP2는 SIPP-IP보다 더 높은 비용의 해를 산출했다: 'room' 지ap에서 SIPP1 해의 42%와 SIPP2 해의 22%가 SIPP-IP의 비용보다 50% 이상 높았다.
• A* 대비 실행 시간을 두 배수 감소시켰으며, 가장 큰 지도를 제외한 모든 지도에서 평균 실행 시간이 0.1초 이하였다.
• 더 보수적인 전략을 채택했음에도 불구하고 SIPP-2보다 실행 시간 면에서 뛰어나, SIPP-IP의 간격 투영 전략이 불필요한 확장을 줄임을 시사한다.
• 평균 실행 시간이 모든 지도(가장 큰 지도 제외)에서 0.1초 이하이므로 실시간 로봇 응용 분야에 적합하다.