[논문 리뷰] Humanoid Path Planning over Rough Terrain using Traversability Assessment

Stephen McCrory, Bhavyansh Mishra외 4명|arXiv (Cornell University)|2022. 03. 01.

Robotic Locomotion and Control인용 수 4

한 줄 요약

이 논문은 거친 지형을 가로질러 매끄럽고 도착 가능하며 충돌 없는 경로를 생성하기 위해 2.5차원 고도 지도를 사용하는 이단계 humanoid 경로 계획 프레임워크를 제안한다. 이 방법은 A* 탐색과 새로운 이족보행 특성 고려 비용 함수를 결합하고, 기울기 기반 최적화를 통해 경로 품질을 향상시키며, DRC Atlas 로봇을 사용하여 시뮬레이션 및 실제 환경에서의 안정적인 주행을 입증한다.

ABSTRACT

We present a planning framework designed for humanoid navigation over challenging terrain. This framework is designed to plan a traversable, smooth, and collision-free path using a 2.5D height map. The planner is comprised of two stages. The first stage consists of an A* planner which reasons about traversability using terrain features. A novel cost function is presented which encodes the bipedal gait directly into the graph structure, enabling natural paths that are robust to small gaps in traversability. The second stage is an optimization framework which smooths the path while further improving traversability. The planner is tested on a variety of terrains in simulation and is combined with a footstep planner and balance controller to create an integrated navigation framework, which is demonstrated on a DRC Boston Dynamics Atlas robot.

연구 동기 및 목표

• 비정형이고 거친 지형, 장애물, 불균일한 표면이 있는 환경에서 자율적인 humanoid 주행 문제를 해결한다.
• 이족보행의 생체역학을 반영하여 자연스럽고 안정적이며 안전한 경로를 생성하는 경로 계획자를 개발한다.
• 실제 humanoid 로봇에서 종단간 주행을 위해 경로 계획자와 발자국 계획자, 균형 제어기를 통합한다.
• 이중 단계 접근법을 통해 경로 품질을 향상시킨다: 보행 특성 고려 비용 함수를 사용한 A* 탐색 이후 기울기 기반 스무딩.
• 시뮬레이션 및 하드웨어 실험에서 센서 노이즈와 실제 지형 변화에 대한 강건성을 입증한다.

제안 방법

• 지형 기하학을 표현하기 위해 2.5차원 고도 지도를 입력으로 사용하여 경로 계획을 위한 효율적인 공간 추론을 가능하게 한다.
• 각 노드가 지형 기울기, 거칠기, 윤곽 특징에서 유도된 도착 가능성 비용을 포함하는 샘플링된 그래프 위에서 A* 탐색을 구현한다.
• 이족보행 보행 특성 제약 조건을 그래프 구조에 직접 통합하여 안정적이고 자연스러운 보행 경로를 선호하는 새로운 비용 함수를 설계한다.
• 윤곽 비용 항목을 도입하여 경로가 지형 가장자리의 위험을 피하고 안정적인 중심 발자국 위치를 선호하도록 유도한다.
• 기울기 강하 최적화를 적용하여 초기 A* 경로를 스무딩하면서 도착 가능성 향상과 날카운 전환 감소를 추가로 달성한다.
• LIDAR 데이터에서 유도된 평면 영역 분할을 사용하여 실시간 발자국 계획자 및 균형 제어기와 경로 계획자를 통합한다.

실험 결과

연구 질문

• RQ1 어떻게 humanoid 로봇을 위한 경로 계획자가 그래프 기반 탐색에 이족보행 보행 역학을 효과적으로 통합하여 자연스럽고 안정적인 경로를 생성할 수 있는가?
• RQ2 기울기, 거칠기, 윤곽 특징 등의 도착 가능성 지표가 불균일하고 장애물이 많은 지형에서 경로 품질을 얼마나 향상시킬 수 있는가?
• RQ3 A* 이후 기울기 기반 스무딩을 적용한 이중 단계 계획 파이프라인은 A*만 사용했을 때보다 더 매끄럽고 도착 가능성이 높은 경로를 생성할 수 있는가?
• RQ4 실제 환경에서 센서 노이즈와 상태 추정 오차가 있을 경우 이 계획자는 어떻게 성능을 발휘하는가?
• RQ5 이 경로 계획자는 실제 humanoid 로봇의 전체 주행 스택에서 저수준 발자국 계획자에 효과적인 히우리스틱으로 작동할 수 있는가?

주요 결과

• 제안된 계획자는 시뮬레이션과 하드웨어 실험 모두에서 기울기, 계단, 시멘트 블록, 발판 돌 등 다양한 지형에서 매끄럽고 충돌 없으며 도착 가능한 경로를 성공적으로 생성했다.
• 보행 특성 고려 비용 함수의 통합은 특히 불균일한 표면에서 안정적이고 중심에 위치한 발자국 위치를 선호하고 가장자리 근접도를 감소시켜 경로 품질을 크게 향상시켰다.
• 윤곽 비용 항목은 로봇이 경사면을 자르는 대신 기슭을 따라 오르내리는 방식으로 경로를 안정적으로 이동하도록 효과적으로 유도했다.
• IHMC 균형 제어기 및 발자국 계획자와의 통합을 통해 DRC Atlas 로봇에서 성공적인 주행이 가능했으며, 센서 노이즈가 있음에도 실행된 발자국이 계획된 경로와 밀도 있게 따라갔다.
• 경로가 발판 돌에서 이상적인 중심선에서 약간 벗어나도 로봇이 안정적인 보행을 유지할 수 있었기 때문에, 경로 계획자는 미세한 지형 변화와 센서 오차에 강건함을 입증했다.
• 이중 단계 접근법(보행 특성 고려 비용 함수를 사용한 A* 탐색 이후 기울기 기반 스무딩)은 원시 A* 출력 대비 더 매끄러운 궤적과 날카운 전환 감소, 향상된 도착 가능성으로 이어졌다.