와이어 형태만으로 외력 추정하는 새로운 해석적 방법

초록

본 논문은 깊이 카메라로 얻은 와이어(변형 가능한 선형 물체)의 3D 형상을 이용해, 정적 혹은 준정적 평형 상태에서 외부 접촉력의 위치와 크기를 추정하는 분석적 알고리즘을 제시한다. 이 방법은 외부 힘‑토크 센서 없이도 내부 탄성 토크와 힘‑모멘트 평형식을 활용해 선형 방정식 시스템을 풀어, 와이어에 작용한 여러 외력을 동시에 식별한다. 시뮬레이션과 실제 로봇 실험을 통해 높은 정확도를 입증하였다.

상세 분석

이 연구는 변형 가능한 선형 물체(DLO)를 ‘이산 탄성 막대(Discrete Elastic Rod, DER)’ 모델로 근사하고, 각 이산 조각 사이의 내부 토크와 외부 힘‑토크 균형을 수식화한다. 핵심 아이디어는 ‘Undisturbed(UD)’ 구간과 ‘Disturbed(D)’ 구간을 구분하는 두 가지 일관성 조건을 도출하는 것이다.
① 조건 A는 인접한 두 조각이 동일한 UD 구간에 속할 경우, 그들의 변위 벡터와 내부 토크 사이에 선형 관계(e_i·c_{i+1}+e_{i+1}·c_i=0)가 성립한다는 점을 이용한다. 하지만 외력이 평면에 평행하게 작용하면 이 조건만으로는 충분하지 않다.
② 조건 B는 세 조각 연속을 이용해 스큐 대칭 행렬 A와 내부 토크 벡터 C를 구성하고, A·F = C의 최소제곱 해를 구함으로써 UD 구간을 확정한다. 이때 SVD 기반 의사역행렬을 사용해 수치적 안정성을 확보한다.
UD 구간이 확정되면, 각 구간에 대한 평균 내부 힘 F*를 계산하고, 인접 UD 구간 사이에 위치한 D 구간에 대해 외부 힘 f_j = F_{k}^{R} - F_{l}^{R} + f^{g}_j (중력 보정 포함) 로 추정한다. 외력 위치는 세 가지 가정 중 하나를 선택해 해결한다: (1) 외력 적용점이 알려진 경우 토크를 계산, (2) 토크가 0이라고 가정하고 적용점을 역산, (3) 외력이 구간 중심에 작용한다고 가정해 토크를 무시한다. 논문에서는 실험적 제약으로 세 번째 가정을 채택하였다.
알고리즘의 전제 조건은 (1) 와이어가 정적 혹은 준정적 평형 상태, (2) 최소 3개의 연속 UD 조각이 존재해야 함, (3) UD 조각이 서로 평행하지 않아야 함, (4) DER 모델이 실제 와이어 거동을 충분히 근사한다는 것이다. 이러한 전제 하에, 외부 접촉이 여러 개 존재하더라도 선형 방정식 시스템을 풀어 고유한 해를 얻을 수 있다.
시뮬레이션에서는 완벽한 강성 파라미터와 내부 트위크 정보를 제공했으며, 실시간으로 형태만을 입력으로 외력을 추정했다. 실제 로봇 실험에서는 Denso VS‑060 팔에 힘‑토크 센서를 장착하고, 와이어를 중간 혹은 오프셋 지점에서 눌러 외력을 발생시켰다. 추정된 외력 벡터는 센서 측정값과 시각적으로 겹쳐 보여졌으며, 시간에 따른 추정 정확도와 오차를 그래프로 제시했다. 결과는 와이어 변형이 작을수록(즉, 준정적 가정에 가까울수록) 추정 오차가 감소함을 확인했다.
이 접근법은 기존의 로봇 관절 토크 기반 접촉 감지와 달리, 와이어 자체를 ‘내부 센서’로 활용한다는 점에서 혁신적이다. 또한, 이산화된 구조 덕분에 외력 위치를 조각 단위로 정밀히 구분할 수 있다. 그러나 현재는 트위크(회전) 정보를 RGB‑D만으로는 얻기 어려워 토크 추정이 제한적이며, 강성 파라미터 사전 캘리브레이션이 필요하다는 한계가 있다. 향후 연구에서는 비접촉식 트위크 추정, 강성 자동 식별, 그리고 동적(비정적) 상황에서도 적용 가능한 확장 모델을 개발할 여지가 있다.