17.10 준정적 조건에서의 운동 계획 응용

1. 개요

준정적 조건은 관성과 속도 의존 효과가 무시 가능한 운동 영역을 의미하며, 이 조건에서 로봇의 운동 계획(motion planning)은 동역학적 복잡성을 피하면서도 환경 상호작용, 안정성, 그리고 토크 제약을 정량적으로 반영할 수 있다는 장점을 가진다. 매니퓰레이터의 정밀 작업, 다족 로봇의 정적 보행, 파지 작업의 손가락 궤적, 그리고 접촉 유지 조작 등 다양한 로봇공학 응용에서 준정적 가정은 실무적으로 유효한 계획 기법의 근간을 이룬다.

본 절에서는 준정적 조건 아래에서 운동 계획의 기본 원리, 대표적 응용 분야, 제약 조건의 정식화, 그리고 궤적 설계와 안정성 판정의 방법을 학술적으로 기술한다. 준정적 해석 자체의 원리와 가정은 별도의 절에서 이미 다루어졌으며, 본 절은 그 결과를 운동 계획 절차에 적용하는 방법에 초점을 맞춘다.

2. 준정적 운동 계획의 기본 전제

준정적 운동 계획은 다음의 기본 전제 아래에서 수행된다. 첫째, 모든 순간 시스템은 정적 평형 방정식을 충족해야 하며, 이는 관성력과 속도 의존 힘을 무시한 평형 조건이다. 둘째, 궤적을 따라 자세가 변화할 때 한 평형 상태에서 다른 평형 상태로의 이행은 연속적이어야 한다. 셋째, 속도 프로파일은 충분히 느려서 관성 기여가 사전 정의된 허용 한계 아래에 머무른다.

이러한 전제에서 운동 계획의 주요 목적은 다음과 같이 요약된다. 시작 자세로부터 목표 자세로 이르는 경로를 찾되, 경로의 모든 중간 자세에서 평형 방정식, 관절 제약, 접촉 제약, 그리고 안정성 조건이 충족되도록 하는 것이다. 준정적 조건은 경로의 속도 프로파일을 사후적으로 결정할 수 있게 하며, 경로 기하학과 속도 시나리오의 분리를 가능하게 한다.

3. 관절 공간과 작업 공간에서의 계획 형식

준정적 운동 계획은 관절 공간(joint space) 또는 작업 공간(task space)에서 수행될 수 있다. 관절 공간 계획에서는 경로가 관절 변수의 함수 $\mathbf{q}(s)$ 로 표현되며, 여기서 $s \in [0, 1]$ 는 경로 매개변수이다. 작업 공간 계획에서는 말단 효과기의 자세 $\mathbf{x}(s)$ 가 직접 설계되고, 역기구학을 통하여 대응하는 관절 경로가 결정된다.

준정적 제약은 각 표현 방식에서 동일한 물리적 내용을 가지지만, 수학적 정식화는 다르다. 관절 공간에서는 각 자세 $\mathbf{q}(s)$ 에서 $\mathbf{g}(\mathbf{q}(s))$ 와 필요 관절 토크를 직접 평가할 수 있어 편리하다. 반면 작업 공간에서는 환경과의 접촉 조건과 상호작용력을 자연스럽게 표현할 수 있어 힘 제약 문제에 적합하다.

4. 다족 보행 로봇의 정적 보행 계획

준정적 운동 계획의 대표적 응용은 다족 보행 로봇의 정적 보행(static walking)이다. 정적 보행은 이동 중 임의의 순간에 로봇의 질량 중심이 지지 다각형(support polygon) 내부에 위치하도록 다리 이동 순서를 계획하는 방법이다. 정적 안정성 조건은 다음과 같이 표현된다.

$\mathbf{p}_{\text{CoM}} \in \mathrm{ConvexHull}\{ \mathbf{p}_{\text{foot}, i} \mid i \in \mathcal{S}(t) \}$

여기서 $\mathbf{p}_{\text{CoM}}$ 은 질량 중심의 수평면 투영이며, $\mathcal{S}(t)$ 는 시간 $t$ 에서 지면과 접촉하는 다리의 집합이다. 이 조건이 모든 순간에 성립하면 로봇은 이론적으로 정지 가능한 상태에 머무르며, 관성력을 활용하지 않고도 안정적으로 이동할 수 있다.

정적 보행 계획은 각 다리의 교대 이동 순서, 이동 중인 다리의 궤적, 그리고 몸통의 자세 이동을 결정하는 문제이다. 사다리형 보행, 파동형 보행 등 여러 보행 패턴이 제안되어 왔으며, 각각의 패턴은 이동 속도, 에너지 소비, 안정성 여유 사이의 상충을 다르게 절충한다. 준정적 해석은 이러한 패턴의 평가와 비교를 가능하게 한다.

접촉 상태 변화의 계획

로봇이 환경과 접촉을 유지하면서 작업을 수행하는 경우, 운동 계획은 각 순간의 접촉 상태(contact mode)를 명시하여야 한다. 접촉 상태는 어떤 접촉점이 활성이고 어떤 접촉점이 비활성인지, 그리고 각 접촉점의 마찰 영역이 활성인지 미끄러짐 영역인지 등을 포함한다. 준정적 계획은 각 접촉 상태에서 평형 조건과 마찰 콘 제약을 동시에 만족하는 구간을 탐색한다.

조작 작업의 예로, 로봇이 물체를 평면을 따라 밀거나 회전시키는 작업에서, 물체에 가해지는 접촉력의 분포는 준정적 평형 방정식을 충족해야 한다. 마찰 콘 제약을 만족하는 접촉력 집합과 물체의 운동 방향을 연결하는 관계식은 준정적 조작 이론(quasi-static manipulation)으로 정립되어 있으며, 이 이론은 접촉력-운동 지도를 통한 체계적 계획 절차를 제공한다.

파지 작업의 준정적 계획

다지 파지(multi-finger grasping)에서는 여러 손가락 끝 접촉력이 물체에 가해져 평형을 이루는 동시에, 각 접촉력이 마찰 콘 내부에 머무르도록 계획해야 한다. 준정적 파지 계획은 다음과 같은 형식의 문제로 정식화된다.

$\sum_{i=1}^{N} \mathbf{W}_i \mathbf{f}_i = -\mathbf{F}_{\text{ext}}, \quad \mathbf{f}_i \in \mathcal{F}_i, \quad i = 1, \ldots, N$

여기서 $\mathbf{W}_i$ 는 $i$ 번째 접촉점의 그립 행렬(grip matrix)로 접촉력을 물체 렌치에 대응시키는 사상이고, $\mathbf{F}_{\text{ext}}$ 는 물체에 가해지는 외력이며, $\mathcal{F}_i$ 는 $i$ 번째 접촉점의 마찰 콘이다. 준정적 평형은 해가 존재하는 접촉력 집합을 보증하며, 그립의 폐쇄성(closure) 성질과도 직결된다.

파지 계획은 물체의 형상과 마찰 조건에 따라 각 손가락의 접촉점과 힘 분배를 결정하는 문제이며, 준정적 해석은 이러한 결정의 기초적 제약을 제공한다.

5. 경로의 준정적 유지를 위한 속도 제한

계획된 경로가 준정적 가정을 유지하려면 속도 프로파일이 적절히 제한되어야 한다. 경로 매개변수화 $\mathbf{q}(s)$ 에서 시간과 매개변수의 관계를 $s(t)$ 로 두면, 관절 속도와 가속도는 다음과 같이 연쇄 규칙으로 표현된다.

$\dot{\mathbf{q}} = \mathbf{q}'(s) \dot{s}, \qquad \ddot{\mathbf{q}} = \mathbf{q}'(s) \ddot{s} + \mathbf{q}''(s) \dot{s}^2$

관성 토크 $\mathbf{M}(\mathbf{q}) \ddot{\mathbf{q}}$ 와 코리올리 토크 $\mathbf{C}(\mathbf{q}, \dot{\mathbf{q}}) \dot{\mathbf{q}}$ 의 크기가 중력 토크의 일정 비율 아래에 머무르도록 $\dot{s}$ 와 $\ddot{s}$ 의 상한을 설정하면, 준정적 가정을 유지하는 속도 프로파일이 결정된다.

이러한 제한은 시간 최적 궤적 문제의 특수 형태로 정식화될 수 있으며, 경로를 고정한 상태에서 속도 프로파일만을 최적화하는 시간 최적화 방법이 사용된다. 결과로 얻어지는 속도 프로파일은 경로의 기하학, 자세 의존 중력 토크, 그리고 관절 토크 한계를 모두 반영한다.

경로 탐색 알고리즘과 준정적 검증

준정적 운동 계획의 실무에서는 샘플링 기반 계획 알고리즘(sampling-based planning)과 최적화 기반 알고리즘이 병행 사용된다. 샘플링 기반 알고리즘은 확률적 도로맵(PRM)과 빠른 무작위 탐색 트리(RRT) 등이 대표적이며, 각 샘플 자세에서 정적 평형 방정식과 제약 조건을 검증한다. 인접한 두 자세 사이의 연결이 유효하려면 경로 전체에 걸쳐 준정적 조건이 유지되어야 한다.

최적화 기반 알고리즘은 경로를 수치적 변분 문제로 정식화하여 목적 함수(경로 길이, 에너지, 매끄러움)와 제약(평형, 충돌 회피, 관절 한계)을 동시에 다룬다. 내부점 방법, 순차 이차 계획법, 그리고 최근에는 궤적 최적화 라이브러리 등이 사용된다. 준정적 조건은 제약의 일부로서 자연스럽게 통합된다.

외력 추종 경로의 계획

준정적 계획은 외력이 사전에 알려진 또는 시간에 따라 예측 가능한 경우에도 적용된다. 이 경우 계획 문제는 다음과 같이 표현된다.

$\mathbf{g}(\mathbf{q}(s)) - \mathbf{J}^T(\mathbf{q}(s)) \mathbf{F}_e(s) = \boldsymbol{\tau}(s), \quad |\tau_i(s)| \leq \tau_i^{\max}, \quad \mathbf{q}(s) \in \mathcal{C}_{\text{free}}$

여기서 $\mathcal{C}_{\text{free}}$ 는 장애물과 충돌하지 않는 자세의 집합이다. 이 제약을 만족하는 경로는 각 순간의 외력을 감당할 수 있는 자세만을 지나간다. 이러한 계획은 유리의 운반, 무거운 부품의 조립, 그리고 일정한 압력을 유지하는 연삭 작업 등에서 유용하다.

6. 유사 정적 보행 대비 동적 보행의 한계

준정적 보행은 정적 안정성을 보장하지만, 관성력의 활용이 필요한 동적 보행(dynamic walking)에 비하여 이동 속도가 느리고 에너지 효율이 낮다. 실제 생체 보행은 관성과 중력의 상호작용을 활용하는 진동자적 동역학에 기반하며, 준정적 보행은 이에 비하여 자세 변화가 작고 운동이 부자연스럽다. 그러므로 고성능 보행 로봇 연구에서는 준정적 계획이 초기 단계의 안정성 확보와 저속 내비게이션에 한정되며, 이후 동적 계획으로 확장되는 경향이 있다.

본 장의 맥락에서 준정적 보행 계획은 정적 평형과 운동 계획 사이의 연결 고리로서, 동역학 운동 계획에 앞서 이해되어야 할 기본 개념이다.

7. 준정적 조작 작업의 에너지적 관점

준정적 운동 계획은 에너지적 관점에서도 자연스러운 해석을 가진다. 관성 기여가 무시 가능한 경우 운동 에너지의 누적은 영이며, 작업자가 로봇에 공급하거나 로봇이 환경에 전달하는 일은 전적으로 위치 에너지의 변화와 마찰 및 비탄성 접촉에서의 소산으로 나타난다. 경로를 따라 수행되는 총 일은 위치 에너지 차이와 경로 손실의 합으로 주어지며, 계획 목적이 최소 에너지 경로일 때 이 표현이 유용하게 활용된다.

또한 경로의 시작과 끝 자세가 동일한 경우, 마찰과 접촉 손실이 없다면 총 일은 영이 된다. 이러한 관찰은 준정적 반복 작업에서 주기당 에너지 소비를 평가하는 데 사용되며, 에너지 효율 최적화의 기초 지표를 제공한다.

8. 본 절의 의의

본 절에서 기술된 준정적 조건에서의 운동 계획 응용은 로봇공학의 여러 분야에 걸쳐 공통적으로 사용되는 기반 기법이다. 매니퓰레이터 작업, 다족 보행, 다지 파지, 조작 계획 등에서 준정적 해석은 동역학적 복잡성을 피하고 제약 조건을 간결하게 표현할 수 있게 하며, 초기 설계와 안전성 확보의 기초를 제공한다.

준정적 계획의 결과는 완전 동역학적 재계획과 제어의 출발점으로 사용되기도 한다. 준정적 해법으로 기본 경로가 결정된 후, 더 빠른 실행을 위해 관성 효과를 반영하는 동역학적 수정이 가해지는 절차가 일반적이다. 본 절의 내용은 이러한 단계적 접근의 첫 단계를 체계화한다.

9. 학습 권장사항

본 절의 내용을 충분히 이해하기 위하여 로봇의 기구학, 정적 평형 해석, 마찰 모델과 접촉 역학, 그리고 기본적인 경로 계획 알고리즘에 대한 선행 학습이 권장된다. 본 절의 내용을 심화 학습하기 위해서는 샘플링 기반 운동 계획 이론, 궤적 최적화 기법, 그리고 다족 보행과 다지 파지에 대한 전문 문헌에 대한 추가 학습이 권장된다.

10. 참고 문헌

LaValle, S. M. (2006). Planning Algorithms. Cambridge University Press.
Choset, H., Lynch, K. M., Hutchinson, S., Kantor, G., Burgard, W., Kavraki, L. E., and Thrun, S. (2005). Principles of Robot Motion: Theory, Algorithms, and Implementations. MIT Press.
Mason, M. T. (2001). Mechanics of Robotic Manipulation. MIT Press.
Murray, R. M., Li, Z., and Sastry, S. S. (1994). A Mathematical Introduction to Robotic Manipulation. CRC Press.
Siciliano, B., Sciavicco, L., Villani, L., and Oriolo, G. (2009). Robotics: Modelling, Planning and Control. Springer.
Lynch, K. M., and Park, F. C. (2017). Modern Robotics: Mechanics, Planning, and Control. Cambridge University Press.
McGhee, R. B., and Frank, A. A. (1968). On the Stability Properties of Quadruped Creeping Gaits. Mathematical Biosciences, 3, 331–351.

version: 1.0