Minimum-Snap Trajectory

• 다른 이름: minimum snap trajectory, min-snap
• 카테고리: Planning & manipulation › Trajectory optimisation
• 태그: trajectory-generation, quadrotors, aerial-robotics, motion-planning, optimization

위치의 4차 미분인 스냅의 제곱 적분을 최소화해 얻는, 경유점을 지나는 매끄러운 경로로, 쿼드로터 비행을 계획하는 표준적인 방법이다.

정의

최소 스냅 궤적(minimum-snap trajectory)은 일련의 경유점을 지나면서, 스냅(snap)이라 부르는 위치의 4차 시간 미분의 제곱 적분을 최소화하는 궤적이다. 각 좌표는 보통 구간별 다항식으로 표현되며, 경유점 쌍마다 한 구간을 두고 이음점에서 위치와 그 미분들의 연속성을 강제한다. 비용이 다항식 계수에 대해 이차이고 경유점 조건과 연속성 조건이 선형이므로, 구간 시간이 고정되어 있으면 계수를 찾는 문제는 이차 계획 문제가 되며, 제약이 없는 경우에는 닫힌 형태로 풀 수 있다.

이 방법은 쿼드로터와 밀접하게 연결되어 있다. Mellinger와 Kumar(2011)는 쿼드로터가 위치와 요(yaw)를 평탄 출력으로 하는 미분 평탄(differentially flat) 시스템임을 보였다. 즉 전체 상태와 입력을 이 출력들과 그 미분들로부터 계산할 수 있다. 추력의 방향과 크기는 가속도에서, 기체 각속도는 저크(jerk)에서, 각가속도와 그에 따른 모터 토크는 스냅에서 나온다. 따라서 스냅을 최소화하면 필요한 모터 명령의 변화가 작고 매끄럽게 유지되어 궤적을 추종하기가 더 쉬워진다. 같은 아이디어를 더 낮은 차수에 적용하면 오래전부터 로봇 팔 동작에 쓰여 온 최소 저크 궤적과 최소 가속도 경로가 된다.

다항식 풀이는 문제의 일부만 다룬다. 구간 시간은 따로 정해야 하며, 흔히 바깥쪽 최적화로 정하거나 속도, 추력, 기체 각속도 한계가 만족될 때까지 시간을 조정해 정한다. 해는 경유점을 지나지만 그 자체로 경유점 사이의 장애물을 피하지는 않으므로, 계획기는 경로가 모서리를 가로지르는 곳에 중간 경유점을 추가하거나 각 구간을 안전한 볼록 통로 안으로 제약한다. 최소 스냅 궤적은 매끄럽지만 시간 최적은 아니며, 그래서 레이싱 시스템은 샘플링 기반 또는 최적화 기반의 시간 최적 계획기도 사용한다.

중요한 이유

최소 스냅 궤적 생성은 경유점을 멀티로터가 비행할 수 있는 기준 궤적으로 바꾸는 기본 방법이다. 빠르고, 잘 이해되어 있으며, 미분 평탄성을 통해 쿼드로터 동역학에 깔끔하게 대응되므로 연구용 오토파일럿, 드론 레이싱, 공중 점검에 쓰인다.

주요 응용

• 쿼드로터 경유점 비행과 공격적인 기동
• 드론 레이싱 기준 궤적
• 공중 점검 및 촬영 경로
• 매니퓰레이터를 위한 매끄러운 관절 또는 직교 공간 궤적(최소 저크 변형)
• 기하학적 경로 계획기 이후의 궤적 정제

실제 사례

한 드론 레이싱 팀이 트랙의 게이트 위치 지도를 가지고 있다. 각 게이트 중심에 경유점을 하나씩 두고, 요를 다음 게이트를 향하도록 설정한 뒤, 각 게이트에서 스냅까지 연속인 최소 스냅 구간별 다항식을 x, y, z에 대해 맞춘다. 초기 시간 할당은 거리와 공칭 속도로 정한다. 그런 다음 평탄성 사상을 통해 계산한 속도, 총 추력, 기체 각속도 한계에 대해 궤적을 검사하고, 모든 한계가 여유를 두고 만족될 때까지 구간 시간을 늘리거나 줄인다. 이렇게 얻은 궤적은 제어기 주기로 샘플링되어 기하학적 추종 제어기에 전달되며, 같은 기준 궤적이 학습 기반 인식 정책의 레이블 생성에도 쓰인다.

흔한 오해

• 최소 스냅은 시간 최적이다 — 고정된 구간 시간에 대해 매끄러움 비용을 최소화할 뿐, 비행 시간을 최소화하지 않는다
• 경유점이 충돌하지 않으므로 궤적도 장애물을 피한다 — 통로 제약을 추가하지 않으면 경유점 사이의 구간이 여전히 모서리를 가로지를 수 있다
• 액추에이터 한계가 자동으로 처리된다 — 속도, 추력, 기체 각속도 한계는 시간 할당이나 제약을 통해 검사하고 강제해야 한다
• 최소 스냅은 미분 평탄성과 같다 — 평탄성은 기체 모델의 성질이고, 최소 스냅은 평탄 출력을 계획하는 데 쓰이는 비용 중 하나이다

알아야 할 사람

• 공중 로봇 및 드론 오토파일럿 엔지니어
• 모션 플래닝 연구자
• 드론 레이싱 및 점검 개발자
• 궤적 생성을 공부하는 제어 전공 학생

관련 기술

• 이차 계획법(Quadratic Programming)
• 구간별 다항식 스플라인(Piecewise Polynomial Splines)
• PX4
• SE(3) 상의 기하학적 추종 제어(Geometric Tracking Control on SE(3))
• 안전 비행 통로(Safe Flight Corridors)

관련 용어

• Differential Flatness
• Trajectory Planning
• UAV
• Direct Collocation
• Kinodynamic Planning
• Model Predictive Control

관련 프로젝트

• Drake: MIT robotics toolbox for model-based dynamics, optimization, and control system design
• GTSAM: Factor-graph optimization library powering many modern SLAM backends
• OMPL: Sampling-based motion planning library powering MoveIt and countless robotics applications
• MoveIt 2: Motion planning framework for ROS 2 robot arms, with kinematics and collision checking
• PyRoki: Modular Python toolkit for kinematic optimization across CPU, GPU, and TPU via JAX
• PyPose: PyTorch library for differentiable robotics with deep learning and Lie group optimization