Baidu Research2021#039작업·궤적계획논문 PDF 기반 카드

굴착 궤적 생성을 위한 최적화 프레임워크

Optimization-Based Framework for Excavation Trajectory Generation

Yajue Yang, Pinxin Long, Jia Pan, Xibin Song, Liangjun Zhang

한줄 요약 — 버킷 경로를 미리 정하지 않고 관절 waypoint와 시간간격을 직접 최적화하되, 토양 진입·굴착·이탈의 이동방향과 heading을 반평면 제약으로 표현하고 swept volume으로 채움률을 지정한다. 실험은 짧고 반복성 높은 궤적을 보였으나 토양 동역학이 없는 체적 proxy와 one-stage의 낮은 최적화 성공률이 실제 굴착기 확장의 핵심 과제다.

1.연구 배경 및 동기

고정 작업단계를 벗어난 굴착 궤적의 직접 최적화

기존 자동 굴착은 버킷을 진입·끌기·닫기·인양하는 단계를 사람이 정한다. 구현은 쉽지만 재료 형상과 목표량이 달라도 경로가 고정된다. 저자들은 Cartesian 경로를 먼저 만들지 않고 관절 waypoint와 구간시간을 한 최적화에서 구한다. 짧은 joint trajectory가 버킷의 진입·굴착·이탈 규칙과 목표 swept volume을 동시에 만족하도록 한다.

굴착을 motion primitive 연결이 아니라 제약된 trajectory optimization으로 본다. 시작·종료 자세, 토양 표면, 목표 채움계수와 관절 제한을 입력하고 optimizer가 내부 waypoint를 조정한다. sampled 버킷 위치·heading과 토양 아래 기하학적 swept volume을 검사해 최소 관절길이 또는 최소시간 해를 얻는다.

원문 Figure 1, PDF 2쪽
원문 Figure 1 · PDF p.2 — Fig. 1: (a) Typical bucket shape. From (b) to (d), we depict different trajectories capable of excavation. (b) Along the trajectory, the bucket penetrates through the soil along the direction tangent to the bottom plate. The tangential velocity is denoted with the blue arrow. (c) Along the trajectory, the bucket breaks and moves the soils in front of the bottom plate by pure separation i.e. moving in normal direction of the bottom plate. The normal velocity is denoted with the red arrow. (d) Along this trajectory, bucket velocity at each timestep is composed of the tangent and normal velocity. The resultant velocity is denoted with the purple arrow.
선행 연구의 한계
이 연구의 기여

2.방법론 및 시스템 구성

결정변수는 관절 waypoint Q와 인접 구간시간 T다. 첫·마지막 구간은 경계 속도·가속도를 만족하는 quintic, 중간은 waypoint를 통과하는 cubic spline이다. sampled q(t)를 forward kinematics에 넣어 버킷 tip과 heading 제약을 검사한다.

최소길이는 Q를, 최소시간은 Δt_i의 합을 줄인다. one-stage는 Q·T를 함께, two-stage는 경로 Q 뒤에 T를 최적화한다. 관절 위치·속도, 시작·종료, 버킷 이동방향·heading과 fill-factor 범위를 모두 적용한다.

처리 파이프라인

1

작업면과 경계조건 설정

height map으로 토양면을 정의하고 시작·종료 관절상태와 버킷 자세를 둔다. 진입 전, 내부 굴착과 이탈 후에 적용할 위치·heading 규칙을 준비한다.

2

관절 waypoint 초기화

관절공간 Q={q0,…,qn}의 끝은 경계조건에 고정하고 내부 waypoint가 경로 모양을 결정한다. solver가 작업제약 안에서 내부점을 수정한다.

3

혼합 spline 보간

첫·마지막 segment는 quintic으로 경계 속도·가속도를 처리하고 중간은 cubic으로 연결해 연속 위치·속도 궤적을 만든다.

4

중간 시점 sampling

각 segment의 중간 path point도 sampling한다. q(t)를 forward kinematics로 위치·heading에 변환해 waypoint 사이의 방향 위반을 줄인다.

5

translation motion rules

진입 전에는 작업면 쪽, 토양 내부에서는 굴착방향, 이탈에서는 바깥쪽으로 이동하도록 translation vector를 half-plane 부등식으로 제한한다.

6

bucket heading rules

bucket heading도 phase별 허용방향에 둔다. translation과 합친 여덟 motion rule이 고정 primitive 없이 굴착다운 운동을 만든다.

7

swept-area 계산

연속한 두 버킷 자세의 cutting edge와 토양면이 만드는 단면을 trapezoid로 근사하고 y-slice 면적을 작업 폭 방향으로 적분한다.

8

bucket fill factor 제약

V_swept/V_bucket인 K_bf를 지정 범위에 둔다. 목표량을 만족하며 길이나 시간을 줄이지만 실제 입자 유입이 아닌 정적 기하학 proxy다.

9

경로와 시간 최적화

경로 문제는 joint waypoint 변화량, 시간 문제는 ΣΔt_i를 줄인다. one-stage는 Q·T를 함께 최적화하며 모두 관절속도 제한을 지킨다.

10

실행 전 갱신과 반복

매 굴착 전 D435 height map을 갱신해 trajectory를 구한다. UR5 실행 뒤 6축 force/torque sensor로 버킷 무게를 측정한다.

원문 수식과 의미

일반 trajectory optimization

min⁡q(t)∫0tfL(q(t)) dts.t.  g(q(t))≤0,  h(q(t))=0\min_{q(t)}\int_0^{t_f}L(q(t))\,dt\quad\mathrm{s.t.}\;g(q(t))\le 0,\;h(q(t))=0

목적은 관절길이 또는 시간이며 g,h에는 관절제한, 경계조건과 motion rule이 들어간다.

최소시간 목적

min⁡Q,T∑iΔti\min_{Q,T}\sum_i\Delta t_i

one-stage는 Q·T를 함께, two-stage는 고정 Q에서 T를 조정해 속도한계 안에서 실행시간을 줄인다.

버킷 채움계수

Kbf=VsweptVbucket,Kbfmin≤Kbf≤KbfmaxK_{bf}=\frac{V_{swept}}{V_{bucket}},\qquad K_{bf}^{min}\le K_{bf}\le K_{bf}^{max}

토양 아래 swept volume을 bucket capacity로 정규화한 기하학적 목표량이다.

원문 Figure 2, PDF 3쪽
원문 Figure 2 · PDF p.3 — Fig. 2: Spline combining quitic polynomials and one exact cubic spline. The red spline denotes an exact cubic spline and blue curves are quintic splines. Purple lines represent the first derivatives at waypoints.
원문 Figure 3, PDF 3쪽
원문 Figure 3 · PDF p.3 — Fig. 3: Illustration of path constraints enforcement. Spline curves interpolate all the waypoints marked by hollow circles and the dotted circles are other intermediate points on the spline. We use red and blue colors to distinguish the first and second iterations. Constraints on the waypoints and intermediate points are imposed at the first iteration and denoted by black arrows, which push the waypoints at t1 and t2 downwards and reduces the difference in value between a point between them and the waypoint at t1. After performing update to the four waypoints as denoted by the green arrows, we get the blue spline satisfying the constraints.
원문 Figure 4, PDF 4쪽
원문 Figure 4 · PDF p.4 — Fig. 4: Geometric constraints of the underground trajectory for valid excavation. The black curve denotes the bucket path, starting from the green point to the purple point which are anchor points. Blue arrows, tangential directions of the curve, denote translation directions of the bucket tip. Red arrows represent heading directions of the bucket. The normal vector of terrain surface, depicted with the brown arrow, confines heading and translation directions at both anchor points in the area denoted with the brown region. As the hollow arrows describe, heading and translation directions are constrained to monotonously rotate clockwise along the path. At every point, the hyperplane separated by the heading direction where the translation direction is limited to lie on is denoted with the light blue region.
원문 Figure 5, PDF 5쪽
원문 Figure 5 · PDF p.5 — Fig. 5: Calculation of constraints. (a) Illustration of the direction constraint. ⃗v is restricted to be located between the dash lines. ⃗ns denote normal vectors. (b) Swept volume estimation. Brown curves denote terrain surfaces. Black curves are the bucket path with arrow denoting the direction of movement. The blue region denotes the swept area for a normal excavation trajectory.

3.핵심 기술

관절공간 자유형 굴착

joint waypoint를 직접 변수로 두고 forward kinematics로 버킷 제약을 확인한다. 시작·종료 사이 내부 waypoint를 조절해 고정 sequence보다 짧은 경로를 찾는다.

  • Q와 T가 결정변수
  • quintic endpoint와 cubic middle
  • Cartesian 제약과 joint-space 목적 결합

반평면 motion rule

translation과 heading이 phase별 허용방향에 있는지를 half-plane으로 검사한다. 여덟 규칙이 진입은 토양 쪽, 이탈은 바깥쪽, 내부는 재료 포획방향이라는 의미를 유지한다.

  • phase별 translation 제한
  • heading으로 유출 방지
  • 중간 sample에도 적용

swept volume 목표량

연속 자세의 단면을 trapezoid로 근사해 폭 방향으로 적분하고 bucket capacity로 나눠 K_bf를 얻는다. 계산은 가볍지만 중복영역과 토양유동을 몰라 실제 적재를 과대평가한다.

  • trapezoidal area
  • 폭 방향 적분
  • K_bf 범위 제약

one-stage와 two-stage

two-stage는 경로 뒤 시간을, one-stage는 경로·시간을 함께 최적화한다. one-stage가 더 빠른 해를 냈지만 비선형 결합으로 optimization success rate가 낮았다.

  • 평균시간 18% 단축
  • 최소시간 16% 단축
  • 표준편차 42% 감소, 성공률 저하

축소 검증의 범위

UR5의 두 관절을 고정한 4-DOF와 pine-needle soil로 검증했다. perception·planning·하중측정은 연결했지만 실제 굴착기의 유압지연·토압·linkage는 재현하지 않는다.

  • D435 height map
  • 6축 force/torque 무게측정
  • 유압·실토질 미검증

4.실험 결과

실험 환경·장비·데이터

실험 프로토콜

비교 기준

평가 지표

원문 Figure 6, PDF 5쪽
원문 Figure 6 · PDF p.5 — Fig. 6: Experiment platform
원문 Figure 7, PDF 6쪽
원문 Figure 7 · PDF p.6 — Fig. 7: Typical bucket paths generated for flat and slope terrain. Gray dashed lines represent the terrain surfaces. Blue curves are paths of the bucket tip. Red arrows denote heading directions of bucket poses sampled on trajectories.
원문 Figure 8, PDF 6쪽
원문 Figure 8 · PDF p.6 — Fig. 8: Statistics on weights of excavated soils with different Kbf. The error bars represent average weights and standard deviations.
원문 Figure 9, PDF 6쪽
원문 Figure 9 · PDF p.6 — Fig. 9: Real amounts of excavated soils with different Kbf for Flat- Slow experiments.
원문 Figure 10, PDF 6쪽
원문 Figure 10 · PDF p.6 — Fig. 10: Parameterization of three-phase specification.

핵심 결과 해석

Table I의 최소 joint-trajectory에서 제안법은 conventional trajectory보다 관절경로를 약 60% 줄였다. 버킷 path를 고정하지 않고 작업 제약 안에서 waypoint를 직접 움직인 효과지만 축소 robot의 특정 조건 결과다.

12개 초기화 group에서 one-stage는 two-stage보다 최소 실행시간 16%, 평균 18%, 시간 표준편차 42%를 줄였다. 경로와 시간을 함께 바꾸면 더 빠르고 일관된 궤적을 찾지만 optimization success rate는 더 낮아 초기값과 수렴에 민감했다.

K_bf와 실제 무게는 대체로 함께 증가했지만 정적 swept volume은 실제 fill을 과대평가했다. 같은 K_bf에서 5s가 10s보다, slope가 flat보다 더 많이 담기는 경향은 속도와 기울기의 영향을 보여준다.

K_bf=3 반복 실행시간은 7.01, 7.68, 7.24, 6.13, 6.53s였다. 매 cycle height map을 갱신했지만 optimization 계산시간, 실패복구와 장기간 throughput은 보고하지 않았다.

정량 결과

평가 항목정량 결과조건·맥락원문 근거
joint trajectory 길이 감소약 60%최소 관절길이 formulation과 conventional trajectory 비교PDF p.7
one-stage 최소 실행시간 감소16%12개 초기화 group에서 two-stage 대비PDF p.7
one-stage 평균 실행시간 감소18%12개 초기화 group에서 two-stage 대비PDF p.7
실행시간 표준편차 감소42%one-stage가 two-stage보다 작은 변동PDF p.7
반복 굴착 실행시간7.01, 7.68, 7.24, 6.13, 6.53sK_bf=3, joint speed 상한 0.3rad/s의 다섯 excavationPDF p.8
체적 실험 반복수조건별 20회flat/slope×10s/5s 네 조건PDF p.6
실패 사례와 경계조건
원문 Figure 11, PDF 7쪽
원문 Figure 11 · PDF p.7 — Fig. 11: Minimal length trajectories for starting position x = 0.8, z = 0 and Kbf = 3. Red trajectories are generated by our method; Blue trajectories are generated by the three-phase method.
원문 Figure 12, PDF 8쪽
원문 Figure 12 · PDF p.8 — Fig. 12: Five continuous excavations in the productivity test. Blue dashed lines show the region that we consider. Orange dashed lines are the target height. Best viewed on screen.

5.한계 및 향후 연구

현재 한계

  • 정적 swept volume이 토양 유동과 bucket 내부 손실을 무시해 실제 fill을 과대평가한다.
  • one-stage의 낮은 success rate는 경로·시간 동시 최적화가 초기값과 비선형 제약에 민감함을 보인다.
  • UR5 4-DOF와 pine-needle soil만 검증해 유압장비·실제 토질 일반화가 확인되지 않았다.
  • 계획시간, collision·force 제약과 실패 recovery가 정량평가되지 않았다.

향후 연구

  • 실측 또는 soil-force model로 K_bf를 속도·기울기·토질에 따라 보정한다.
  • warm start와 다중 초기해로 one-stage success rate를 높인다.
  • 유압 dynamics, pressure·stability와 self-collision을 제약에 넣는다.
  • height-map 불확실성과 장애물을 반영하고 장기 cycle productivity를 검증한다.

6.한마디로 정리

핵심 방법은?

관절 waypoint와 시간간격의 혼합 spline을 직접 최적화하고, 버킷 translation·heading 반평면 제약과 swept-volume 기반 K_bf로 굴착 운동과 목표량을 규정한다.

핵심 결과는?

UR5 실험에서 conventional 궤적보다 joint path를 약 60% 줄였고 one-stage가 two-stage보다 최소 16%, 평균 18% 빠르며 표준편차도 42% 작았다.

한계는?

기하학 swept volume은 실제 적재량을 과대평가했고 one-stage는 성공률이 낮았으며 대형 유압굴착기와 실제 토질의 동역학·실시간성은 검증되지 않았다.

#작업·궤적계획#제어·MPC#다항 spline#비선형 최적화#swept volume 제약#시간 가변 waypoint

나의 의견 / 우리 연구와의 연관성

상위 계획기의 dig pose·target fill을 하위 joint trajectory로 바꾸는 local planner로 연결할 수 있다. height map과 K_bf 범위를 받아 매 cycle 경로를 재계산하며, 고정 primitive보다 pile 변화에 적응하고 최소시간 목적을 생산성과 연결한다.

실제 AES에서는 payload, cylinder pressure와 soil class로 swept-volume 예측을 보정해야 한다. optimizer가 실패하거나 force가 급증하면 two-stage나 검증된 primitive로 fallback하고 feasibility와 deadline을 감시해야 한다.

7.전체 그림·표

섹션별 원문 근거 페이지

원문·기존 요약·관련 자료

추출·교차검증 근거