[논문 리뷰] Time Variable Minimum Torque Trajectory Optimization for Autonomous Excavator

Yajue Yang, Jia Pan외 3명|arXiv (Cornell University)|2020. 06. 01.

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

한 줄 요약

이 논문은 기계적 토양-도구 상호작용 모델을 통합한 시간 가변형 최소 토크 경로 최적화 방법을 제안한다. 이 방법은 핵심점 위치와 그 사이의 시간 간격을 동시에 최적화하여 기하학적, 운동학적, 동역학적 제약 조건을 만족하면서 토크와 시간 비용을 감소시킨다. 검증 결과, 다양한 토양 유형에 대해 적응 가능한 성능을 보이며 고정밀 시뮬레이터에서 성공적인 추적 성능을 확보하였다.

ABSTRACT

In this paper, we present a minimal torque and time variable trajectory optimization method for autonomous excavator considering the soil-tool interaction. The method formulates the excavation motion generation as a trajectory optimization problem and takes into account geometric, kinematic and dynamics constraints. To generate time-efficient trajectory and improve the overall optimization efficiency, we propose a time variable trajectory optimization mechanism so that the time intervals between the keypoints along the trajectory subject to the optimization. As a result, the method uses few keypoints and reduces the total number of optimization variables. We further introduce a soil-tool interaction force model, which considers the geometric shape of the bucket and the physical properties of the soil. The experimental result on a high fidelity dynamic simulator shows our method can generate feasible trajectories, which satisfy excavation task constraints and are adaptive to different soil conditions.

연구 동기 및 목표

• 굴착 중 관절 토크 요구량을 최소화하면서 시간 효율성을 확보하는 경로 최적화 프레임워크를 개발한다.
• 다양한 토양 조건 하에서 동적으로 실현 가능하고 적응 가능한 굴착 동작을 생성하는 문제를 해결한다.
• 밀도 높은 파arameterization 대신 소수의 핵심점과 가변 시간 간격을 사용하여 최적화 복잡도를 감소시킨다.
• 지게 형상과 토양 특성(밀도, 응집력, 감쇠 계수)을 고려한 현실적인 토양-도구 상호작용 힘 모델을 통합하여 경로의 실현 가능성을 향상시킨다.
• 핵심점 간 자율적인 시간 할당을 통해 최적화 수렴성과 성능을 향상시킨다.

제안 방법

• 기하학적, 운동학적, 동역학적 제약 조건을 포함한 경로 최적화 문제로 굴착 동작 계획을 수식화한다.
• 최소한의 핵심점을 최적화 변수로 사용하고, 고정된 시간 간격에서 선형 보간을 적용한다.
• 시간 간격 자체를 최적화하는 시간 가변 메커니즘을 도입하여 동적 시간 할당을 가능하게 한다.
• 리커시브 역운동역학을 리 군(Manifold) 기반으로 적용하여 경로 전역에서 관절 토크를 효율적으로 계산한다.
• 지게 형상과 토양 특성(밀도, 응집력, 감쇠 계수)을 고려한 토양-도구 상호작용 힘 모델을 도입한다.
• 도달 가능 맵 기반 운동학 방법을 사용하여 최적화를 위한 초기 실현 가능한 경로를 생성한다.

실험 결과

연구 질문

• RQ1 시간 가변형 경로 최적화 프레임워크는 자율 굴착기 운동 계획에서 토크 및 시간 비용을 줄일 수 있는가?
• RQ2 핵심점 위치와 시간 간격을 동시에 최적화하는 것이 고정 시간 방법에 비해 경로 효율성을 어떻게 향상시키는가?
• RQ3 물리 기반 상호작용 모델링을 통해 이 방법은 어떤 정도 다양한 토양 조건에 적응할 수 있는가?
• RQ4 모델 불일치가 존재하더라도 최적화된 경로는 고정밀 동적 시뮬레이터에서 성공적으로 추적될 수 있는가?
• RQ5 스위프트 볼륨 및 방향 제약 조건의 포함이 경로 실현 가능성과 성능에 어떤 영향을 미치는가?

주요 결과

• 시간 가변 최적화로 전체 경로 소요 시간이 고정 시간 기준 6.4 s에서 5.5 s로 감소하여 시간 효율성이 향상되었다.
• 최적화된 경로는 가속도와 시간의 균형을 통해 총 토크 비용을 낮추어 에너지 효율성을 향상시켰다.
• 이 방법은 딱딱한 토양에 대해 얕은 경로를, 부드러운 토양에 대해 깊은 경로를 생성하여 인간 운전사의 행동과 토양역학 이론 예측과 일치시켰다.
• 최적화된 경로는 AGX 시뮬레이터에서 성공적으로 추적되었으며, 시뮬레이션과 최적화 간 관절 토크 프로파일이 일관성을 유지했다.
• 최적화 전반에 걸쳐 부피 제약 조건이 충족되었고, 초기 스위프트 볼륨이 0.8 m³ 이하로 유지되어 충분한 재료 제거가 보장되었다.
• 역운동역학 목적 함수는 잘 조절되어 있어 다양한 토양 특성 조건에서도 낮은 토크 해에 수렴할 수 있었다.