32.7 회전 관절의 기하학적 자코비안 열 벡터

32.7 회전 관절의 기하학적 자코비안 열 벡터

회전 관절(revolute joint)의 기하학적 자코비안 열 벡터는 해당 관절이 엔드 이펙터의 순간 운동에 기여하는 선속도와 각속도 성분을 정량적으로 표현한다. 회전 관절은 관절 축 주위의 회전만을 허용하므로 각속도는 관절 축 방향으로 직접 생성되며, 선속도는 관절 축을 중심으로 하는 회전이 엔드 이펙터 위치에 만드는 접선 속도로 나타난다. 본 절에서는 회전 관절의 자코비안 열 벡터의 수학적 유도, 기하학적 해석, 좌표계 선택, 필요한 기하학적 정보, 특수 상황, 그리고 대표적 예시를 학술적으로 다룬다.

1. 회전 관절의 순간 운동학적 기여

회전 관절 i는 관절 축 방향 단위 벡터 \hat{z}_{i-1} 주위의 순수 회전만을 허용하며, 관절 변수는 회전 각 q_i = \theta_i이다. 관절 이전 링크가 고정된 상태에서 관절 i만이 관절 속도 \dot{\theta}_i로 동작할 때, 관절 i 이후 모든 강체는 다음과 같은 공통된 각속도를 획득한다.

\vec{\omega}_i = \dot{\theta}_i \, \hat{z}_{i-1}

관절 축 벡터 \hat{z}_{i-1}은 기저 좌표계에서 표현된 단위 벡터이며, 순기구학의 동차 변환 {}^0\mathbf{T}_{i-1}로부터 회전 부분의 z축 열로 추출된다. 관절 축 주위의 회전 운동은 관절 축 상에 위치하지 않은 강체 위 점들에 접선 방향 선속도를 생성한다.

32.7.2 선속도 성분의 유도

강체 운동학의 기본 관계식에 따라, 강체 위 두 점 O(기준점)와 P(관심점)의 선속도 관계는 다음과 같이 주어진다.

\vec{v}_P = \vec{v}_O + \vec{\omega} \times (\vec{p}_P - \vec{p}_O)

회전 관절 i만이 동작하고 관절 i 이전의 모든 관절이 고정된 상황을 가정하면, 관절 i의 원점 \vec{p}_{i-1}은 정지해 있으므로 \vec{v}_{i-1} = \vec{0}이다. 엔드 이펙터의 원점 위치를 \vec{p}_n이라 할 때, 이 공식을 적용하면 엔드 이펙터 원점의 선속도는 다음과 같이 유도된다.

\vec{v}_n = \vec{\omega}_i \times (\vec{p}_n - \vec{p}_{i-1}) = \dot{\theta}_i \, \hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1})

관절 속도 \dot{\theta}_i = 1로 정규화하면 관절 i의 단위 속도에 대한 엔드 이펙터 선속도 기여가 얻어진다.

\vec{J}_{v,i} = \hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1}) \in \mathbb{R}^3

각속도 기여는 관절 축 방향 자체이다.

\vec{J}_{\omega,i} = \hat{z}_{i-1} \in \mathbb{R}^3

32.7.3 열 벡터의 최종 형식

회전 관절 i에 대응하는 기하학적 자코비안의 열 벡터는 선속도 성분과 각속도 성분을 수직으로 결합한 6차원 벡터로 표현된다.

\vec{J}_i = \begin{bmatrix} \vec{J}_{v,i} \\ \vec{J}_{\omega,i} \end{bmatrix} = \begin{bmatrix} \hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1}) \\ \hat{z}_{i-1} \end{bmatrix} \in \mathbb{R}^6

이 공식은 Whitney의 고전적 정식화(1972) 이후 로봇 기구학의 표준 결과로 확립되어 왔으며, 관절 축 방향과 관절 원점 위치, 엔드 이펙터 위치만을 이용하여 계산된다.

상단 3행 \vec{J}_{v,i}는 관절 i의 단위 회전 속도가 엔드 이펙터에 만드는 선속도이고, 하단 3행 \vec{J}_{\omega,i}는 관절 i의 단위 회전 속도가 엔드 이펙터에 만드는 각속도이다. 두 성분은 관절 속도 \dot{\theta}_i로 스케일링되어 엔드 이펙터 6차원 속도에 기여한다.

2. 필요한 기하학적 정보와 추출 방법

회전 관절의 자코비안 열 벡터 계산에는 다음 세 가지 기하학적 정보가 요구된다.

관절 축 방향 벡터 \hat{z}_{i-1}은 관절 i의 회전 축을 기저 좌표계에서 표현한 단위 벡터이며, 순기구학의 동차 변환 {}^0\mathbf{T}_{i-1}의 회전 부분 {}^0\mathbf{R}_{i-1}의 3열로부터 직접 추출된다.

\hat{z}_{i-1} = {}^0\mathbf{R}_{i-1} \, [0, 0, 1]^\top

관절 원점 위치 벡터 \vec{p}_{i-1}은 관절 i의 좌표계 원점을 기저 좌표계에서 표현한 위치 벡터이며, {}^0\mathbf{T}_{i-1}의 병진 부분으로 직접 주어진다.

엔드 이펙터 위치 벡터 \vec{p}_n은 엔드 이펙터 원점을 기저 좌표계에서 표현한 위치 벡터이며, {}^0\mathbf{T}_n의 병진 부분이다.

이들 기하학적 정보는 순기구학 계산에서 자연스럽게 얻어지므로, 자코비안 구성은 순기구학 연산의 부산물로 효율적으로 수행된다.

32.7.5 기하학적 해석

32.7.5.1 각속도 성분: 관절 축 그 자체

각속도 열 벡터 \vec{J}_{\omega,i} = \hat{z}_{i-1}은 회전 관절 i의 회전 축 방향이다. 이는 회전 관절이 엔드 이펙터에 기여하는 각속도가 오직 관절 축 방향으로만 존재한다는 물리적 사실을 반영한다. 관절 축 방향이 단위 벡터이므로 크기는 항상 1이며, 실제 크기는 관절 속도 \dot{\theta}_i에 의해 스케일링된다.

32.7.5.2 선속도 성분: 레버 암과 외적

선속도 열 벡터 \vec{J}_{v,i} = \hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1})은 관절 축 벡터와 관절 원점으로부터 엔드 이펙터까지의 상대 위치 벡터의 외적이다. 외적의 기하학적 의미에 따라 이 벡터는 두 인수 모두에 수직이며, 크기는 다음과 같이 주어진다.

\|\vec{J}_{v,i}\| = \|\hat{z}_{i-1}\| \, \|\vec{p}_n - \vec{p}_{i-1}\| \, \sin \alpha

여기서 \alpha는 관절 축 \hat{z}_{i-1}과 상대 위치 벡터 \vec{p}_n - \vec{p}_{i-1} 사이의 각이다. 이는 기계역학에서 토크 해석에 등장하는 레버 암(lever arm) 개념에 대응한다. 엔드 이펙터가 관절 축으로부터 수직 방향으로 멀리 떨어져 있을수록 선속도 기여가 커지며, 관절 축 근방에서는 작아진다.

2.1 수직성과 방향

외적의 성질에 의해 \vec{J}_{v,i}는 관절 축 \hat{z}_{i-1}에 수직이고, 상대 위치 벡터 \vec{p}_n - \vec{p}_{i-1}에도 수직이다. 물리적으로 이는 회전으로 인한 순간 선속도가 항상 회전 반지름에 수직한 접선 방향임을 의미한다.

3. 특수 상황과 기여의 소멸

회전 관절의 선속도 기여 \vec{J}_{v,i} = \hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1})이 영 벡터가 되는 경우가 존재한다.

엔드 이펙터가 관절 축 위에 있는 경우: \vec{p}_n = \vec{p}_{i-1}이거나 상대 위치 벡터가 관절 축과 평행한 경우 외적이 0이 된다. 이때 관절 i의 회전은 엔드 이펙터의 각속도만 생성하고 선속도는 생성하지 않는다.

관절 축과 상대 위치 벡터가 평행한 경우: (\vec{p}_n - \vec{p}_{i-1}) \parallel \hat{z}_{i-1}이면 외적이 0이 되며, 위와 동일한 상황에 해당한다. 대표적인 예로 산업용 매니퓰레이터의 손목 중심이 엔드 이펙터와 일치하도록 설계된 구성이 있다.

이러한 상황은 자코비안 행렬의 계수 감소(rank deficiency)와 관련될 수 있으며, 기구학적 특이점의 한 유형으로 나타난다.

4. 좌표계 선택과 표현

회전 관절의 자코비안 열 벡터는 어느 좌표계에서 표현하느냐에 따라 수치적 성분이 달라진다.

기저 좌표계 표현: 일반적으로 {}^0\vec{J}_i의 형태로 기저 좌표계에서 표현되며, 이는 세계 좌표계 기준의 엔드 이펙터 속도 제어에 자연스럽다.

엔드 이펙터 좌표계 표현: 엔드 이펙터 좌표계에서 표현된 자코비안은 힘·임피던스 제어와 같이 엔드 이펙터 기준 좌표계에서의 속도와 힘이 중요한 제어 전략에 유리하다. 두 표현은 회전 행렬 {}^n\mathbf{R}_0 = ({}^0\mathbf{R}_n)^\top에 의해 다음과 같이 연결된다.

{}^n\vec{J}_{v,i} = {}^n\mathbf{R}_0 \, {}^0\vec{J}_{v,i}, \qquad {}^n\vec{J}_{\omega,i} = {}^n\mathbf{R}_0 \, {}^0\vec{J}_{\omega,i}

공간·물체 자코비안: 스크류 이론 관점에서 회전 관절의 열 벡터는 관절 축에 대응하는 스크류(screw)의 특정 표현이며, 공간 좌표계와 물체 좌표계에서의 표현이 수반 변환(adjoint transformation)에 의해 연결된다.

32.7.8 계산의 효율성과 재귀적 구현

회전 관절의 자코비안 열 벡터 계산은 단순한 외적과 벡터 감산 연산으로 구성되므로 실시간 제어에 적합하다. 실무 구현에서는 순기구학의 재귀적 계산과 통합된 재귀적 자코비안 알고리즘이 사용된다. 이러한 재귀적 구현은 \mathcal{O}(n) 시간 복잡도로 n 자유도 매니퓰레이터의 전체 자코비안을 계산하며, Orin과 Schrader의 효율적 자코비안 계산 연구(1984)가 그 고전적 근거를 제공한다.

재귀적 계산의 기본 단계는 다음과 같다. 첫째, 관절 i에 대하여 {}^0\mathbf{T}_{i-1}을 계산한다. 둘째, \hat{z}_{i-1}과 \vec{p}_{i-1}을 추출한다. 셋째, 엔드 이펙터 위치 \vec{p}_n이 이미 계산되어 있으면 상대 위치 \vec{p}_n - \vec{p}_{i-1}을 구하고 외적 \hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1})을 계산한다. 넷째, 열 벡터 \vec{J}_i를 조립한다.

32.7.9 대표적 예시

32.7.9.1 2자유도 평면 매니퓰레이터

평면 내에서 동작하는 2자유도 매니퓰레이터의 두 회전 관절 축이 모두 평면 법선 방향(z축)이고 링크 길이가 a_1, a_2일 때, 자코비안 열 벡터는 다음과 같이 계산된다. \hat{z}_0 = \hat{z}_1 = [0, 0, 1]^\top, \vec{p}_0 = \vec{0}, \vec{p}_1 = [a_1 c_1, a_1 s_1, 0]^\top, \vec{p}_2 = [a_1 c_1 + a_2 c_{12}, a_1 s_1 + a_2 s_{12}, 0]^\top (여기서 c_1 = \cos\theta_1, s_1 = \sin\theta_1, c_{12} = \cos(\theta_1+\theta_2), s_{12} = \sin(\theta_1+\theta_2)).

첫 번째 관절의 열 벡터는

\vec{J}_1 = \begin{bmatrix} \hat{z}_0 \times (\vec{p}_2 - \vec{p}_0) \\ \hat{z}_0 \end{bmatrix} = \begin{bmatrix} -a_1 s_1 - a_2 s_{12} \\ a_1 c_1 + a_2 c_{12} \\ 0 \\ 0 \\ 0 \\ 1 \end{bmatrix}

이며, 두 번째 관절의 열 벡터는

\vec{J}_2 = \begin{bmatrix} \hat{z}_1 \times (\vec{p}_2 - \vec{p}_1) \\ \hat{z}_1 \end{bmatrix} = \begin{bmatrix} -a_2 s_{12} \\ a_2 c_{12} \\ 0 \\ 0 \\ 0 \\ 1 \end{bmatrix}

이다.

32.7.9.2 공간 3자유도 매니퓰레이터

관절 축 방향이 서로 다른 공간 3자유도 매니퓰레이터의 경우 각 \hat{z}_{i-1}이 다른 방향을 가지므로 외적의 계산이 평면 사례보다 복잡하지만, 동일한 공식 \vec{J}_i = [\hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1}), \, \hat{z}_{i-1}]^\top가 그대로 적용된다.

32.7.9.3 6자유도 산업용 매니퓰레이터

모든 관절이 회전 관절인 6자유도 산업용 매니퓰레이터의 경우, 각 i = 1, \ldots, 6에 대하여 동일한 공식이 적용되어 6 \times 6의 정방 자코비안 행렬이 구성된다. 이러한 구조는 PUMA, Stäubli, Fanuc, ABB, KUKA 등 상용 6축 로봇의 속도 기구학 분석에 직접적으로 활용된다.

32.7.10 학술적 의의

본 절에서 정립한 회전 관절의 기하학적 자코비안 열 벡터 \vec{J}_i = [\hat{z}_{i-1} \times (\vec{p}_n - \vec{p}_{i-1}), \, \hat{z}_{i-1}]^\top는 로봇 공학에서 다음의 학술적 의의를 가진다. 첫째, 관절 축 방향과 관절·엔드 이펙터 위치라는 최소한의 기하학적 정보만으로 자코비안을 구성할 수 있는 명료한 공식을 제공한다. 둘째, 외적에 의한 선속도 기여는 강체 운동학의 기본 정리의 직접적 귀결로서 물리적 해석이 투명하다. 셋째, 회전 축이 방향 매개변수 선택에 독립적이므로 매개변수 특이점과 기구학적 특이점의 구분이 명확해진다. 넷째, 산업용 회전 관절 매니퓰레이터의 절대 다수에 보편적으로 적용되므로 실무적 가치가 높다. 다섯째, 스크류 이론과 리 군 기반 현대적 기구학과의 자연스러운 연결점을 제공한다.

출처

  • Whitney, D. E., “The mathematics of coordinated control of prosthetic arms and manipulators”, Journal of Dynamic Systems, Measurement, and Control, Vol. 94, No. 4, pp. 303–309, 1972.
  • Paul, R. P., Shimano, B., and Mayer, G. E., “Kinematic control equations for simple manipulators”, IEEE Transactions on Systems, Man, and Cybernetics, Vol. 11, No. 6, pp. 449–455, 1981.
  • Orin, D. E. and Schrader, W. W., “Efficient computation of the Jacobian for robot manipulators”, International Journal of Robotics Research, Vol. 3, No. 4, pp. 66–75, 1984.
  • Spong, M. W., Hutchinson, S., and Vidyasagar, M., Robot Modeling and Control, 2nd edition, Wiley, 2020.
  • Craig, J. J., Introduction to Robotics: Mechanics and Control, 4th edition, Pearson, 2018.
  • Siciliano, B., Sciavicco, L., Villani, L., and Oriolo, G., Robotics: Modelling, Planning and Control, Springer, 2009.
  • Lynch, K. M. and Park, F. C., Modern Robotics: Mechanics, Planning, and Control, Cambridge University Press, 2017.
  • Murray, R. M., Li, Z., and Sastry, S. S., A Mathematical Introduction to Robotic Manipulation, CRC Press, 1994.
  • Yoshikawa, T., Foundations of Robotics: Analysis and Control, MIT Press, 1990.

버전

  • 문서 버전: 1.1
  • 작성일: 2026-04-19