[논문 리뷰] Time Derivative of Rotation Matrices: A Tutorial

Shiyu Zhao|arXiv (Cornell University)|2016. 09. 20.

Robotic Mechanisms and Dynamics참고 문헌 4인용 수 6

한 줄 요약

이 튜토리얼은 회전 행렬의 시간 도함수를 회전 운동학을 사용하여 유도하며, 이 도함수가 각속도를 나타내는 반대칭 행렬과 회전 행렬 자체의 곱과 같음을 보여준다. 주요 기여는 반대칭 행렬을 세계 프레임 또는 본체 프레임에 따라 표현된 각속도 벡터로 물리적으로 해석하는 것으로, 로봇 공학 및 IMU 기반 운동 추정에 실용적인 응용이 가능하다.

ABSTRACT

The time derivative of a rotation matrix equals the product of a skew-symmetric matrix and the rotation matrix itself. This article gives a brief tutorial on the well-known result.

연구 동기 및 목표

• 반대칭 행렬이 회전 행렬 도함수에 있어 물리적 의미를 명확히 하기 위해.
• 기본적인 회전 행렬 도함수 공식에서 각속도 벡터의 기준 프레임에 대한 모호함을 해결하기 위해.
• 로봇 공학 및 제어 시스템에 사용 가능한 물리적으로 해석 가능한 자세 운동학 방정식의 유도를 제공하기 위해.
• IMU를 통해 본체 프레임에서 각속도를 측정할 때 도함수 공식의 실용적 유용성을 입증하기 위해.

제안 방법

• 고정된 본체 프레임 $ B $ 에서 움직이는 점의 운동을 분석하여 $ R_B^A $ 의 시간 도함수를 유도한다. 관계식 $ \dot{P}_A = \dot{R}_B^A P_B $ 를 사용한다.
• 세계 프레임에서의 선속도와 각속도를 연결하기 위해 운동학적 관계식 $ \dot{P}_A = w_A \times P_A = [w_A]_\times P_A $ 를 사용한다.
• 두 가지 $ \dot{P}_A $ 표현식을 동치로 놓아 $ \dot{R}_B^A = [w_A]_\times R_B^A $ 를 도출한다. 여기서 $ w_A $ 는 세계 프레임에서의 각속도이다.
• 본체 고정 각속도 $ w_B $ 를 사용하여 도함수를 재구성하여 $ \dot{R}_B^A = R_B^A [w_B]_\times $ 를 얻는다. 이는 IMU 측정값과 직접적으로 사용 가능하다.
• 반대칭 행렬 간의 프레임 변환을 위해 항등식 $ [R w]_\times = R [w]_\times R^T $ 를 적용한다.
• 2차원에서의 결과를 유도하여 3차원 공식의 특수 케이스로 확인한다: $ \dot{R}_\alpha = [-\sin\alpha \; -\cos\alpha; \; \cos\alpha \; -\sin\alpha] \dot{\alpha} $.

실험 결과

연구 질문

• RQ1 반대칭 행렬이 회전 행렬 도함수에 있어 물리적 의미는 무엇인가?
• RQ2 각속도의 기준 프레임 선택이 회전 행렬 도함수의 형태에 어떻게 영향을 미치는가?
• RQ3 왜 본체 고정 각속도를 포함하는 방정식이 IMU를 갖춘 로봇 시스템에서 더 실용적인가?
• RQ4 세계 프레임과 본체 프레임의 기원이 일치하지 않을 경우, 표준 도함수 공식이 여전히 유효한 조건은 무엇인가?
• RQ5 2차원에서의 회전 행렬 도함수는 3차원 공식의 특수 케이스로 어떻게 도출될 수 있는가?

주요 결과

• 시간 도함수 $ \dot{R}_B^A $ 는 $ \dot{R}_B^A = [w_A]_\times R_B^A $ 로 주어지며, 여기서 $ w_A $ 는 세계 프레임에서의 각속도이다.
• 도함수는 또한 $ \dot{R}_B^A = R_B^A [w_B]_\times $ 로 표현될 수 있으며, 여기서 $ w_B $ 는 본체 프레임에서의 각속도로, IMU를 통해 직접 측정 가능하다.
• 본체 프레임에서 각속도를 측정할 경우, 세계 프레임에 대해 본체 프레임이 이동하더라도 공식 $ \dot{R}_B^A = R_B^A [w_B]_\times $ 는 그대로 유효하다.
• 반대칭 행렬 $ [w_A]_\times $ 와 $ [w_B]_\times $ 는 $ [w_A]_\times = R_B^A [w_B]_\times (R_B^A)^T $ 를 통해 관련되어 있으며, 이는 프레임 간 변환을 가능하게 한다.
• 2차원에서의 도함수 $ \dot{R}_\alpha $ 는 $ w_B = \dot{\alpha} e_3 $ 일 때 3차원 결과와 일치하여 차원 간 일관성을 확인한다.
• 식 (6)과 (8)은 본체 고정 각속도를 사용하므로 세계 프레임 각속도를 사용하는 식보다 실시간 로봇 응용에 더 실용적이다.