[논문 리뷰] DiffPills: Differentiable Collision Detection for Capsules and Padded Polygons

Kevin Tracy, Taylor A. Howell외 1명|arXiv (Cornell University)|2022. 07. 01.

Robotic Path Planning Algorithms인용 수 4

한 줄 요약

이 논문은 충돌 쿼리를 미분 가능한 볼록 2차 계획문으로 공식화하여 캡슐과 패딩된 다각형에 대한 미분 가능한 충돌 검출 프레임워크인 DiffPills를 소개한다. 이 방법은 전반적인 기울기 지원을 통해 접근 거리 값과 가장 가까운 점을 계산하며, 궤도 최적화, 상태 추정 및 강화 학습과 같은 기울기 기반 로봇 워크플로우에 통합할 수 있다.

ABSTRACT

Collision detection plays an important role in simulation, control, and learning for robotic systems. However, no existing method is differentiable with respect to the configurations of the objects, greatly limiting the sort of algorithms that can be built on top of collision detection. In this work, we propose a set of differentiable collision detection algorithms between capsules and padded polygons by formulating these problems as differentiable convex quadratic programs. The resulting algorithms are able to return a proximity value indicating if a collision has taken place, as well as the closest points between objects, all of which are differentiable. As a result, they can be used reliably within other gradient-based optimization methods, including trajectory optimization, state estimation, and reinforcement learning methods.

연구 동기 및 목표

• 시뮬레이션, 계획, 학습에서 기울기 기반 최적화의 사용을 제한하는 로봇 분야에서의 미분 가능한 충돌 검출의 부족을 해결한다.
• 기하학적 원소로 캡슐과 패딩된 다각형을 사용하여 복잡한 형상에 대해 정확하고 미분 가능한 접촉 모델링을 가능하게 한다.
• 기울기 전파를 지원하기 위해 충돌 검출을 미분 가능한 볼록 최적화 문제로 공식화한다.
• 캡슐과 패딩된 다각형 모두의 물체 구성(위치, 방향)에 대한 기울기 계산을 지원한다.
• 궤도 최적화와 같은 실제 로봇 작업에서의 적용 가능성을 입증한다. 충돌 회피 제약 조건을 포함한 궤도 최적화를 예로 들 수 있다.

제안 방법

• 캡슐과 패딩된 다각형을 기하학적 원소로 모델링하여, 충돌 여부를 가장 가까운 점들 간의 접근 거리로 결정한다.
• 물체 구성에 따라 매개변수화된 부등식 제약 조건이 있는 볼록 2차 계획문(QP)으로 충돌 검출 문제를 공식화한다.
• 프리멀-듀얼 내점법과 메르트라 예측-수정 단계를 사용하여 QP를 풀며, 자동 미분를 통한 미분 가능한 최적화를 가능하게 한다.
• KKT 조건과 은둔함수정리(implicit function theorem)를 이용해 접근 거리 값과 가장 가까운 점의 기울기를 유도하며, QP 해를 통해 기울기를 전파한다.
• 캡슐과 다각형의 가장 가까운 점을 파arametric 표현 기반의 해석적 식을 사용해 QP 해 변수로부터 복원한다.
• ALTRO와 같은 기울기 인식 최적화 솔버를 사용하여 기울기 기반 최적화 파이프라인에 미분 가능한 충돌 검출을 통합한다.

실험 결과

연구 질문

• RQ1 캡슐과 패딩된 다각형 간의 충돌 검출이 물체 구성에 대해 완전히 미분 가능하게 만들 수 있는가?
• RQ2 볼록 최적화를 사용하여 접근 거리와 가장 가까운 점 정보를 어떻게 미분적으로 계산할 수 있는가?
• RQ3 미분 가능한 충돌 검출이 기울기 기반 운동 계획의 성능과 실행 가능성에 얼마나 기여하는가?
• RQ4 제안된 미분 가능한 QP 공식화가 로봇 워크로드에서 계산적이고 수치적으로 안정적인가?
• RQ5 프레임워크를 사용하여 궤도 최적화에서 매끄럽고 미분 가능한 충돌 회피 제약 조건을 강제로 적용할 수 있는가?

주요 결과

• 제안된 방법은 기울기 기반 볼록 QP 해법을 사용하여 캡슐과 패딩된 다각형 간의 미분 가능한 접근 거리 값과 가장 가까운 점을 성공적으로 계산한다.
• QP 해를 통해 은둔 미분을 사용하여 캡슐과 다각형 구성에 대한 접근 거리 값의 기울기를 계산하며, 기울기 전파를 가능하게 한다.
• 메서드는 ALTRO 궤도 최적화기와 성공적으로 통합되어 정지된 캡슐을 회피하는 타당하고 최적의 궤도를 생성하였다.
• Julia로 구현된 오픈소스 구현체(DiffPills.jl)는 재현 가능성과 로봇 연구 파이프라인 내 통합을 가능하게 한다.
• 미분 가능한 충돌 검출은 구형 유지 영역의 한계를 극복하고, 기울기 기반 학습 및 제어에서 캡슐과 패딩된 다각형과 같은 표현력 있는 원소를 사용할 수 있도록 한다.
• 충돌 경계에서도 조건이 불연속적이더라도 매끄럽고 연속적인 기울기를 지원하여, 비연속적인 접촉 상황에서도 안정적인 최적화를 가능하게 한다.