[논문 리뷰] Stability Constrained Mobile Manipulation Planning on Rough Terrain

Jiazhi Song, Inna Sharf|arXiv (Cornell University)|2021. 05. 10.

Soil Mechanics and Vehicle Dynamics인용 수 5

한 줄 요약

이 논문은 거친 지형에서 이동하는 로봇을 위한 실시간 궤적 계획 프레임워크를 제안하며, 동적 안정성을 확보하기 위해 영점 모멘트(Zero Moment Point, ZMP) 제약 조건을 적용한다. 샘플링 기반의 준정적 계획 알고리즘과 온도가 예열된 비선형 최적 제어를 융합함으로써, 안정성과 牽장(tractive) 성능을 확보하면서도 비구조적 환경에서 산업용 로봇을 위한 효율적인 온라인 계획을 가능하게 한다.

ABSTRACT

This paper presents a framework that allows online dynamic-stability-constrained optimal trajectory planning of a mobile manipulator robot working on rough terrain. First, the kinematics model of a mobile manipulator robot, and the Zero Moment Point (ZMP) stability measure are presented as theoretical background. Then, a sampling-based quasi-static planning algorithm modified for stability guarantee and traction optimization in continuous dynamic motion is presented along with a mathematical proof. The robot's quasi-static path is then used as an initial guess to warm-start a nonlinear optimal control solver which may otherwise have difficulties finding a solution to the stability-constrained formulation efficiently. The performance and computational efficiency of the framework are demonstrated through an application to a simulated timber harvesting mobile manipulator machine working on varying terrain. The results demonstrate feasibility of online trajectory planning on varying terrain while satisfying the dynamic stability constraint.

연구 동기 및 목표

• 거친 변화하는 지형에서 작동하는 이동 로봇의 실시간, 동적 안정성 제약 궤적 계획을 가능하게 하기 위해.
• 기존 이동 로봇 계획 프레임워크에서 안정성과 牽장 최적화의 통합 부족 문제를 해결하기 위해.
• 벌목 및 광산과 같은 자율 산업 응용 분야에서의 안전성, 생산성 및 에너지 효율성을 향상시키기 위해.
• 안정성 제약이 있는 최적 제어 문제를 해결하는 데 발생하는 계산적 과제를 예열 전략을 통해 극복하기 위해.

제안 방법

• ZMP 안정성과 연속적인 동적 운동 중의 牽장 최적화를 보장하도록 수정된 샘플링 기반 준정적 계획 알고리즘을 제안한다.
• 로봇이 동적 운동 중에 기울어지지 않도록 보장하기 위해 ZMP를 주요 안정성 척도로 사용한다.
• 동적 ZMP와 정적 ZMP 위치 간의 편차에 대한 분석적 경계를 유도하며, 작은 가속도에서는 ZMP 이동이 비례적으로 작다는 것을 증명한다.
• 준정적 계획기에서 유도된 초기 추측값을 활용해 비선형 최적 제어 솔버를 효율적으로 수렴시켜 안정적인 동적 궤적을 도출한다.
• 관절 운동, 질량 및 관성 파라미터를 기반으로 이동 로봇의 운동학 모델을 적용해 ZMP를 계산한다.
• 최적 제어 솔버의 수렴 속도를 향상시키기 위해 예열 전략을 구현함으로써 온라인 계획을 위한 계산 시간을 단축시킨다.

실험 결과

연구 질문

• RQ1 ZMP 안정성 제약 조건을 갖춘 샘플링 기반 계획기에서 거친 지형에서의 동적 이동 로봇 작업에 대해 실현 가능한 초기 궤적을 생성할 수 있는가?
• RQ2 일반적인 운동 입력 하에서 동적 ZMP가 정적 ZMP에서 얼마나 벗어날 수 있는지 분석적으로 경계할 수 있는가?
• RQ3 준정적 경로를 초기 추측값으로 사용할 경우 비선형 최적 제어 솔버의 수렴 속도에 어떤 영향을 미치는가?
• RQ4 이 프레임워크는 복잡하고 변화하는 지형 환경에서도 실시간 안정성 제약 궤적 계획을 가능하게 하는가?
• RQ5 안정성 제약이 없는 표준 최적 제어 방법과 비교해 본다면, 제안된 방법은 성능과 계산 효율성 면에서 어떤가?

주요 결과

• 이 프레임워크는 거친 지형에서 이동 로봇의 온라인 궤적 계획을 가능하게 하며, 동적 안정성 제약 조건을 충족시킨다.
• ZMP 편차에 대한 분석적 경계는 작은 가속도에서 ZMP 이동도 비례적으로 작다는 것을 보여주며, 동적 운동 중 안정성을 보장한다.
• 예열 전략은 비선형 최적 제어 솔버의 수렴 속도를 크게 향상시켜 실시간 성능을 가능하게 한다.
• 다양한 지형에서 ZMP가 지지 다각형 내부에 유지되어 넘어짐과 미끄러짐을 방지한다.
• 목재 수확용 이동 로봇에 대한 시뮬레이션 결과는 제안된 방법의 실현 가능성과 계산 효율성을 입증한다.
• 프레임워크는 ZMP 편차가 제한된 상태에서 전진 및 회전 운동 모두를 지원하며, 다양한 동적 조건 하에서도 견고함을 입증한다.