17.24 관절 공간과 작업 공간 동역학의 변환

17.24 관절 공간과 작업 공간 동역학의 변환

1. 개요

로봇의 동역학은 관절 공간과 작업 공간이라는 서로 다른 두 좌표계에서 표현될 수 있으며, 실제 제어와 해석에서는 두 표현 사이의 상호 변환이 빈번히 요구된다. 구동기와 직접 연관되는 것은 관절 공간이지만, 과업 목표와 성능 지표는 대개 작업 공간에서 정의되기 때문이다. 본 절은 관절 공간 동역학과 작업 공간 동역학 사이의 수학적 변환 관계를 체계적으로 정리하고, 두 표현이 상호 유도되는 과정에서 나타나는 자코비안의 역할, 영공간의 처리, 가상 일의 보존, 특이점 근방의 수치적 고려 사항을 서술한다. 본 절의 관점은 변환 자체에 초점이 맞추어지며, 각 공간에서의 개별 동역학 방정식은 앞선 절들에서 제시된 내용을 전제로 한다.

2. 속도와 가속도 수준의 변환

관절 공간과 작업 공간의 연결은 자코비안 J(q) \in \mathbb{R}^{m\times n}을 통해 속도 수준에서 시작된다.

\dot{x} = J(q)\,\dot{q}, \qquad \ddot{x} = J(q)\,\ddot{q} + \dot{J}(q,\dot{q})\,\dot{q}

비여유 상황에서는 자코비안이 정칙이면 역관계가 존재하지만, 일반적으로 여유 자유도 시스템에서는 관절 가속도 해가 유일하지 않다. 이 경우 최소 노름 해는 다음과 같이 주어진다.

\ddot{q} = J^{+}(q)\bigl(\ddot{x} - \dot{J}\dot{q}\bigr) + \bigl(I - J^{+}(q) J(q)\bigr)\xi

여기서 J^{+}는 J의 Moore-Penrose 의사 역행렬이며, \xi는 영공간 방향의 임의 벡터로서 부과업 수행에 활용된다. 이 관계는 작업 공간 운동 요구를 만족시키는 관절 가속도의 무한 집합 중 특정 해를 선택하는 기초적 규칙을 제공한다.

3. 힘과 토크 수준의 변환

힘 수준의 변환은 가상 일의 원리에 기초하며, 엔드 이펙터에 작용하는 작업 공간 힘 F \in \mathbb{R}^m과 관절 토크 \tau \in \mathbb{R}^n 사이의 관계는 다음과 같이 주어진다.

\tau = J(q)^\top F

이 관계는 두 표현이 동일한 가상 일을 생산한다는 조건 \dot{q}^\top \tau = \dot{x}^\top F로부터 직접 유도되며, 속도 변환이 선형이므로 힘 변환 역시 선형이다. 이 전치 관계는 관절 공간과 작업 공간 사이의 수학적 쌍대성(duality)을 명확히 드러낸다.

동역학 방정식의 전체 변환

관절 공간 동역학 M\ddot{q} + C\dot{q} + g = \tau가 주어졌을 때, 양변에 J M^{-1}을 곱하고 가속도 관계를 대입하면 작업 공간 동역학 방정식이 얻어진다.

\Lambda\ddot{x} + \mu\dot{x} + p = F

여기서 \Lambda = (J M^{-1} J^\top)^{-1}, \mu = \Lambda(J M^{-1} C - \dot{J}), p = \Lambda J M^{-1} g이다. 역방향으로는 작업 공간 방정식이 주어졌을 때 J^\top을 곱하고 적절한 영공간 보정을 추가하면 관절 공간 표현으로 되돌아갈 수 있다. 두 방정식은 동일한 물리적 시스템을 서로 다른 좌표계에서 기술한 것이며, 그 해는 등가이다.

4. 영공간 프로젝터와 쌍대성

여유 자유도 시스템에서는 속도 수준의 영공간 투영 N(q) = I - J^{+}(q) J(q)이 부과업에 할당되는 가속도를 제어하는 데 사용된다. 힘 수준에서는 영공간 토크가 엔드 이펙터에 아무런 힘을 유발하지 않아야 한다는 조건을 만족하도록 쌍대 프로젝터가 정의된다.

\tau = J^\top F + N(q)^\top \tau_0

이 구조는 부과업이 주과업의 실행을 방해하지 않도록 보장하며, 계층적 작업 공간 제어(hierarchical operational space control)의 기반이 된다. 특히 관성 가중 의사 역행렬 J^{\bar{+}} = M^{-1} J^\top \Lambda을 사용하면 영공간 운동이 시스템의 운동 에너지 분해에 직교하도록 보장되어, 주과업 동역학이 영공간 활동에 의해 교란되지 않는 유리한 성질이 얻어진다.

관성 가중 의사 역행렬의 역할

동역학적 일관성을 유지하기 위해 속도 수준의 기하학적 의사 역행렬 J^{+} 대신 관성 가중 의사 역행렬 J^{\bar{+}}를 사용하는 것이 선호된다. 이는 다음과 같이 정의된다.

J^{\bar{+}}(q) = M(q)^{-1} J(q)^\top \Lambda(q)

이 연산자는 J J^{\bar{+}} = I를 만족하면서도, 영공간 운동이 작업 공간 관성과 직교하도록 하여 계층적 동역학 분해를 가능케 한다. 결과적으로 관절 공간과 작업 공간 사이의 변환이 물리적으로 일관된 형태를 유지하게 된다.

5. 제약 공간 분해

접촉이나 구속이 존재하는 경우, 관절 공간은 제약 공간과 자유 공간으로 분해되며 이 분해는 자코비안의 구조를 통해 이루어진다. 제약 방정식이 \phi(q) = 0으로 주어진다면 A(q) = \partial \phi / \partial q가 제약 자코비안이 되며, 관절 가속도는 A(q)\ddot{q} = -\dot{A}\dot{q}를 만족해야 한다. 이는 라그랑주 승수 방법에 의해 동역학 방정식에 통합되며, 구속력은 자코비안 전치를 통해 관절 토크로 환산된다. 이러한 분해는 힘 제어, 접촉 작업, 폐 운동 사슬 해석에서 중요한 역할을 한다.

6. 좌표 변환에 따른 항의 해석

관절 공간과 작업 공간 사이의 변환은 단순한 수치 변환이 아니라 물리량의 해석을 바꾸는 과정이다. 관절 공간의 관성 행렬은 구동기 관점에서 가속 응답을 정의하는 반면, 작업 공간 관성 행렬은 엔드 이펙터가 외부 힘에 대해 보이는 등가 관성을 정의한다. 코리올리 항 역시 관절 속도의 이차 결합에서 작업 공간 속도의 이차 결합으로 재구성되며, 중력 항은 개별 링크의 중력 토크가 엔드 이펙터 방향으로 투영된 형태로 나타난다. 이러한 해석적 차이는 제어 설계자가 과업의 목표와 성능 요구를 적절한 공간에서 표현하도록 안내한다.

7. 수치적 조건과 특이점

자코비안이 계수 손실을 겪는 특이점 근방에서는 \Lambda = (J M^{-1} J^\top)^{-1}의 계산이 발산하므로, 관절 공간과 작업 공간 사이의 변환이 수치적으로 불안정해진다. 이를 완화하기 위해 감쇠 최소자승 역행렬 J^{+}_\lambda = J^\top(JJ^\top + \lambda^2 I)^{-1}을 사용하거나, 특이값 분해 기반 절단(truncated SVD) 기법이 적용된다. 이러한 기법은 운동 정확성을 약간 희생하는 대신 수치적 안정성과 제어 연속성을 확보한다.

8. 전체 운동 방정식의 등가성

관절 공간 표현과 작업 공간 표현은 동일한 물리적 시스템에 대한 기술이므로, 제어 해석에서 두 표현은 등가적이어야 한다. 예를 들어 관절 공간에서의 계산 토크 제어 법칙을 적절히 변환하면 작업 공간에서의 등가 제어 법칙이 얻어지며, 이 두 법칙은 동일한 폐루프 거동을 유발한다. 설계 관점에서는 과업의 기하와 성능 요구가 직접적으로 표현되는 공간을 선택하는 것이 효율적이며, 구현에서는 두 공간 사이를 오가며 연산하는 방식이 널리 사용된다.

9. 본 절의 의의

본 절은 로봇 동역학의 두 대표적 표현 사이의 수학적 교량을 제공한다. 자코비안과 그 전치, 의사 역행렬, 관성 가중 연산자, 영공간 프로젝터는 관절 공간과 작업 공간을 자유롭게 오가게 하는 도구이며, 이를 통해 서로 다른 설계 요구를 통합적으로 다룰 수 있다. 이는 후속 절에서 다룰 접촉 동역학, 힘 제어, 임피던스 및 어드미턴스 제어 설계의 수학적 통일성을 확보하는 데 필수적이다.

10. 학습 권장사항

독자는 6자유도 매니퓰레이터에 대해 관절 공간 계산 토크 제어 법칙을 구현한 뒤, 동일한 제어 효과를 작업 공간 계산 토크 방식으로 재현해 폐루프 응답이 일치함을 확인하는 실습을 권장한다. 또한 관성 가중 의사 역행렬과 기하학적 의사 역행렬을 비교하여 영공간 운동이 주과업 수행에 미치는 영향 차이를 분석하면 변환 기법의 물리적 의미가 명확해진다. 특이점 근방에서의 감쇠 계수 \lambda 변화가 제어 응답과 토크 요구에 미치는 영향을 실험적으로 관찰하는 것도 유익하다.

11. 참고 문헌

  • Khatib, O. (1987). A unified approach for motion and force control of robot manipulators: The operational space formulation. IEEE Journal of Robotics and Automation, 3(1), 43–53.
  • Nakamura, Y. (1991). Advanced Robotics: Redundancy and Optimization. Addison-Wesley.
  • Sentis, L., & Khatib, O. (2005). Control of free-floating humanoid robots through task prioritization. IEEE International Conference on Robotics and Automation.
  • Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2009). Robotics: Modelling, Planning and Control. Springer.
  • Park, J., Choi, Y., Chung, W. K., & Youm, Y. (2001). Multiple tasks kinematics using weighted pseudo-inverse for kinematically redundant manipulators. IEEE International Conference on Robotics and Automation.
  • Chiaverini, S. (1997). Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators. IEEE Transactions on Robotics and Automation, 13(3), 398–410.
  • Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.

version: 1.0