32.49 이동 로봇의 자코비안 해석

이동 로봇(mobile robot)의 자코비안 해석은 고정 기저 매니퓰레이터와 다른 이론적 전제를 요구한다. 이동 로봇은 기저 자체가 자유 운동체(floating base)로 기능하거나, 비홀로노믹 구속 하에 운동이 제한되는 구조를 가지며, 이로 인해 기구학적 자유도와 순간 속도 자유도가 분리되는 현상이 발생한다. 본 절에서는 차륜 이동 로봇, 이동 매니퓰레이터, 다족 로봇, 공중 이동체를 포괄하여 이동 로봇의 자코비안 해석을 정식화하고, 비홀로노믹 구속, 접촉 자코비안, 플로팅 베이스 동역학, 상대 자코비안 등의 이론적 쟁점을 해라체로 기술한다.

1. 이동 로봇의 기구학 틀

1.1 플로팅 베이스

고정 기저가 없는 이동 로봇의 일반화 좌표는 베이스 자세와 내부 관절 변수의 결합으로 구성된다.

\vec{q} = \begin{bmatrix} \vec{q}_b \\ \vec{q}_j \end{bmatrix}, \quad \vec{q}_b \in SE(2) \text{ or } SE(3)

여기서 \vec{q}_b는 베이스 자세(2차원 이동은 SE(2), 3차원 이동은 SE(3))이고, \vec{q}_j는 내부 관절 변수이다.

32.49.1.2 기구학적 자유도와 순간 속도 자유도

비홀로노믹 구속이 존재하는 경우, 기구학적 자유도(위치 변수의 수)와 순간 속도 자유도(실제로 취할 수 있는 속도 방향의 수)가 다르다. 예를 들어 단일 구름 구속 차량은 3차원 위치 공간에서 이동하지만, 순간 속도는 2차원 부분 공간에 제한된다.

32.49.1.3 일반화 속도

일반화 속도 \dot{\vec{q}} \in \mathbb{R}^n 대신, 다음과 같이 순간 속도 기준 벡터 \vec{\nu} \in \mathbb{R}^{n'}로 표현하는 것이 편리한 경우가 많다.

\dot{\vec{q}} = \mathbf{S}(\vec{q}) \vec{\nu}

여기서 \mathbf{S}는 비홀로노믹 구속에 부합하는 속도 기저 행렬이다.

1.2 Siegwart 등의 정식화

Siegwart, Nourbakhsh, Scaramuzza의 Introduction to Autonomous Mobile Robots 제2판(MIT Press, 2011)에서 이동 로봇 기구학의 체계적 정식화가 제시되어 있다.

2. 차륜 이동 로봇의 자코비안

2.1 차등 구동 로봇

차등 구동(differential drive) 로봇은 두 구동 차륜의 선속도 v_R, v_L에 의해 운동이 결정된다. 차륜 간격을 L, 베이스 자세를 (x, y, \theta)로 두면, 전진 속도 v와 각속도 \omega는 다음과 같다.

v = \tfrac{1}{2}(v_R + v_L), \quad \omega = \tfrac{1}{L}(v_R - v_L)

월드 좌표계에서의 속도는

\begin{bmatrix} \dot{x} \\ \dot{y} \\ \dot{\theta} \end{bmatrix} = \begin{bmatrix} \cos \theta & 0 \\ \sin \theta & 0 \\ 0 & 1 \end{bmatrix} \begin{bmatrix} v \\ \omega \end{bmatrix}

로 기술되며, 이 3 \times 2 행렬이 차등 구동 로봇의 운동학적 자코비안이다.

2.2 Ackermann 구동

자동차형 Ackermann 구동 로봇은 조향각 \phi와 구동 속도 v로 매개화된다. 자전거 모델에서 회전 반경은 R = L / \tan \phi이고, 운동학은 다음과 같다.

\begin{bmatrix} \dot{x} \\ \dot{y} \\ \dot{\theta} \end{bmatrix} = \begin{bmatrix} \cos \theta \\ \sin \theta \\ \tan \phi / L \end{bmatrix} v

여기서 L은 축간 거리이다.

32.49.2.3 전방향 구동

Mecanum 휠 또는 옴니 휠 기반 전방향 구동 로봇은 SE(2)의 모든 방향으로 순간 속도를 생성할 수 있으므로 비홀로노믹 구속이 없다. 세 개 이상의 휠에 대한 구동 속도 벡터는 자코비안 역행렬을 통해 베이스 속도와 연결된다.

32.49.2.4 동기 구동

동기 구동(synchronous drive) 로봇은 모든 휠이 동일한 조향각과 속도를 공유하는 구조로, 순간 속도 공간이 2차원이다. 자코비안은 조향각과 공통 속도의 관계로 기술된다.

32.49.3 비홀로노믹 구속

32.49.3.1 구름 구속

차륜 이동 로봇의 순수 구름 및 미끄러짐 없음 조건은 다음과 같은 비홀로노믹 구속을 유도한다.

\dot{x} \sin \theta - \dot{y} \cos \theta = 0

이 구속은 적분 불가능한 속도 수준 구속이며, 위치 공간의 차원을 감소시키지 않지만 순간 속도 방향을 제한한다.

2.3 Pfaffian 구속

일반 비홀로노믹 구속은 Pfaffian 형태

\mathbf{A}(\vec{q}) \dot{\vec{q}} = \vec{0}

로 기술되며, 여기서 \mathbf{A} \in \mathbb{R}^{k \times n}는 구속 분포의 쌍대 기저이다. 허용 속도는 \operatorname{null}(\mathbf{A})에 속한다.

32.49.3.3 Frobenius 정리와 적분 가능성

Frobenius 정리에 의하여 Pfaffian 구속 분포 \operatorname{null}(\mathbf{A})가 Lie 괄호에 대하여 닫혀 있으면(홀로노믹) 구속이 적분 가능하며, 그렇지 않으면(비홀로노믹) 적분 불가능하다. 차륜 이동 로봇의 구속은 일반적으로 비홀로노믹이다.

32.49.3.4 Brockett의 안정화 제약

Brockett이 1983년 논문 “Asymptotic stability and feedback stabilization”(Differential Geometric Control Theory)에서 증명한 바에 따르면, 비홀로노믹 시스템은 매끄러운 시간 불변 상태 피드백으로는 자세를 원점으로 점근 안정화할 수 없다. 이는 시간 변동 제어 또는 비연속 제어가 요구됨을 의미한다.

32.49.4 이동 매니퓰레이터

32.49.4.1 결합 시스템 정의

이동 매니퓰레이터는 이동 베이스와 매니퓰레이터가 결합된 시스템이며, 일반화 좌표는 다음과 같이 연결된다.

\vec{q} = \begin{bmatrix} \vec{q}_b \\ \vec{q}_m \end{bmatrix}

여기서 \vec{q}_b는 베이스 변수, \vec{q}_m은 매니퓰레이터 관절 변수이다.

2.4 결합 자코비안

엔드 이펙터 속도는 베이스 속도와 매니퓰레이터 관절 속도의 영향을 모두 받는다.

\dot{\vec{x}}_e = \mathbf{J}_b(\vec{q}) \vec{\nu}_b + \mathbf{J}_m(\vec{q}) \dot{\vec{q}}_m

여기서 \mathbf{J}_b는 베이스 자코비안, \mathbf{J}_m은 매니퓰레이터 자코비안이고 \vec{\nu}_b는 베이스 순간 속도이다.

32.49.4.3 여유 자유도 해소

이동 매니퓰레이터는 일반적으로 여유 자유도를 가지므로, 가중 의사 역행렬 기반의 운동 분배가 적용된다. 베이스 이동과 매니퓰레이터 관절 사이의 가중 분배는 에너지 효율, 안정성, 조작성 등의 목적에 따라 조정된다.

32.49.4.4 비홀로노믹 베이스의 처리

베이스가 비홀로노믹 구속을 가지면, 허용되지 않는 베이스 속도 방향은 매니퓰레이터 관절이 보상해야 한다. 이는 제어 복잡도를 증가시키며, Bayle 등의 연구에서 체계적으로 다루어졌다.

32.49.5 다족 로봇과 접촉 자코비안

32.49.5.1 플로팅 베이스 분기 구조

다족 로봇은 몸통에서 여러 다리가 분기하는 트리 형태의 플로팅 베이스 시스템이다. 각 다리의 엔드(발)에 대한 자코비안은 몸통 베이스 자세와 해당 다리의 관절 변수 모두에 의존한다.

32.49.5.2 접촉 자코비안

지면에 접촉한 다리는 접촉 구속을 형성한다. 접촉점의 속도가 영(점 접촉 기준) 또는 비미끄러짐 조건을 만족해야 하므로, 접촉 자코비안 \mathbf{J}_c에 대한 구속

\mathbf{J}_c(\vec{q}) \dot{\vec{q}} = \vec{0}

이 부과된다.

2.5 스윙 다리와 스탠스 다리

운동 주기 내에서 각 다리는 스탠스(stance, 접촉)와 스윙(swing, 공중)을 교차한다. 스탠스 다리는 접촉 구속을 통해 베이스 운동에 기여하고, 스윙 다리는 자유롭게 운동 가능하다. 접촉 자코비안의 구성은 단계별로 동적으로 변화한다.

2.6 전신 제어

다족 로봇의 전신 제어는 접촉 자코비안, 베이스 자코비안, 관절 공간 제약을 동시에 고려하는 계층적 해소로 구성된다. Sentis와 Khatib의 전신 제어 틀이 대표적이다.

3. 비행 로봇의 자코비안

3.1 6자유도 자유 비행

헬리콥터, 쿼드로터 등의 비행 로봇은 SE(3) 상에서 자유 운동한다. 상태 공간은 위치, 자세, 선속도, 각속도의 13차원(쿼터니언) 또는 12차원(오일러 각) 벡터이다.

3.2 과소 구동 특성

쿼드로터는 4개의 제어 입력(총 추력 및 세 축 모멘트)으로 6자유도 운동을 제어하므로 과소 구동(underactuated) 시스템이다. 수평 이동은 자세 변화를 통해서만 생성되므로, 위치와 자세가 비선형 결합된다.

3.3 비홀로노믹적 결합

과소 구동에 의하여 비행 로봇은 비홀로노믹 유사 구속을 가진다. 특정 순간 속도 방향만 즉시 생성 가능하며, 다른 방향은 자세 변화를 경유해야 한다.

3.4 고정 날개와 회전 날개

고정 날개 비행체는 전진 속도에 의존하는 비홀로노믹 구속(최소 비행 속도)을 가지며, 회전 날개 비행체는 정지 비행이 가능하다. 두 구조는 서로 다른 자코비안 해석을 요구한다.

4. 공중 매니퓰레이터

4.1 비행체-매니퓰레이터 결합

공중 매니퓰레이터(aerial manipulator)는 비행체 플랫폼에 매니퓰레이터를 탑재한 시스템이다. 일반화 좌표는 비행체 자세와 매니퓰레이터 관절의 결합으로 구성된다.

4.2 통합 자코비안

엔드 이펙터 속도는 비행체의 6자유도 속도와 매니퓰레이터 관절 속도에 의존한다.

\dot{\vec{x}}_e = \mathbf{J}_{\mathrm{aero}}(\vec{q}) \vec{\nu}_{\mathrm{aero}} + \mathbf{J}_{\mathrm{manip}}(\vec{q}) \dot{\vec{q}}_m

과소 구동 특성으로 인하여 비행체 속도 중 직접 제어 가능한 부분과 자세 변화를 경유하는 부분이 구분된다.

32.49.7.3 동역학 결합

비행체와 매니퓰레이터 사이의 동역학 결합은 관성 분포의 시변성을 유발한다. 이는 자세 안정성 제어와 매니퓰레이션 작업의 동시 수행을 어렵게 한다.

32.49.7.4 Kim 등의 연구

Kim, Choi, Kim이 2013년 논문 “Aerial manipulation using a quadrotor with a two DOF robotic arm“에서 쿼드로터와 소형 매니퓰레이터를 결합한 공중 매니퓰레이터의 자코비안 기반 제어를 제시하였다.

32.49.8 상대 자코비안과 협동 작업

32.49.8.1 상대 자코비안 정의

다중 이동 로봇의 협동 작업에서는 로봇 간 상대 자세가 주된 제어 대상이다. 상대 자코비안은 상대 자세의 시간 변화를 각 로봇의 관절 속도에 연결한다.

\dot{\vec{x}}_{\mathrm{rel}} = \mathbf{J}_{\mathrm{rel}}^{(1)} \dot{\vec{q}}^{(1)} + \mathbf{J}_{\mathrm{rel}}^{(2)} \dot{\vec{q}}^{(2)}

여기서 상첨자는 로봇 번호이다.

4.3 편대 제어

편대 제어(formation control)에서는 로봇 간 상대 위치를 유지하는 제어 법칙이 상대 자코비안을 통해 구성된다. 이는 다중 UAV, 다중 UGV, 이동 매니퓰레이터 협동에 적용된다.

4.4 협동 수송

다중 로봇이 공통 물체를 운반할 때, 물체의 6자유도 자세와 각 로봇의 파지점 자세 관계가 협동 자코비안을 통해 기술된다. 내부 힘 해석과 외부 힘 분배가 자코비안 구조로 체계화된다.

5. SLAM과 위치 추정

5.1 상태 추정 자코비안

확장 칼만 필터(EKF) 기반 SLAM에서 로봇 운동 모델과 관측 모델의 자코비안은 공분산 전파에 사용된다.

\mathbf{P}_{k+1}^- = \mathbf{F}_k \mathbf{P}_k \mathbf{F}_k^\top + \mathbf{Q}_k

여기서 \mathbf{F}_k는 운동 모델의 상태 자코비안이다.

32.49.9.2 관측 모델 자코비안

관측 모델 \vec{z} = h(\vec{x}) + \vec{v}에서 자코비안 \mathbf{H} = \partial h / \partial \vec{x}은 칼만 이득 계산과 업데이트 단계에 사용된다.

32.49.9.3 관측 가능성 해석

SLAM의 관측 가능성 해석은 관측 자코비안의 계수 구조를 통해 수행된다. Huang과 Dissanayake가 2007년 논문 “Convergence and consistency analysis for extended Kalman filter based SLAM“에서 이 해석을 체계적으로 제시하였다.

32.49.9.4 요인 그래프와 자코비안

요인 그래프(factor graph) 기반 SLAM에서 각 요인의 잔차 자코비안은 가우스–뉴턴 또는 Levenberg–Marquardt 반복 최적화의 기반이 된다. GTSAM, g2o 등의 라이브러리가 이를 구현한다.

32.49.10 제어 응용

32.49.10.1 경로 추종

비홀로노믹 이동 로봇의 경로 추종 제어는 자코비안 기반 선형화 또는 Lyapunov 기반 제어 법칙으로 구성된다. Kanayama 등의 고전적 추종 제어기가 대표적이다.

32.49.10.2 궤적 추종

쿼드로터의 궤적 추종은 미분 평탄성(differential flatness)을 이용한 자코비안 기반 역동역학 제어로 수행된다. Mellinger와 Kumar가 2011년 논문 “Minimum snap trajectory generation and control for quadrotors“에서 이 기법을 체계화하였다.

32.49.10.3 충돌 회피

자코비안과 거리 함수의 결합은 실시간 충돌 회피 제어기의 구성 요소이다. 포텐셜 필드 기반 제어에서 자코비안은 작업 공간 기울기를 관절/액추에이터 공간으로 사상한다.

32.49.11 본 절의 학술적 정리

본 절에서 다룬 이동 로봇의 자코비안 해석은 플로팅 베이스, 비홀로노믹 구속, 과소 구동, 접촉 구속과 같은 이동 로봇 특유의 기구학적 요소를 통합하는 이론적 틀이다. 차륜 이동 로봇에서는 구동 방식별 자코비안 구조가 도출되고, 이동 매니퓰레이터와 다족 로봇에서는 베이스 자코비안과 내부 관절 자코비안의 결합이 전체 자코비안을 구성한다. 비행 로봇과 공중 매니퓰레이터는 과소 구동과 자세-위치 결합을 반영한 특수 자코비안 해석을 요구한다. 상대 자코비안은 협동 이동 로봇 시스템의 표준 도구이며, SLAM과 상태 추정에서 자코비안은 공분산 전파와 관측 가능성 해석의 핵심 수단이다. 본 절의 내용은 Siciliano와 Khatib의 Springer Handbook of Robotics 제2판(Springer, 2016)에서 체계화된 이동 로봇 이론과 정합하며, 자율 주행, 자율 비행, 서비스 로봇, 다중 로봇 협동의 학술적 공통 기반을 형성한다.

출처

• Brockett, R. W., “Asymptotic stability and feedback stabilization”, in Differential Geometric Control Theory, Birkhäuser, pp. 181–191, 1983.
• Kanayama, Y., Kimura, Y., Miyazaki, F., and Noguchi, T., “A stable tracking control method for an autonomous mobile robot”, Proceedings of the IEEE International Conference on Robotics and Automation, pp. 384–389, 1990.
• Huang, S. and Dissanayake, G., “Convergence and consistency analysis for extended Kalman filter based SLAM”, IEEE Transactions on Robotics, Vol. 23, No. 5, pp. 1036–1049, 2007.
• Featherstone, R., Rigid Body Dynamics Algorithms, Springer, 2008.
• Mellinger, D. and Kumar, V., “Minimum snap trajectory generation and control for quadrotors”, Proceedings of the IEEE International Conference on Robotics and Automation, pp. 2520–2525, 2011.
• Siegwart, R., Nourbakhsh, I. R., and Scaramuzza, D., Introduction to Autonomous Mobile Robots, 2nd edition, MIT Press, 2011.
• Kim, S., Choi, S., and Kim, H. J., “Aerial manipulation using a quadrotor with a two DOF robotic arm”, Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 4990–4995, 2013.
• Siciliano, B. and Khatib, O. (eds.), Springer Handbook of Robotics, 2nd edition, Springer, 2016.
• Lynch, K. M. and Park, F. C., Modern Robotics: Mechanics, Planning, and Control, Cambridge University Press, 2017.
• Laumond, J.-P. (ed.), Robot Motion Planning and Control, Springer, 1998.

버전

• 문서 버전: 2.0
• 작성일: 2026-04-21