[논문 리뷰] A Homotopy Method for Motion Planning

Shenyu Liu, Mohamed-Ali Belabbas|arXiv (Cornell University)|2019. 01. 29.

Robotic Path Planning Algorithms참고 문헌 15인용 수 4

한 줄 요약

이 논문은 초기 비제약 경로(일명 '스케치')를 호모토플리티 기반으로 변형하여, 힐버트, 비힐버트, 장애물 제약 조건을 모두 만족하는 타당한 경로로 변환하는 운동 계획 방법을 제안한다. 이는 제약 조건을 리만 메트릭에 통합함으로써 이루어지며, 기하학적 열 흐름을 사용해 경로를 진화시켜 복잡한 로봇 운동 계획 문제, 특히 다중 차량 간 충돌 회피 문제에 대해 효율적이고 확장 가능한 해법을 제공한다.

ABSTRACT

We propose a novel method for motion planning and illustrate its implementation on several canonical examples. The core novel idea underlying the method is to define a metric for which a path of minimal length is an admissible path, that is path that respects the various constraints imposed by the environment and the physics of the system on its dynamics. To be more precise, our method takes as input a control system with holonomic and non-holonomic constraints, an initial and final point in configuration space, a description of obstacles to avoid, and an initial trajectory for the system, called a sketch. This initial trajectory does not need to meet the constraints, except for the obstacle avoidance constraints. The constraints are then encoded in an inner product, which is used to deform (via a homotopy) the initial sketch into an admissible trajectory from which controls realizing the transfer can be obtained. We illustrate the method on various examples, including vehicle motion with obstacles and a two-link manipulator problem.

연구 동기 및 목표

• 홀로노믹, 비힐버트, 장애물 제약 조건을 통합한 유일한 프레임워크 내에서 새로운 계산 효율성이 뛰어난 운동 계획 방법을 개발하는 것.
• 초기 경로가 운동학적 또는 역학적 제약 조건을 만족할 필요 없이, 복잡한 동역학과 환경 제약 조건을 가진 시스템에 대해 타당한 경로를 생성하는 데 도전하는 것.
• 유명한 로봇 운동 계획 문제, 특히 차량 운동 및 다중 차량 간 충돌 회피를 포함한 협동 계획 문제에서 본 방법의 효과성을 입증하는 것.
• PDE 해의 정의 도메인이 항상 2차원을 유지하므로 고차원 구성 공간으로의 확장이 가능해지며, 차원의 저주를 피할 수 있음을 보여주는 것.

제안 방법

• 모든 제약 조건—홀로노믹, 비힐버트, 장애물 관련—을 내적을 통해 리만 메트릭에 통합함으로써, 최단 경로가 타당한 경로가 되는 기하학적 구조를 정의한다.
• 초기 스케치(시작 상태에서 종료 상태로 이어지는(piecewise differentiable) 곡선)로 시작하며, 이는 제약 조건을 만족할 필요가 없어, 특히 볼록 구성 공간에서는 쉽게 생성할 수 있다.
• 기하학적 열 흐름(GHF)을 적용하여 구성 공간 내에서 제약 조건에 의해 유도된 메트릭에 따라 곡선을 진화시켜 초기 스케치를 타당한 경로로 변형한다.
• GHF는 시간과 호모토플리티 매개변수로 매개변수화된 2차원 도메인에서 정의된 연속성 파라보릭 PDE 시스템으로 기술되며, 구성 공간 차원에 대해 다항식 스케일링을 보장한다.
• 장애물 회피는 기저 메트릭에 장애물에 가까워질수록 벌점을 주는 장벽 함수를 곱하여 구현되며, 다중 차량 시나리오에서는 대각선 부분공간도 포함된다.
• 최종 타당한 경로는 메트릭에 의해 유도된 속도를 통해 제어 입력을 직접 계산할 수 있어, 시스템의 실질적 경로 추적을 가능하게 한다.

실험 결과

연구 질문

• RQ1 비힐버트 시스템에 장애물 제약 조건이 존재할 경우, 제약이 없는 초기 스케치를 변형하여 타당한 경로를 효율적으로 생성할 수 있는가?
• RQ2 홀로노믹, 비힐버트, 장애물 제약 조건을 하나의 리만 메트릭에 통합하여 경로 변형을 이끌 수 있는가?
• RQ3 고차원 구성 공간에서 PDE 해의 정의 도메인이 항상 2차원이므로, 본 방법이 차원의 저주를 피할 수 있는가?
• RQ4 다중 차량 운동 계획 문제에 대해, 대각선 회피를 포함한 블록 대각선 메트릭에 제약 조건을 통합함으로써 본 방법을 확장할 수 있는가?
• RQ5 실제 로봇 운동 계획 작업에 대해 기하학적 열 흐름을 풀이하는 데 소요되는 계산 효율성은 어떠한가?

주요 결과

• 본 방법은 전복 제약 조건이 있는 유니클라이클에 대해 초기 스케치를 타당한 경로로 변형하여 부드럽고 실현 가능한 경로를 생성함으로써, 운동학적 제약 조건을 준수함을 입증하였다.
• 두 대의 유니클라이클이 위치를 교환하는 문제에서, 알고리즘은 초기 원형 스케치를 두 개의 V자형 경로로 변형하여, 두 차량이 방향성 제약과 충돌 제약을 위반하지 않고 위치를 교환할 수 있도록 하였다.
• 다중 차량 운동 계획 문제에서는, 제품 구성 공간에 대각선 장애물을 통합하고 블록 대각선 메트릭에 장벽 함수를 적용함으로써 충돌 회피를 달성하였다.
• 기하학적 열 흐름 해법기는 효율적으로 스케일링되며, 최적화되지 않은 MATLAB 코드를 사용한 표준 랩탑에서 계산 시간이 몇 초에서 수 분 수준이었으며, 실용적 타당성이 높음을 시사한다.
• PDE 도메인이 항상 2차원이므로, 구성 공간의 차원에 비례해 보간점의 수가 지수적으로 증가하지 않고 선형적으로 증가하므로, 본 방법은 차원의 저주를 피한다.
• 본 방법은 최종 경로의 메트릭에 의해 유도된 속도에서 직접 제어 입력을 계산할 수 있어, 실질적인 경로 추적을 위한 실용적인 길을 제공한다.