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

자율굴착기를 위한 시간 가변 최소 토크 궤적 최적화

Time Variable Minimum Torque Trajectory Optimization for Autonomous Excavator

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

한줄 요약 — R-map 초기해를 소수 keypoint로 압축한 뒤 swept volume, 버킷 헤딩·이동방향, 관절 속도·토크 제약과 토양-도구 힘을 TrajOpt SQP에 결합한다. 관절자세와 구간시간을 동시에 조정해 목표 굴착량을 유지하면서 토크와 실행시간을 줄이는 단일 굴착 궤적 최적화법이다.

1.연구 배경 및 동기

굴착량·기계 한계·토양 저항·작업시간을 한 문제에서 다루기

굴착 한 사이클은 침투, 드래그, 회전, 인양으로 이루어지지만 같은 버킷 충전 목표를 만족하는 경로는 많다. 깊게 짧게 파거나 얕게 길게 끌 수 있고, 같은 형상도 구간시간에 따라 속도·가속도와 토크가 달라진다. 지중 저항도 토양 밀도·응집·속도·침투 깊이에 좌우되므로 위치 경로만 계획하면 토크 한계를 넘거나 시간과 연료를 낭비할 수 있다. 논문은 기하적으로 가능한 후보 중 토양 상호작용을 고려한 동역학적 최소토크 궤적을 찾는다.

선행 방법은 한 제어 시점의 힘을 제한하거나 접근각·높이·굴착거리 같은 소수 수작업 변수만 최적화했다. 모든 작은 timestep을 직접 변수로 두면 정확하지만 차원이 급증한다. 이 연구는 의미 있는 소수 keypoint와 구간시간만 변수로 두고, 그 사이를 작은 고정 간격으로 보간해 토크를 평가한다. 굴착의 단계 구조를 이용해 변수 수를 줄이면서 기하·기구학·동역학·작업시간을 함께 다룬다.

원문 Figure 1, PDF 2쪽
원문 Figure 1 · PDF p.2 — Fig. 1: Two different bucket trajectories for excavation. (a) The bucket ap- proaches the terrain surface. (b) The bucket penetrates into the soil. (c) The bucket drags horizontally to make the soil fail. (d) The bucket rotates and lift soils out from the terrain.
선행 연구의 한계
이 연구의 기여

2.방법론 및 시스템 구성

입력은 굴착기 링크·질량·관성·관절 한계, 버킷 크기, 지표면, 목표 굴착량, 토양 계수와 R-map 초기 궤적이다. 직접 변수는 관절 keypoint 집합 k와 인접 keypoint 사이 시간 T이고, 각 구간은 작은 Δt로 선형 보간한다. 속도·가속도·외력·토크는 조밀 waypoint에서 계산하지만 solver가 바꾸는 값은 keypoint와 시간뿐이다.

목적함수는 보간된 모든 waypoint의 관절 토크 제곱합이다. 제약은 swept volume, 침투·드래그·회전·인양의 버킷 heading과 translation direction, 방향의 단조 변화, 관절 속도·토크 한계다. 네 핵심점이 만드는 면적과 버킷 폭으로 굴착량을 근사해 토크가 작은 공중 경로 대신 목표량을 파는 해를 강제한다.

토양력은 버킷의 back plane과 separation plane을 면요소로 나누어 계산한다. 요소 깊이의 정수압, 법선속도 저항, 접선마찰을 합쳐 버킷 끝의 힘·모멘트를 만들고 재귀 역동역학에 넣는다. TrajOpt SQP가 keypoint와 시간을 갱신하며, 최종 궤적은 별도 토양·동역학 모델을 가진 AGX에서 추종 검증한다.

처리 파이프라인

1

R-map 초기해

Compact R-map에서 침투-드래그-회전-인양의 기구학적 초기 궤적을 찾아 비선형 SQP를 시작한다.

2

시간 가변 keypoint

k와 T만 변수로 두고 Δt 간격 waypoint를 보간한다. Q_i=T_i/Δt라 시간은 속도·가속도와 목적함수 항 수를 함께 바꾼다.

3

굴착량 제약

진입·침투·드래그·이탈 네 점의 면적에 버킷 폭을 곱해 swept volume을 근사하고 V_min≤V≤V_max를 강제한다.

4

방향 제약

버킷 heading과 tip 이동을 반평면으로 제한하고, 지중에서 방향이 역회전해 흙을 미는 경로를 단조성 제약으로 막는다.

5

기계 한계

보간 waypoint의 차분으로 속도·가속도를 구해 유압 유량의 속도상한과 관절 토크상한을 검사한다.

6

토양 저항 적분

지중 버킷 면요소의 깊이·법선속도·접선속도로 저항을 구해 끝단 resultant force와 moment로 합산한다.

7

역동역학 SQP

재귀 역동역학으로 waypoint 토크를 계산하고 TrajOpt SQP가 제약 아래 토크 제곱합을 줄이도록 k와 T를 갱신한다.

8

AGX 검증

최적 궤적을 별도 토양 모델의 AGX에서 단순 제어기로 추종하고 관절각과 토크를 계획값과 비교한다.

원문 수식과 의미

외력을 포함한 굴착기 운동방정식

τ=M(q)q¨+C(q,q˙)q˙+V(q)−JsT(q)R\tau=M(q)\ddot q+C(q,\dot q)\dot q+V(q)-J_s^T(q)R

질량관성, 코리올리, 중력과 버킷에 작용하는 토양 resultant wrench R을 합쳐 관절 토크를 계산한다. 원문 PDF 4쪽 식 (3).

시간 가변 최소토크 최적화

min⁡k,T∑i=0M∑j=0Qi∥τi,j∥2,Qi=Ti/Δt\min_{k,T} \sum_{i=0}^{M}\sum_{j=0}^{Q_i}\|\tau_{i,j}\|^2,\quad Q_i=T_i/\Delta t

직접 변수는 소수 keypoint와 구간시간이고, 토크는 각 구간의 보간 waypoint에서 합산한다. 원문 PDF 5쪽 식 (7).

swept volume

Vmin≤V≤Vmax,V=SabcdWV_{min}\le V\le V_{max},\quad V=S_{abcd}W

침투·드래그·회전·이탈 핵심점이 만드는 면적 S_abcd에 버킷 폭 W를 곱해 목표 굴착량을 근사한다. 원문 PDF 7쪽 식 (8).

heading·translation 반평면 제약

R(q)dhB⋅n<0,(pi+1(q)−pi(q))⋅n<0R(q)d_h^B\cdot n<0,\quad (p_{i+1}(q)-p_i(q))\cdot n<0

버킷 헤딩과 말단 이동방향을 지표 법선 또는 허용방향이 정의하는 반평면 안에 둔다. 원문 PDF 8쪽 식 (9).

관절 속도·토크 제약

∥qi+1−qiΔt∥2<vmax,∥τi∥2<τmax\left\|\frac{q_{i+1}-q_i}{\Delta t}\right\|_2<v_{max},\quad \|\tau_i\|_2<\tau_{max}

유압 유량에 따른 속도 한계와 기계의 토크 한계를 모든 보간 waypoint에서 강제한다. 원문 PDF 8쪽 식 (12).

토양 면요소 법선력

N=−(KpP+Kv∥vn∥)Svn∥vn∥,P=ρghN=-(K_pP+K_v\|v_n\|)S\frac{v_n}{\|v_n\|},\quad P=\rho gh

깊이의 정수압과 법선속도 항을 토양 계수로 조절해 버킷 면요소에 작용하는 법선 저항을 만든다. 원문 PDF 9~10쪽 식 (13), (15).

면요소 힘·모멘트 합산

F=∑iRi,M=∑iri×RiF=\sum_i R_i,\quad M=\sum_i r_i\times R_i

모든 면요소의 법선력과 마찰력을 버킷 끝단의 resultant force와 moment로 통합한다. 원문 PDF 11쪽 식 (18).

원문 Figure 2, PDF 6쪽
원문 Figure 2 · PDF p.6 — Fig. 2: Excavator Model
원문 Figure 3, PDF 7쪽
원문 Figure 3 · PDF p.7 — Fig. 3: Excavation constraints. Large orange circles denote bucket tip keypoints. Between each pair of adjacent keypoints, waypoints, denoted by tiny green cir- cles, are linearly interpolated. Translation and heading directions are drawn with blue and red directions. The brown curve represents the terrain surface. n is the normal vector of the surface at the keypoint a. The heading direction is restricted between a range around n. The blue shadow area denotes the side view of the excavated swept volume. Depths of keypoints b and c are forced to be within the range [Z1, Z2] to guarantee that they are beneath the soil surface.
원문 Figure 4, PDF 8쪽
원문 Figure 4 · PDF p.8 — Fig. 4: (a) illustrates the heading direction dh and bucket tip translation vector dt, which are two important factors for the success of an excavation task. (b) illustrates direction constraints represented using hyperplanes. For example, the direction of v is constrained within the intersection of half-planes defined by vector n1 and n2, i.e. v · n1 < 0 and v · n2 < 0.
원문 Figure 5, PDF 9쪽
원문 Figure 5 · PDF p.9 — Fig. 5: Monotonic change of the directions. The bucket moves from step 1 to step 3. Red arrows denote heading directions and blue arrows are translation directions. Double arrows represent the normal vectors of hyperplanes for cor- responding directions. At step 2, pose c is not valid since its heading direction locates at the forbidden halfplane. At step 3, pose e violates the constraint of monotonic change of translation directions. As a result, the path a →b →d is a feasible path.
원문 Figure 6, PDF 10쪽
원문 Figure 6 · PDF p.10 — Fig. 6: Bucket simplification and soil-tool interaction force model. The brown curve and shadow area beneath it represent the terrain soil. Any planar rigid body motion could be regarded as a rotation around some point A. Based on the rotation motion, velocity of each point is calculated and denoted with a black arrow v, which is decomposed into vn and vt shown in the enlarged right part of figure. F and M denote the resultant force and moment at the bucket tip frame.

3.핵심 기술

keypoint-보간 구조

굴착 단계의 핵심점만 최적화하되 토크와 한계는 조밀 보간점에서 평가해 저차원 표현과 동역학 해상도를 분리한다.

  • 변수는 k와 T
  • waypoint에서 토크 계산
  • R-map으로 warm-start

시간의 동역학 편입

시간이 짧으면 가속 토크가 커지고 길면 합산 토크 항이 늘어난다. 이 균형으로 고정 6.4초보다 짧은 5.5초 해를 얻었다.

  • Q_i=T_i/Δt
  • 시간·토크 동시 조정
  • 구간별 비균일 시간

방향·체적 작업제약

swept volume은 굴착량을, heading·translation과 단조 변화는 관입·회전·인양 자세를 보존해 토크만 작은 무의미한 경로를 막는다.

  • 0.8~1.0 m³
  • 반평면 방향 제한
  • 회전에 더 많은 keypoint

토양-도구 모델

두 버킷 평면의 면요소에 깊이·속도·마찰 저항을 적분한다. 계수를 바꾸자 단단한 토양에서 더 얕은 경로가 생겼다.

  • 정수압 ρgh
  • 법선·접선 저항
  • 외력을 역동역학에 전달

AGX 교차검증

간략 모델의 최적 궤적을 다른 토양 모델의 AGX에서 실행해 관절각 추종과 토크 패턴 일관성을 확인했다. 여전히 시뮬레이션 검증이다.

  • AGX Dynamics
  • 초기·최적·실행 비교
  • 실차 데이터 없음

4.실험 결과

실험 환경·장비·데이터

실험 프로토콜

비교 기준

평가 지표

원문 Figure 7, PDF 12쪽
원문 Figure 7 · PDF p.12 — Fig. 7: Experiment I. The sub-figure (a) shows the side view of the bucket tra- jectory which is parallel to the excavation plane. Each dot point denotes a key- point at which the heading direction is represented by the red arrow. The sub- figure (b) draws values of torque cost and some constraints during optimization. LHDirCstr is the heading direction constraint of lifting phase; SweptVolumeCstr is the constraint of swept volume for the whole trajectory; TDirMonoCstrPDR is the monotonic change constraint of the translation direction for penetration- dragging-rotation phases.
원문 Figure 8, PDF 13쪽
원문 Figure 8 · PDF p.13 — Fig. 8: Comparison of optimization results between fixed and variable time ex- periments. In sub-figure (a), time intervals between keypoints are annotated for the time variable trajectory.
원문 Figure 9, PDF 13쪽
원문 Figure 9 · PDF p.13 — Fig. 9: Bucket trajectory comparison
원문 Figure 10, PDF 14쪽
원문 Figure 10 · PDF p.14 — Fig. 10: Comparison of optimization results on dynamic simulator. Blue curves are for the initial trajectory; Orange curves are for the optimal trajectory; Green curves are for the optimal simulation trajectory.
원문 Figure 11, PDF 14쪽
원문 Figure 11 · PDF p.14 — Fig. 11: Sequence of excavation motion on dynamic simulator.

핵심 결과 해석

제약 만족 실험의 초기 궤적은 swept volume 하한 0.8 m³를 만족하지 못했다. 최적화가 체적·인양 heading·translation direction 단조성 제약을 줄이는 동안 더 많은 토양을 파므로 torque cost가 먼저 증가했고, 제약이 만족된 뒤 다시 감소했다. 이는 목표 굴착량과 자세를 확보한 범위 안에서 동역학 비용을 낮추는 solver 동작을 보여준다.

가변시간 궤적은 구간별 0.70~1.01초를 배분해 총 5.5초였고, 1초 고정 구간의 6.4초보다 0.9초 짧았다. 논문은 time scaling이 더 빨리 수렴하고 비용도 낮췄다고 기술한다. 동역학적으로 가능한 궤적은 평균 150초 이내에 계산했으므로 단일 굴착의 저빈도 계획에는 가능하지만 고주파 재계획에는 길다.

hard soil은 ρ=2500 kg/m³, K_p=3, K_v=1000, K_s=0.8, soft soil은 ρ=1000 kg/m³, K_p=1, K_v=300, K_s=0.5로 설정했다. 단단한 토양의 최적 궤적은 더 얕았고 사람 운전 경향과 맞았다. AGX에서는 단순 제어기로 최적 궤적을 추종했으며, 계획과 시뮬레이터의 토양 모델 차이에도 관절 토크 패턴이 일관됐다고 보고한다.

정량 결과

평가 항목정량 결과조건·맥락원문 근거
동역학적 실행 가능 궤적 계산시간평균 150 s 이내소수 keypoint의 시간 가변 최적화; 논문이 평균값으로 보고PDF p.4
고정시간 궤적 총시간6.4 skeypoint 간 1초 고정 비교PDF p.12
가변시간 궤적 총시간5.5 s구간시간을 최적화한 결과PDF p.12
목표 swept volume0.8~1.0 m³Experiment I 제약 만족 실험PDF p.11
관절 속도한계0.785 rad/sboom, stick, bucket 모두 동일PDF p.11
관절 토크한계950000 / 425000 / 300000 N·mboom / stick / bucket 모델 사양PDF p.11
soft soil 밀도1000 kg/m³K_p=1, K_v=300, K_s=0.5PDF p.13
hard soil 밀도2500 kg/m³K_p=3, K_v=1000, K_s=0.8PDF p.13
실패 사례와 경계조건

5.한계 및 향후 연구

현재 한계

  • 상용 동역학 시뮬레이터에 한정되고 실제 유압 굴착기 실험이 없다.
  • 토양-도구 모델은 두 버킷 면과 균질 경험계수에 의존하며 AGX 모델과도 차이가 있다.
  • 토양 계수를 실행 중 추정하지 않아 미지·층상·혼합 토양에 자동 적응하지 못한다.
  • 평균 150초 이내 계산은 현장 재계획에 길고 수렴 실패율·worst-case 시간이 없다.
  • 단일 사이클만 최적화하며 상위 task planner와 실제 연료·유압에너지를 다루지 않는다.

향후 연구

  • task planner와 결합해 굴착 위치·목표 체적·단일 사이클 궤적을 계층적으로 계획한다.
  • 실제 여러 토양의 system identification으로 힘 모델을 실측 데이터에 정합한다.
  • 실차에서 유압 제약·추종오차·토크한계·에너지를 검증하고 warm-start로 계획시간을 줄인다.

6.한마디로 정리

핵심 방법은?

R-map 초기해를 소수 keypoint와 구간시간으로 표현하고, 체적·방향·속도·토크 제약과 면요소 토양력을 포함한 역동역학 SQP로 최소 토크 궤적을 찾는다.

핵심 결과는?

AGX에서 제약을 만족하고 토양에 따라 경로 깊이를 바꾸었으며, 가변시간 해는 고정시간 6.4초보다 짧은 5.5초 궤적을 만들었다.

한계는?

단순 토양계수와 시뮬레이션에 의존하고 평균 최대 150초 수준의 계산은 온라인 적용에 길며, task planner·실차 검증이 남아 있다.

#작업·궤적계획#제어·MPC#궤적 최적화#역동역학#토양-도구 상호작용 모델#시간 가변 keypoint

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

Compact R-map이 ‘움직일 수 있는가’를 빠르게 답한다면 이 연구는 그 초기해가 ‘목표량을 담으면서 기계 부하를 견딜 수 있는가’를 검사한다. 기구학 도달성, 토양 외력, 액추에이터 한계와 시간배분을 연결하므로 상위 목표 선택과 유압제어 사이의 동역학 계획층으로 배치할 수 있다.

현장에서는 토양 계수를 관절압력·실린더 변위·버킷 자세로 온라인 식별하고, 이전 해 warm-start와 짧은 horizon으로 150초 계획시간을 줄여야 한다. 평가는 토크 제곱합뿐 아니라 유압에너지, 굴착량, 계획지연과 한계 위반을 함께 기록해야 한다.

7.전체 그림·표

섹션별 원문 근거 페이지

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

추출·교차검증 근거