← Portfolio Home

인간-로봇 상호작용을 위한 반응형 제어

Proximity-Based
Reactive Motion
Control

Proximity Sensing · RMPflow Control · Tangential Guidance

근접센서의 거리값을 기반으로 RB10이 주변 장애물에 연속적으로 반응하도록 RMPflow 제어기를 구성했습니다. 기본 제어기에서 나타난 local minimum을 완화하기 위해 장애물 접선 방향의 우회 동작을 생성하는 TG-RMP를 추가했습니다.

실제 RB10에서의 근접 반응형 회피
01

제어 목표

안전한 HRI를 위한
근접 반응형 제어

HRI · 근접 장애물 회피 · 목표 진행 유지

HRI 환경에서는 작업자나 주변 물체가 로봇의 동작 범위에 가까워지는 상황이 발생할 수 있습니다. 안전성과 작업 연속성을 함께 확보하려면, 로봇이 이러한 근접 상황을 인지하고 충돌을 피하는 방향으로 움직임을 조정할 필요가 있습니다. 이에 근접 장애물에 반응하면서 목표 진행을 유지하는 제어를 목표로 했습니다.

01

HRI 근접 상황

작업자나 주변 물체의 접근으로 로봇 주변의 환경이 계속 변할 수 있습니다.

02

반응형 회피

근접 거리에 따라 충돌을 피하는 방향으로 움직임을 연속적으로 조정합니다.

03

목표 진행 유지

회피 과정에서도 목표를 향한 진행이 유지되도록 합니다.

02

제어기 구성

RMPflow 기반
제어기 구성

센서 정보 변환 · 제어 정책 결합 · 동작 명령 생성

근접센서의 거리값을 로봇 기준좌표계의 장애물 위치로 변환하고, 센서가 장착된 각 로봇 링크의 충돌 회피 정책에 연결했습니다. RMPflow를 기반으로 목표 추종, 충돌 회피, 감쇠, 관절 제한 정책을 결합해 로봇의 동작 명령을 생성했습니다.

로봇 상태의 task-space 매핑부터 Target, Collision, Joint Limit, Damping, Axis Target, Joint Velocity Limit RMP 결합과 최종 로봇 동작 생성까지의 RMPflow 제어 구조
03

제어 검증

기본 제어기
검증

RViz · 정적 장애물 · 동적 사람 접근

시뮬레이션에서 센서 매핑과 충돌 회피 정책을 먼저 검증한 뒤, 실제 RB10에서 중간 링크 주변의 정적 장애물과 움직이는 손의 접근 상황에 대한 회피 동작을 평가했습니다.

03-1

RViz 기반 선행 검증

센서 감지 범위 · 로봇 기준 장애물 점 · 링크별 반응

근접센서 감지 범위와 장애물 회피를 표시한 RViz 화면
RViz에서 수행한 선행 시뮬레이션 검증
03-2

정적 장애물 회피

중간 링크 주변에 고정된 장애물의 유무에 따른 실로봇의 회피 동작을 비교했습니다.

장애물 없음 · 기본 동작
장애물 있음 · 중간 링크 회피
03-3

동적 장애물 회피

움직이는 손의 접근에 대한 실로봇과 RViz의 회피 동작을 비교했습니다.

실로봇 RB10의 동적 손 회피
RViz 대응하는 시뮬레이션 반응
04

한계 발견

충돌은 피했지만,
진행하지 못했다

목표–충돌 정책 대립 · 제어 명령 상쇄

기본 제어기는 근접 장애물과의 충돌을 피했지만, 장애물이 목표 진행 방향을 가로막는 조건에서는 목표 추종과 충돌 회피 정책이 서로 다른 방향의 명령을 생성했습니다. 그 결과 합성된 동작 명령이 작아지면서 로봇이 장애물 앞에 정체되는 local minimum이 나타났습니다.

대표적인 국소 최소점 · 충돌은 없지만 장애물 근처에서 정체
05

제어기 확장

TG-RMP Tangential Guidance

접선 방향 선택 · 가속도 생성 · Metric 설정

local minimum을 완화하기 위해 기존 RMPflow 트리에 TG-RMP leaf를 추가했습니다. TG-RMP는 장애물 주변의 접선 방향을 선택하고, 해당 방향으로 움직이기 위한 가속도와 정책의 영향도를 정하는 Metric을 생성해 기존 정책과 함께 결합됩니다.

RMPflow의 기본 정책에 TG-RMP를 추가하고 접선 방향, 목표 가속도, Metric, 방향 갱신을 통해 local minimum을 완화하는 확장 제어 구조
확장 제어기 · 기본 RMP 말단 정책과 추가된 TG-RMP 접선 정책 좌우로 밀어 전체 구조를 확인하세요.
06

적용 전후 검증

local minimum
완화

동일한 장애물 배치에서 TG-RMP 적용 전후를 비교했습니다. TG-RMP 적용 시 장애물의 접선 방향으로 우회 동작이 추가되어, 기본 제어기에서 나타난 정체가 완화되고 목표를 향한 진행이 이어졌습니다.

장애물 배치 01

W/O TG-RMP
W TG-RMP

장애물 배치 02

W/O TG-RMP
W TG-RMP

장애물 배치 03

W/O TG-RMP
W TG-RMP

Project takeaway

근접센서 기반 Reactive Motion Controller를 RB10에 구현하고, 기본 제어기에서 나타난 local minimum을 TG-RMP 접선 정책으로 완화했습니다.

근접센서 기반 Reactive Motion RMPflow 제어기 구성 TG-RMP 접선 정책 추가 RViz · RB10 동작 검증
Next project Interactive Diffusion Policy →