17.23 작업 공간 동역학 방정식

1. 개요

작업 공간 동역학 방정식은 엔드 이펙터의 위치와 방향을 기술하는 작업 공간 좌표 x \in \mathbb{R}^m 위에서 로봇의 운동 방정식을 표현한 것이다. 로봇의 구동기는 본질적으로 관절을 구동하므로 연산은 관절 공간에서 이루어지지만, 실제 과업의 목표는 대개 작업 공간에서 정의된다. 예를 들어 물체를 일정 위치에 도달시키는 것, 접촉면에 특정 힘을 가하는 것, 엔드 이펙터의 운동 궤적을 정밀하게 추종하는 것은 모두 작업 공간에서 명시된다. 본 절은 관절 공간 동역학을 작업 공간으로 변환하여 얻어지는 작업 공간 동역학 방정식의 수학적 형식과 그 각 항의 물리적 의미, 그리고 작업 공간 제어에 활용되는 기본적인 구조를 제시한다.

2. 작업 공간 좌표와 자코비안

작업 공간 좌표 x는 일반적으로 엔드 이펙터의 위치 p \in \mathbb{R}^3과 방향 표현(오일러 각, 축-각, 회전 벡터 등)의 결합으로 주어지며, 엔드 이펙터의 선속도와 각속도는 공간 자코비안 J(q) \in \mathbb{R}^{m \times n}을 통해 관절 속도와 연결된다.

\dot{x} = J(q)\,\dot{q}

가속도 관계는 자코비안의 시간 미분을 포함한다.

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

m = n이고 자코비안이 정칙이면 \ddot{q}에 대해 역관계가 존재하지만, 여유 자유도(redundant)나 결핍 자유도 상황에서는 의사 역행렬이 사용된다. 본 절은 m \le n인 일반적 경우를 기본 전제로 한다.

3. 작업 공간 운동 방정식의 유도

관절 공간 동역학 방정식

M(q)\ddot{q} + C(q,\dot{q})\dot{q} + g(q) = \tau

에서 가속도를 \ddot{q} = J^{+}(\ddot{x} - \dot{J}\dot{q}) + (I - J^{+}J)\xi로 치환하면, 여기서 J^{+}는 자코비안의 의사 역행렬이고 \xi는 영공간 성분이다. 이를 양변에 J M^{-1}을 곱하고 정리하면 Khatib가 제안한 작업 공간 관성 행렬을 중심으로 한 다음 형태의 방정식이 얻어진다.

\Lambda(q)\ddot{x} + \mu(q,\dot{q})\dot{x} + p(q) = F

여기서 F는 엔드 이펙터에 인가된 등가 작업 공간 힘/모멘트(wrench), \Lambda는 작업 공간 관성 행렬, \mu는 작업 공간 코리올리/원심 행렬, p는 작업 공간 중력 벡터이다. 각 항은 관절 공간 항들로부터 다음과 같이 정의된다.

\Lambda(q) = \bigl(J(q) M(q)^{-1} J(q)^\top\bigr)^{-1}

\mu(q,\dot{q}) = \Lambda\bigl(J M^{-1} C - \dot{J}\bigr)

p(q) = \Lambda J M^{-1} g

구동 토크와 작업 공간 힘의 관계는 자코비안 전치에 의해 \tau = J^\top F + (I - J^\top J^{+\top})\tau_0로 주어지며, 영공간의 추가 토크 \tau_0는 여유 자유도 활용에 사용된다.

작업 공간 관성 행렬의 특성

\Lambda(q)는 대칭이며 양정치 조건은 J(q)가 행 기준 완전 계수(full row rank)를 만족할 때 성립한다. \Lambda의 고유 구조는 엔드 이펙터의 방향별 등가 관성을 기술하며, 동적 조작성 타원체(dynamic manipulability ellipsoid)를 정의하는 기반이 된다. 특이 형상에서 J의 계수가 감소하면 JM^{-1}J^\top가 특이 행렬이 되어 \Lambda가 정의되지 않으므로, 특이점 근방에서는 정규화된 의사 역행렬이나 감쇠 최소자승 기법이 사용된다. 관성 행렬의 이 비유클리드 기하 구조는 작업 공간 제어의 공간적 이방성을 결정한다.

작업 공간 코리올리 행렬의 성질

\mu(q,\dot{q})는 관절 공간의 코리올리 행렬 C와 자코비안 시간 미분 \dot{J}을 포함한다. 적절한 구성에서 \dot{\Lambda} - 2\mu가 반대칭 성질을 만족하도록 선택할 수 있으며, 이는 패시비티 기반 제어 설계의 안정성 해석에서 핵심적 성질로 활용된다. 작업 공간 코리올리 항은 관절 공간의 동일한 항을 좌표 변환한 결과이므로, 에너지 보존적 성질과 속도에 대한 이차 형식 구조를 그대로 계승한다.

작업 공간 중력 벡터

p(q)는 중력이 엔드 이펙터에서 느껴지는 등가 힘을 나타낸다. 관절 공간의 중력 토크 g(q)는 공간 전체 링크의 무게 분포를 반영하는 반면, p(q)는 이를 엔드 이펙터의 좌표계로 투영한 형태이다. 중력 보상 관점에서 p를 보상하면 엔드 이펙터 방향의 정적 부하만 제거되며, 링크 자체의 중력 토크 균형은 추가적으로 관절 공간에서 처리되어야 한다.

작업 공간 계산 토크 제어

작업 공간 동역학 방정식을 이용한 대표적 제어 법칙은 Khatib의 작업 공간 계산 토크 방식이며 다음과 같이 설계된다.

F^{*} = \ddot{x}_d + K_d(\dot{x}_d - \dot{x}) + K_p(x_d - x)

F = \Lambda(q) F^{*} + \mu(q,\dot{q})\dot{x} + p(q)

\tau = J^\top F + (I - J^\top J^{+\top})\tau_0

이때 폐루프 오차는 \ddot{e} + K_d \dot{e} + K_p e = 0로 선형화되어, 작업 공간에서 지정된 이득에 의해 직접 해석 가능한 오차 동역학을 갖는다. 이 접근은 작업 공간 성능 요구를 제어기 설계 단계에서 명시적으로 반영할 수 있다는 점에서 관절 공간 제어보다 직관적이다.

4. 여유 자유도와 영공간

여유 자유도를 가진 시스템에서는 J(q)가 넓은 행렬이 되어 동일한 작업 공간 운동에 대응하는 관절 해가 무수히 많다. 작업 공간 동역학 방정식은 엔드 이펙터의 운동만을 직접 지배하며, 잔여 자유도는 영공간 프로젝터 N(q) = I - J^{+}J를 통해 독립적으로 관리된다. 전형적인 응용은 특이점 회피, 관절 한계 회피, 장애물 회피, 보조 과업 수행이며, 작업 공간 동역학의 구조를 통해 주과업과 부과업이 계층적으로 결합된다.

5. 작업 공간 힘 제어와의 연결

작업 공간 동역학 방정식은 접촉력 제어에서도 기반 역할을 한다. 엔드 이펙터가 환경에 접촉 상태일 때 접촉력 F_e가 인가되면 동역학은

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

로 확장되며, F의 제어 법칙에 F_e를 직접 반영하거나 관측하여 이를 힘 제어 루프로 연결할 수 있다. 이 구조는 임피던스 제어, 어드미턴스 제어, 하이브리드 위치-힘 제어의 수학적 토대를 이룬다.

특이점과 수치적 취급

작업 공간 동역학 방정식은 J의 계수 감소에 민감하므로, 특이점 근방에서 수치적 불안정성이 발생한다. 이를 완화하기 위해 감쇠 최소자승 기법 J^+_\lambda = J^\top(JJ^\top + \lambda^2 I)^{-1}이 사용되며, 작업 공간 관성 행렬에도 정규화 항이 적용된다. 또한 작업 공간 좌표가 방향을 포함할 때 방향 오차를 매개변수에 의존하지 않고 정의하기 위해 회전 행렬 또는 퀀터니언 기반 오차가 사용된다.

본 절의 의의

본 절은 로봇이 수행하는 과업이 본질적으로 작업 공간에서 정의된다는 점을 강조하고, 관절 공간에서 유도된 동역학을 작업 공간으로 변환하여 얻어지는 방정식의 수학적 구조와 물리적 해석을 제시한다. 이를 통해 엔드 이펙터의 관성, 코리올리 효과, 중력의 영향이 공간적 이방성을 가진 형태로 드러나며, 작업 공간 제어, 힘 제어, 여유 자유도 관리가 통합적으로 이루어질 수 있는 이론적 기반이 마련된다.

학습 권장사항

독자는 2자유도 평면 매니퓰레이터에 대해 작업 공간 관성 행렬 \Lambda(q)를 직접 계산해 보고, 엔드 이펙터가 방향에 따라 경험하는 관성이 달라지는 공간적 이방성을 확인할 것을 권장한다. 또한 특이점 근방에서 \Lambda의 조건수가 발산하는 양상을 수치적으로 관찰하고, 감쇠 최소자승 접근의 효과를 비교해 보는 실습이 유익하다. 여유 자유도가 있는 7자유도 시스템에 대해 주과업과 관절 한계 회피 부과업을 결합한 제어 시뮬레이션은 작업 공간 동역학 방정식의 응용적 의미를 체험하는 데 도움이 된다.

참고 문헌

• 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.
• Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2009). Robotics: Modelling, Planning and Control. Springer.
• Khatib, O. (1995). Inertial properties in robotic manipulation: An object-level framework. International Journal of Robotics Research, 14(1), 19–36.
• Sentis, L., & Khatib, O. (2006). A whole-body control framework for humanoids operating in human environments. IEEE International Conference on Robotics and Automation.
• Nakamura, Y. (1991). Advanced Robotics: Redundancy and Optimization. Addison-Wesley.
• Chiaverini, S., Oriolo, G., & Walker, I. D. (2008). Kinematically redundant manipulators. In Springer Handbook of Robotics, 245–268. Springer.
• Park, J., & Khatib, O. (2006). A haptic teleoperation approach based on contact force control. International Journal of Robotics Research, 25(5–6), 575–591.

version: 1.0