[논문 리뷰] A Collision Cone Approach for Control Barrier Functions

Manan Tayal, Bhavya Giri Goswami외 6명|arXiv (Cornell University)|2024. 03. 11.

Robotic Path Planning Algorithms인용 수 4

한 줄 요약

이 논문은 충돌 원추 기하학과 제어 보행 함수를 통합하여 무인 지상 및 항공 차량의 충돌 회피를 보장하는 새로운 실시간 안전 프레임워크인 충돌 원추 제어 보행 함수(Collision Cone Control Barrier Functions, C3BFs)를 제안한다. 상대 속도를 충돌 원추 외부로 제약하여, 제곱형 프로그래밍 기반 제어를 통해 비보수적인 동적 장애물 주변의 안전한 항로를 확보한다. 터틀봇, 스토크-지프, 그리고 크레이지플라이 2.1 드론에서 검증되었으며, 고차수 CBFs보다 뛰어난 성능을 보였다.

ABSTRACT

This work presents a unified approach for collision avoidance using Collision-Cone Control Barrier Functions (CBFs) in both ground (UGV) and aerial (UAV) unmanned vehicles. We propose a novel CBF formulation inspired by collision cones, to ensure safety by constraining the relative velocity between the vehicle and the obstacle to always point away from each other. The efficacy of this approach is demonstrated through simulations and hardware implementations on the TurtleBot, Stoch-Jeep, and Crazyflie 2.1 quadrotor robot, showcasing its effectiveness in avoiding collisions with dynamic obstacles in both ground and aerial settings. The real-time controller is developed using CBF Quadratic Programs (CBF-QPs). Comparative analysis with the state-of-the-art CBFs highlights the less conservative nature of the proposed approach. Overall, this research contributes to a novel control formation that can give a guarantee for collision avoidance in unmanned vehicles by modifying the control inputs from existing path-planning controllers.

연구 동기 및 목표

• 기존의 제어 보행 함수가 동적 장애물을 다루는 데에 한계를 보이고 있으며 기하학적 직관이 부족한 점을 해결하기 위해.
• 지상(UGV) 및 항공(UAV) 차량에 모두 적용 가능한 통합된 실시간 안전 프레임워크를 개발하기 위해.
• 상대 속도 제약 기반의 기하학적으로 직관적인 접근 방식을 통해 공식적인 충돌 회피 보장을 제공하기 위해.
• 동적 장애물 조건 하에서 최신 기술인 고차수 CBFs보다 타당성과 안전성 면에서 뛰어나게 하기 위해.
• 다양한 로봇 플랫폼에서 시뮬레이션과 하드웨어 실험을 통해 접근 방식을 검증하기 위해.

제안 방법

• 충돌 원추의 기하 개념에 기반한 새로운 종류의 제어 보행 함수를 정식화하여, 차량과 장애물 간의 상대 속도가 원추 외부를 향하도록 보장한다.
• 유니클로이드, 자전거, 큼지개형 드론의 역학 모델에 대해 CBF-QP 설정을 유도하여 실시간으로 안전한 제어 입력을 계산한다.
• 이미 존재하는 경로 계획기 위에서 작동하는 빠르고 실시간적인 제어기로 작동하는 안전 필터 아키텍처를 사용한다.
• 정적 및 동적 장애물이 있는 점 질량, 유니클로이드, 자전거, 큼지개형 드론 모델에 적용한다.
• 제어 입력을 최적화하기 위해 제곱형 프로그래밍을 사용하며, 안전 집합의 전방 불변성을 보장하기 위해 C3BF 제약 조건을 강제한다.
• 파이빌트(PyBullet) 시뮬레이션과 터틀봇3, 스토크-지프, 크레이지플라이 2.1에서의 하드웨어 실험을 통해 프레임워크를 검증한다. 상태 추정에는 모션 캡처 기반 기법을 사용한다.

실험 결과

연구 질문

• RQ1 기하학적으로 직관적인 CBF 설정이 동적 장애물 회피에서 안전성 향상과 보수성 감소에 기여하는가?
• RQ2 제안된 C3BF 접근 방식은 고차수 CBFs와 비교해 타당성과 충돌 회피 성능 면에서 어떻게 다른가?
• RQ3 C3BF-QP 프레임워크는 UGV 및 UAV를 포함한 다양한 로봇 플랫폼에서 실시간 안전 보장을 보장할 수 있는가?
• RQ4 다수의 정적 및 동적 장애물이 존재하는 복잡한 상황에서도 이 방법이 강건성을 유지하는가?
• RQ5 다양한 운동학적 특성을 가진 다양한 차량 모델에 동일한 안전 필터를 균일하게 적용할 수 있는가?

주요 결과

• C3BF 접근 방식은 터틀봇3, 스토크-지프, 크레이지플라이 2.1에서 시뮬레이션 및 하드웨어 실험 모두에서 동적 장애물과의 충돌을 성공적으로 피했다.
• C3BF-QP 제어기는 장애물이 길거나 구형인 환경에서도 뛰어난 성능을 보였다.
• 고차수 CBFs(HO-CBFs)는 고속으로 접근하는 장애물을 피하지 못했고, 특히 투영 CBF 케이스에서 장거리 장애물에 대해 어려움을 겪었다. 반면 C3BF는 이에 비해 뛰어난 성능을 보였다.
• 하드웨어 실험을 통해 실시간 실행 가능성이 확인되었으며, 모션 캡처와 온보드 필터링을 사용해 제어 명령을 100 Hz로 계산하고 전송하였다.
• 동일한 안전 필터를 사용한 다중 에이전트 시나리오에서도 제어기는 안전한 경로를 유지하였으며, 확장성과 강건성을 입증하였다.
• C3BF 프레임워크는 공식적인 안전 보장을 제공하면서도, 기존 CBF 기반 방법보다 보수성이 낮았다.