Tension-Aware Cooperative Trajectory Planning for Cable-Suspended Payload Transport by Two Underwater Vehicles

기술 요약: 두 대의 수중 이동체를 이용한 케이블 현수 페이로드 운송을 위한 인장력 인지 협동 궤적 계획

1. 문제 정의

케이블을 통한 중량물 또는 대형 페이로드의 협동 운송은 항공 로봇 분야에서는 성숙한 패러다임이지만, 수중 영역에서는 여전히 해결되지 않은 과제로 남아 있다. 기존의 수중 방식들은 일반적으로 로봇을 점질량(point mass)으로 모델링하며, 케이블의 단방향성(당기는 힘만 존재)을 구조적 계획 제약 조건이 아닌 사후적인 반응형 체크 항목으로 취급한다. 이러한 접근 방식은 다음 세 가지 복합적인 요인들로 인해 수중 환경에서 실패한다:

1. 유체역학: 등방성 부가 질량(added mass), 부력 및 비선형 항력의 존재는 페로이드를 이동시키는 데 필요한 힘의 균형을 크게 변화시킨다.
2. 단방향 제약: 케이블은 인장력(tension)만을 가할 수 있다. 만약 계획된 궤적이 인장력을 0 또는 음수로 만든다면, 케이블은 느슨해지고(slack), 페이로드는 제어 불능 상태가 되며, 시스템은 제어 능력을 상실한다.
3. 중성 부력 근접성: 해저 페이로드는 종종 중성 부력에 매우 근접해 있어, 요구되는 케이블 힘이 매우 작다. 결과적으로 인장력이 느슨해지는 마진이 매우 좁으며, 표준 플래너들은 케이블이 페이로드를 "밀어야" 하는 상황을 초래하는 동역학적으로 불가능한 궤적을 생성하곤 한다.

또한, 기존 방식들은 바디 고정(body-fixed) 케이블 부착 오프셋으로 인해 발생하는 차량의 자세와 케이블 운동학 사이의 결합(coupling)을 무시하며, 계획 단계에서 인장력 양수성을 보장하지 못한다.

2. 방법론

저자들은 점질량 페이로드를 운송하는 두 대의 완전 6자유도(6-DOF) 무인 수중 이동체(UUV)를 위한 계층적 인장력 인지 계획 프레임워크를 제안한다. 이 프레임워크는 유체역학적 역학, 바디 고정 오프셋, 그리고 엔드 투 엔드 인장력 보장을 통합한다.

시스템 모델링:

• 역학: 시스템은 등방성 부가 질량, 복원력/부력, 비선형 항력을 포함하기 위해 Fossen 벡터 모델을 활용한다.
• 운동학: 바디 고정 케이블 오프셋($r_{B,i}$)은 차량의 자세와 케이블 기하학을 결합한다. 시스템은 케이블을 축 방향 힘을 전달하는 질량이 없는 강체로 모델링하는 미분-대수 방정식(DAE)으로 모델링된다.
• 제약 조건: 팽팽한 케이블 가정은 홀로노믹 거리 제약을 부과한다. 시스템은 완전 작동 모드를 유지하기 위해 $T_i \ge T_{min} > 0$인 단방향 조건을 만족해야 한다.

핵-알고리즘:
본 프레임워크는 세 가지 주요 구성 요소로 이루어진다:

1. 중복적 미분 평탄화 매개변수화 (Redundant Differential Flatness Parameterization):

   • 저자들은 중복적인 평탄 출력 $z = [p_L, \hat{l}_1, \hat{l}_2, \eta_1, \eta_2]$를 정의한다. 여기서 $p_L$은 페이로드 위치, $\hat{l}_i$는 케이블 단위 벡터, $\eta_i$는 차량의 자세이다.
   • 하나의 공면 제약 조건(coplanarity constraint) $(\hat{l}_1 \times \hat{l}_2)^T F_{req} = 0$이 도입되어 1차원 중복성을 해소한다. 이는 요구되는 힘 $F_{req}$가 케이블이 이루는 평면 내에 존재하도록 보장하여, 케이블 인장력을 유일하고 폐쇄형(closed-form)인 양인 $T = (L^T L)^{-1} L^T F_{req}$로 회수할 수 있게 한다.
   • 명제 1은 고정된 케이블 기하학이 좁은 원뿔 형태의 요구 힘 범위 내에서만 가능하다는 것을 입증하는 한편, 케이블의 방향을 재설정할 수 있는 자유도가 있다면 어떤 비제로(non-zero) 요구 힘에 대해서도 양의 인장력을 유지할 수 있음을 보여준다.

2. 인장력 인지 키네다이내믹 프런트엔드 (Hybrid-A):*

   • 탐색 기반 플래너가 평탄 출력 공간을 탐색한다.
   • 공면 제약 조건은 분석적으로 해결되어 평면 외 페이로드 저크($j_{L,\perp}$)를 결정하며, 이를 통해 12개의 자유 제어 입력을 남긴다.
   • 가지치기(Pruning): 회수된 인장력이 $T_i \ge T_{min}$을 위반하거나 충돌이 발생하는 경우 모션 프리미티브를 가지치기한다. 이는 인장력이 가능한 경로만을 확장하도록 보장한다.

3. 제약된 시공간 백엔드 (Augmented Lagrangian):

   • 프런트엔드 경로는 B-스플라인(B-spline) 궤적 최적화를 위한 웜 스타트(warm start) 역할을 한다.
   • 공면성을 준수하는 차트 (Coplanarity-Respecting Chart): 궤적은 공면성과 단위 노름(unit-norm) 제약이 구조적으로 동일하게 유지되도록 차트를 사용하여 매개변수화된다(명제 1을 통해). 이는 등식 제약을 경계 조건으로 축소한다.
   • 최적화: 증강 라그랑주 방법(ALM)을 사용하여 인장력 타당성($T_i \ge T_{min}$), 안전 항행 회랑(SNCs)을 통한 충돌 회피, 케이블 간격, 그리고 키네다이내믹 경계(속도, 가속도, 각속도)와 같은 엄격한 부등식 제약 조건 하에서 페이로드 저크 및 케이블 각가속도를 최소화한다.

3. 주요 기여

• 최초의 완전 6-DOF 수중 모델: 본 논문은 캐리어를 바디 고정 오프셋을 가진 완전한 강체로 모델링하고 유체역학적 역학(부가 질량, 항력)을 계획 모델에 내장한 최초의 협동 케이블 운송 플래너를 제시한다.
• 구조적 인장력 보장: 인장력 타당성을 사후적인 체크 항목으로 취treating하는 기존 연구와 달리, 본 방법은 엔드 투 엔드로 인장력 양수성을 보장한다. 이는 중복 평탄 매개변수화와 특정 기하학적 차트를 사용하여 양의 인장력을 솔루션 공간의 구조적 속성으로 만든다.
• 분석적 공면성 해소: 본 방법은 케이블 평면의 중복성을 분석적으로 해결하여 인장력 계산을 폐쇄형 식으로 변환함으로써, 프런트엔드에서의 효율적인 가지치기와 백엔드에서의 엄격한 제약 조건 강행을 가능하게 한다.
• 엔드 투 엔드 실행 가능성: 본 프레임워크는 키네다이내믹 탐색과 제약 최적화기를 통합하여 충돌이 없고, 동역학적으로 실행 가능하며, 엄격하게 팽팽한 상태를 유지하는 궤적을 생성한다.

4. 결과

본 방법은 3차원 운송 시나리오, 부력 스윕(buoyancy sweep), 그리고 50개의 무작위 작업에 대한 몬테카를로 연구를 포함한 수치 시뮬레이션을 통해 평가되었다.

• 베이스라인 실패 사례:

  • 고정 케이블 베이스라인 (최소 저크 페이로드 및 고정된 대칭 케이블)은 모든 작업에서 100% 실패하였다. 항력이 지배적인 영역에서 이는 케이블 인장력을 깊은 음수 값(예: -11.7 N)으로 몰아넣었으며, 이는 케이블이 밀어야 함을 의미한다.
  • 디커플링 할당기 (제안된 경로와 사후 인장력 할당 사용)는 양의 인장력을 유지했으나, 키네다이내믹 한계를 위반하였고(케이블 각속도가 1.0 rad/s 제한 대비 최대 2.9 rad/s 도달), 케이블 방향을 경로와 함께 설계하지 않아 차량-장애물 충돌을 일으켰다.

• 제안된 방법의 성능:

  • 실행 가능성: 제안된 플래너는 50개의 모든 무작위 작업에서 인장력 마진, 공면성, 충돌 회피 및 키네다이내믹 경계를 만족하며 100% 실행 가능성을 달erm성했다.
  • 인장력 유지: 주요 시나리오에서 최소 인장력은 운송 내내 0.69 N(0.5 N 임계값 이상)으로 유지되었다.
  • 강건성: 부력 스윕 결과, 본 방법은 중성 부력에 근접한 상태($W_{net} \approx 1$ N)에서도 인장력 마진을 유지하는 반면, 다른 방법들은 실패하거나 인장력이 0으로 붕괴됨을 보여주었다.
  • 폐루프 추적: 모델 불일치와 해류 교란이 존재하는 전체 다체 시뮬레이션에서 기하학적 SE(3) 컨트롤러가 생성된 궤적을 추적하였다. 페이로드 추적 오차는 0.8 cm였으며, 측정된 케이블 인장력은 엄격하게 양수(최소 0.58 N)를 유지하여 케이블이 팽팽하게 유지됨을 확인하였다.

5. 의의 및 주장

본 논문은 완전 6-DOF 역학, 바디 고정 오프셋을 포함하며 엔드 투 엔드로 케이블 인장력 양수성을 보장하는 모델을 통해 협동 케이블 운송을 다룬 첫 번째 연구라고 주장한다.

저자들은 단방향 실행 가능성(unilateral feasibility)이 중립 부력에 가까운 수중 페이로드의 항력 지배 영역에서 실질적인 장애물이 되며, 이것이 고정 기하학 방식들을 무력화시킨다는 점을 입증하였다. 또한, 단순히 사후에 케이블 방향을 재설정하는 것은 불충분하며, 속도 및 충돌 제한을 준수하기 위해 케이블 방향이 페이로드 경로와 **함께 설계(co-designed)**되어야 한다고 주장한다.

본 연구의 의의는 부력, 항력 및 차량 가속도 제한에도 불구하고 사용자가 지정한 최소 인장력 이상을 케이블이 유지하도록 하는, 실행 전 충돌 없는 운송 궤적을 생성할 수 있다는 점에 있다. 이 방법은 참조 궤적과 피드포워드 제어 입력을 출력하며, 이는 표준 SE(3) 차량 컨트롤러와 직접 통합될 수 있어 단일 차량이 감당하기 너무 큰 하중을 다루는 해저 작업에 실질적인 솔루션을 제공한다.

저자들은 현재 구현체가 수십 초 정도의 해결 시간을 갖는 오프라인 플래너임을 언급하며, 향후 실시간 구현, $n > 2$ 대의 차량으로의 확장, 그리고 모델링되지 않은 해류 및 케이블 탄성에 대한 강건성 확보에 집중할 것이라고 밝혔다.