2025-11-10T03:03:08.769835

Extending First-order Robotic Motion Planners to Second-order Robot Dynamics

Sawant, Tayebi

This paper extends first-order motion planners to robots governed by second-order dynamics. Two control schemes are proposed based on the knowledge of a scalar function whose negative gradient aligns with a given first-order motion planner. When such a function is known, the first-order motion planner is combined with a damping velocity vector with a dynamic gain to extend the safety and convergence guarantees of the first-order motion planner to second-order systems. If no such function is available, we propose an alternative control scheme ensuring that the error between the robot's velocity and the first-order motion planner converges to zero. The theoretical developments are supported by simulation results demonstrating the effectiveness of the proposed approaches.

academic

일차 로봇 운동 계획기를 이차 로봇 동역학으로 확장

기본 정보

논문 ID: 2503.17589
제목: Extending First-order Robotic Motion Planners to Second-order Robot Dynamics
저자: Mayur Sawant, Abdelhamid Tayebi (Lakehead University)
분류: cs.RO cs.SY eess.SY
발표 시간: 2025년 10월 10일 (arXiv v2)
논문 링크: https://arxiv.org/abs/2503.17589

초록

본 논문은 이차 동역학에 의해 지배되는 로봇 시스템으로 일차 운동 계획기를 확장한다. 알려진 스칼라 함수의 음의 기울기가 주어진 일차 운동 계획기와 정렬되는 지식을 기반으로 두 가지 제어 방안을 제시한다. 이러한 함수가 알려진 경우, 일차 운동 계획기를 동적 이득을 갖는 감쇠 속도 벡터와 결합하여 일차 운동 계획기의 안전성 및 수렴성 보장을 이차 시스템으로 확장한다. 이러한 함수가 없는 경우, 로봇 속도와 일차 운동 계획기 간의 오차가 0으로 수렴함을 보장하는 대체 제어 방안을 제시한다. 이론적 발전은 시뮬레이션 결과로 뒷받침되며, 제안된 방법의 유효성을 입증한다.

연구 배경 및 동기

문제 정의

자율 로봇 항법은 로봇을 원하는 목표 위치로 유도하면서 장애물을 회피하는 것을 포함한다. 기존 항법 방법은 주로 인공 포텐셜 필드에 기반하며, 여기서 인력 벡터 필드는 로봇을 목표 방향으로 유도하고 척력 벡터 필드는 장애물 회피를 보장한다.

핵심 과제

동역학 불일치 문제: 대부분의 항법 전략은 로봇 운동이 속도 제어되는 일차 모델에 의해 지배된다고 가정하지만, 실제 로봇 시스템은 일반적으로 이차 동역학으로 모델링됨
안전성 보장: 일차 계획기를 이차 시스템에 직접 적용하면 오버슈트가 발생하여 시스템이 불안전 영역으로 진입할 수 있음
기하학적 제약: 기존 이차 시스템 항법 방법은 처리할 수 있는 장애물 기하학적 형태에 제한이 있음

연구 동기

기존 일차 운동 계획기(예: 5, 8)는 복잡한 기하학적 형태의 장애물 환경에서 안전한 항법을 보장할 수 있지만, 이차 시스템에 직접 적용하면 안전성 보장이 손실된다. 따라서 일차 운동 계획기의 적용성을 이차 동역학 시스템으로 확장하는 제어 방안을 설계할 필요가 있다.

핵심 기여

안전성 및 수렴성 보장 확장: 일차 운동 계획기의 안전성 및 수렴성 보장을 이차 시스템으로 확장하여 복잡한 장애물 기하학적 환경에서 항법 가능
무한 포텐셜 함수 불필요: 기존 방법1, 10과 달리 장애물 경계에 접근할 때 인공 포텐셜 함수가 무한대로 발산할 필요 없음
초기 조건 제약 완화: 참조 조절기 방법13, 14과 달리 로봇 초기 속도에 제약 없음
두 가지 상호 보완적 제어 방안: 동적 감쇠 피드백(DDF)과 속도 추적 피드백(VTF) 두 가지 제어 전략 제시

방법 상세 설명

작업 정의

피드백 제어 법칙 u를 설계하여 이차 시스템:

ẋ = v
v̇ = u

이 안전성과 목표 상태(x = xd, v = 0)의 점근 안정성을 보장하도록 함. 일차 시스템 ẋ = vd가 안전성과 목표 위치 x = xd의 점근 안정성을 보장한다고 가정.

기본 가정

가정 1 (환경 제약):

자유 공간 Xr은 경로 연결
δu > 0이 존재하여 불안전 영역이 다음을 만족: 최근점 유일성, Hessian 행렬 유계성 및 대칭성

가정 2 (일차 계획기 성질):

ω-극한 집합은 E ∪ {xd}이며, E는 고립된 평형점만 포함
xd는 거의 전역 점근 안정
모든 평형점에서 Jacobian 행렬 고유값의 실부가 0이 아님
장애물 근처에서 vd(x)⊤η(x) ≥ μ > 0 만족
vd(x)는 유계

제어 방안 설계

방안 1: 동적 감쇠 피드백(DDF) 제어

적용 조건: 스칼라 함수 φ(x)가 알려져 있어 vd(x) = -k₁∇ₓφ(x)

제어 법칙:

ud(x,v) = -k₁∇ₓφ(x) - kdβ(dx)v

동적 이득 함수:

β(p) = {
  1,           p ≥ ε₂
  φ(p),        ε₁ ≤ p ≤ ε₂  
  p⁻¹,         0 < p ≤ ε₁
}

여기서 dx = d(x,OW) - r은 장애물까지의 안전 거리.

방안 2: 속도 추적 피드백(VTF) 제어

적용 조건: 일차 계획기 vd(x)가 연속 미분가능하고 ∇ₓvd(x)가 유계

제어 법칙:

uv(x,v) = -kdβ(dx)(v - vd(x)) + ∇ₓvd(x)⊤v

기술적 혁신점

적응형 감쇠 메커니즘: 로봇과 장애물 간의 거리에 따라 감쇠 이득을 동적으로 조정. 장애물에서 멀 때는 낮은 감쇠로 빠른 운동 유지, 장애물에 접근할 때는 감쇠 증가로 안전성 보장
이론적 보장:
- 정리 1: DDF 제어는 X°r × Rⁿ 전진 불변성을 보장하고, (xd,0)은 거의 전역 점근 안정
- 정리 2: VTF 제어는 속도 오차 ‖v(t)-vd(x(t))‖의 단조 감소를 보장하고, (xd,0)은 거의 전역 점근 안정
포텐셜 함수 발산 불필요: 기존 방법과 달리 장애물 경계에서 포텐셜 함수가 무한대로 발산할 필요 없음