[논문 리뷰] Inverse Kinematics with Forward Dynamics Solvers for Sampled Motion Tracking

Stefan Scherzinger, Arne Roennau외 1명|arXiv (Cornell University)|2019. 08. 17.

Robotic Mechanisms and Dynamics참고 문헌 11인용 수 17

한 줄 요약

이 논문은 샘플링된 운동 추적에서 역기구학(IK)에 대한 자코비안 전치 방법에 동역학 기반 개선을 제안한다. 가상의 조건화된 쌍둥이 로봇의 질량 행렬을 사용하여 수렴성과 부드러움을 향상시킨다. 정방향 동역학을 IK 해소기에 통합함으로써, 표준 자코비안 접근 방식에 비해 경로 정확도와 보간 품질이 향상되며, 실시간 성능을 확보한 채 UR10 로봇에서 검증되었다.

ABSTRACT

Tracking Cartesian motion with end~effectors is a fundamental task in robot control. For motion that is not known in advance, the solvers must find fast solutions to the inverse kinematics (IK) problem for discretely sampled target poses. On joint control level, however, the robot's actuators operate in a continuous domain, requiring smooth transitions between individual states. In this work, we present a boost to the well-known Jacobian transpose method to address this goal, using the mass matrix of a virtually conditioned twin of the manipulator. Results on the UR10 show superior convergence and quality of our dynamics-based solver against the plain Jacobian method. Our algorithm is straightforward to implement as a controller, using common robotics libraries.

연구 동기 및 목표

• 희소하게 샘플링된 직각좌표 목표 자세 사이에서 실시간 로봇 제어에서 부드럽고 타당한 관절 궤적을 생성하는 데 도전 과제를 해결하기 위해.
• 사전에 알려지지 않은 목표가 있는 운동 추적 응용 분야에서 역기구학 해소기의 수렴성과 궤적 품질을 향상시키기 위해.
• 완전한 동역학 모델 지식이 필요 없이도 기구의 동역학을 활용할 수 있는 단순하고 직관적이며 효율적인 자코비안 전치 방법의 확장 제공을 위해.
• 즉각적인 로봇 연구 및 응용 분야에서 사용 가능한 플러그 앤 플레이형 ROS 호환 컨트롤러 구현을 제공하기 위해.

제안 방법

• 표준 자코비안 전치 IK를 개선하기 위해, 일정한 보상 행렬 K를 로봇 기구의 가상의 쌍둥이 기구의 관성 행렬(H⁻¹)로 대체한다.
• 이 방법은 정방향 동역학 문제로 IK를 재구성한다: ¨q = H⁻¹JTf, 여기서 f는 직각좌표 오차 벡터(xd − g(q))이며, H는 가상의 질량 행렬이다.
• 가상의 쌍둥이 기구의 동역학은 코리olis 및 중력 항을 생략하여 관성 행렬에만 초점을 맞춰 계산 효율성과 직관적인 행동을 보장한다.
• 고정된 시간 간격 ∆t를 사용한 명시적 시간 적분(전진 오일러 방법)을 통해 관절 가속도를 계산하고 관절 위치를 반복적으로 갱신한다.
• 컨트롤러 보상 계수 kp는 전체 반응을 조정할 수 있게 하여 부드럽고 지연된 추적과 빠르고 정확한 수렴 사이에서 사용자가 튜닝할 수 있도록 한다.
• 이 방법은 ROS-제어 호환 컨트롤러로 구현되어 기존 로봇 시스템에 직접 통합 가능하다.

실험 결과

연구 질문

• RQ1 자코비안 전치 방법에 동역학 기반 수정을 가미하면 샘플링된 운동 추적에서 수렴 속도와 궤적 품질이 향상되는가?
• RQ2 일정한 보상 행렬 대신 가상의 조건화된 질량 행렬을 사용할 경우, 중간 관절 궤적의 부드러움과 타당성은 어떻게 영향을 받는가?
• RQ3 오차 감소와 보간 정확도 측면에서 제안된 방법이 표준 자코비안 전치 방법보다 얼마나 뛰어나게 성능을 발휘하는가?
• RQ4 의도적으로 실제 로봇과 다를 만한 비물리적 가상 질량 행렬을 사용함에도 불구하고, 실시간 로봇 제어 시스템에 효율적으로 구현 가능할 수 있는가?

주요 결과

• 제안된 방법은 표준 자코비안 전치 방법보다 유의미하게 더 빠른 수렴 속도를 달성하여 목표 자세에 도달하기 위한 반복 횟수를 줄였다.
• 제안된 방법은 경로 전반에 걸쳐 회전 오차가 거의 일정하게 유지되었고, 반면 자코비안 전치 방법은 시간이 지남에 따라 증가하는 회전 오차를 보였다.
• 보간 실험에서 제안된 방법은 목표 향한 부드럽고 일관된 직각좌표 경로를 생성한 반면, 자코비안 전치 방법은 왜곡되고 최적화되지 않은 궤적을 생성했다.
• 0.2 m/s로 움직이는 목표를 추적하는 데서 kp = 5일 경우, 부드럽고 정확한 추적과 최소한의 오버슈트를 달성했고, 더 높은 보상 계수(kp = 50)는 더 빠르고 정밀한 수렴을 가능하게 했다.
• 이 방법은 강인성과 실시간 실행 가능성을 입증했으며, 표준 하드웨어에서 10 kHz의 솔버 레이트에서도 성능 저하 없이 안정적으로 작동했다.
• 의도적으로 실제 로봇과 다를 만한 비물리적 질량 행렬을 사용함에도 불구하고 안정적이고 고품질의 해답을 도출했으며, 이는 파rameter 불일치에 대한 방법의 강인성을 확인시켰다.