ETH Zurich2023#021작업·궤적계획박사논문 PDF

보행-차륜 혼합계획

Hybrid motion planning and control for legged-wheeled robots: application to walking excavators

박사논문

한줄 요약 — 정밀 임업 배치에서 출발해 robust support polygon 전신 최적화, 계층적 whole-body control, roadmap 결합 planner, 0.5초급 long-short-term planning으로 발전하며 12톤 보행 굴착기의 주행·보행·arm 지지와 사족·차륜사족의 험지 접촉계획을 하나의 방법론으로 일반화했다.

1.연구 배경 및 동기

31자유도 보행 굴착기의 전역 이동성과 실시간 실행 가능성을 함께 푸는 누적 연구

보행식 굴착기는 네 개의 구동·조향 바퀴, 독립 leg, 회전 cabin, 다관절 arm을 갖기 때문에 평지에서는 차량처럼 달리고, 장애물에서는 leg로 차체를 들어 올리며, 필요하면 shovel을 다섯 번째 지지점으로 쓸 수 있다. HEAP 모델은 31 DoF로, 모든 자유도를 직접 탐색하면 sampling space가 폭발하고, 반대로 차체 경로만 먼저 정하면 이후 contact schedule과 관절제약을 만족하지 못할 수 있다. 수치 궤적최적화는 전신 동역학과 제약을 정교하게 반영하지만 장애물·접촉 전환 때문에 생기는 비볼록성에서 초기값과 지역최소에 민감하다.

이 박사논문은 한 번에 완성된 알고리즘보다 다섯 편의 연구를 통해 문제를 좁혀 간다. 먼저 숲에서 정밀수확용 mapping·localization·navigation·control을 실차 배치하고, 젖은 지면에서 주행만으로 부족한 이동성을 확인한다. 다음으로 HEAP 31 DoF 전체를 Hermite spline으로 최적화해 주행·stepping·arm support를 발견하고 robust support polygon을 도입한다. 이어 혼합 torque/velocity actuator를 위한 hierarchical whole-body controller를 구현하고, sampling planner와 limb reachability roadmap을 붙여 초기값 없는 전역 전신계획을 만든다. 마지막 LSTP에서는 장기 sampling 초기화와 짧은 horizon MPC refinement를 반복해 실제 시간에 재계획한다.

이 누적구조는 HEAP에만 갇히지 않는다. 최종 planner는 point-foot ANYmal, non-steerable wheel을 가진 ANYmal on Wheels, steerable wheel과 arm을 가진 HEAP의 세 플랫폼을 같은 base sampling·limb roadmap·contact schedule 틀로 처리한다. 플랫폼 규모는 약 60 kg 차륜사족, 156 kg 사족, 12,300 kg HEAP으로 크게 다르다. 따라서 논문의 핵심 질문은 ‘어떤 단일 optimizer가 최선인가’가 아니라, 장애물과 장기 위상 탐색은 sampling에, 실행가능성과 짧은 시간척도 보정은 optimization/MPC에, actuator 현실은 WBC/VMC에 어떻게 배분할 것인가다.

원문 Figure 1.1, PDF 26쪽
원문 Figure 1.1 · PDF p.26 — Figure 1.1: Left: Hierarchical planning structure often found in the literature. Right: Whole body planner
원문 Figure 1.3, PDF 42쪽
원문 Figure 1.3 · PDF p.42 — Figure 1.3: Different testing platforms used in this thesis. Left to right: legged excavator HEAP, legged-wheeled robot ANYmal on Wheels and legged robot ANYmal.
선행 연구의 한계
이 연구의 기여

2.방법론 및 시스템 구성

초기 연구의 optimization formulation은 base와 모든 joint trajectory를 Hermite spline으로 표현하고 접촉 여부, support polygon, collision, rolling/no-slip, shovel orientation을 연속 제약으로 둔다. contact indicator까지 최적화해 driving과 stepping을 함께 탐색하며, 지지다각형 내부에 투영된 질량중심이 epsilon margin을 두도록 해 모델·추종오차에 강건성을 확보한다. 31 DoF를 직접 최적화하므로 crab steering, cusp, diagonal drive, leg step, arm contact가 별도 behavior library 없이 나타난다.

그러나 전역 장애물과 나쁜 초기값에는 optimization만으로 부족하다. hybrid planner는 base pose를 SE(2)/SE(3)의 낮은 차원에서 RRT류로 샘플링하고, 각 base pose에 가능한 leg·arm configuration을 offline probabilistic roadmap에서 빠르게 조회한다. one-step motion을 20 cm 이하 subnode로 나누고 full-support state, latest contact break, earliest contact creation을 구한 다음 swing limb 순열을 열거해 안정한 contact schedule을 만든다. 탐색된 whole-body keyframe sequence를 continuous trajectory optimization에 초기값으로 전달한다.

LSTP는 이 개념을 online 구조로 발전시킨다. long-term SBP가 전역 base path, contact schedule, whole-body keyframes를 만들고, short-term MPC는 전체 계획 중 가까운 snippet만 받아 Direct Multiple Shooting으로 관절·base trajectory를 반복 정제한다. point-foot ANYmal은 1 s horizon과 0.01 s discretization을 사용하고, HEAP은 최대 15 s horizon, 31 state와 36 control의 kinematic MPC를 사용한다. SBP가 먼 위상을 안내하므로 MPC가 straight-line 지역최소나 잘못된 foothold로 빠질 위험을 줄인다.

terrain preprocessing은 3 cm elevation grid에서 local plane normal, filtered elevation, traversability, 2D/3D signed-distance field를 만든다. ANYmal의 normal radius는 0.1 m, filtered elevation은 0.4 m이며 HEAP은 각각 0.3 m와 2.5 m다. negative obstacle에는 neighborhood elevated mean을 써 gap·hole을 보수적으로 표시한다. 20×20 m map도 6 threads에서 1 Hz 이상 처리하며, 8×8 m의 3D SDF 평균 계산은 115 ms다.

제어는 플랫폼에 따라 달라진다. ANYmal은 25 Hz MPC와 400 Hz WBC로 high-bandwidth torque actuator를 제어한다. HEAP은 정확한 torque control이 불가능한 혼합 actuator 때문에 VMC가 지형 불일치에 순응하고 kinematic MPC가 장기 reference를 추종한다. filtering·wheel velocity loop·state estimation을 함께 쓰며 MPC는 작업에 따라 5~20 Hz로 재계획한다. 이 분리는 정교한 hydraulic dynamics를 MPC 안에 넣지 않고도 실제 장비의 wheel drift와 uneven terrain을 흡수한다.

처리 파이프라인

1

현장 지도와 traversability 전처리

LiDAR·IMU·GNSS 또는 leg kinematics를 융합해 3 cm elevation map을 만들고 local plane fitting으로 normal과 filtered elevation을 계산한다. slope·roughness·elevated mean으로 traversability를 정하고 SDF를 생성해 collision 및 foothold query에 제공한다.

2

offline limb roadmap 구성

각 leg와 arm의 joint configuration, 도달 가능한 endpoint, self/environment collision 정보를 미리 샘플링해 PRM/CDRM을 만든다. HEAP은 leg 약 300 vertices와 arm 3000 vertices 규모, ANYmal은 leg별 5000 vertices를 사용하며 runtime에는 terrain transform과 근접검색만 수행한다.

3

저차원 base sampling과 전신 상태 복원

RRT/RRT*가 base pose를 샘플하고 Reeds-Shepp 또는 straight connection으로 최소 회전반경을 반영한다. 각 pose에서 roadmap으로 full-support limb configuration을 찾고 collision·stability를 검사해 고차원 robot state를 빠르게 복원한다.

4

접촉일정과 one-step motion 생성

base connection을 20 cm 이하 subnode로 분할하고 limb별 latest contact break와 earliest contact creation을 계산한다. swing limb 순열을 최대 4!=24개 열거하면서 한 번에 한 limb만 swing하고 relaxed support polygon을 만족하는 contact schedule을 선택한다.

5

trajectory optimization과 MPC refinement

SBP의 keyframe·contact schedule을 Hermite spline 또는 OCP 초기값으로 변환한다. offline 단계는 IPOPT/SQP 등으로 전체 궤적을 정제하고, LSTP는 가까운 1~15초 snippet을 DMS-MPC로 반복 최적화하여 rolling, collision, joint, stability constraints를 만족한다.

6

WBC/VMC 실행과 재계획

ANYmal에서는 terrain-adaptive WBC가 400 Hz로 contact force와 joint torque를 실행한다. HEAP에서는 VMC가 base leveling과 contact compliance를 맡고 velocity/position loops가 유압관절을 구동한다. 실행이 plan보다 drift하면 MPC가 5~20 Hz로 보정하고 SBP는 local map을 갱신해 다음 전역 segment를 재계획한다.

원문 수식과 의미

식 (6.24) local tangent plane

nixdx+niydy+(h−h~i)=0n_i^x d_x+n_i^y d_y+(h-\tilde h_i)=0

grid cell 주변 지형을 평면으로 근사하여 normal과 filtered elevation을 얻는 기본식이다.

식 (6.26) normal least-squares estimate

θ∗=(DTD)−1DTh,θ=[nix,niy,h~i]T\theta^*=(D^T D)^{-1}D^T h,\qquad \theta=[n_i^x,n_i^y,\tilde h_i]^T

반경 안의 고도 샘플에서 local surface normal과 평균 고도를 최소제곱으로 계산해 traversability 및 base pose selection에 사용한다.

원문 Figure 3.1, PDF 114쪽
원문 Figure 3.1 · PDF p.114 — Figure 3.1: Model of the excavator shown without the arm for better visibility. Workspace of the EE’s is shown; in blue color for the front legs, in red color for the hind legs. These shapes depict the volume where HEAP can place the center of the wheels without moving the base. Workspace of the arm is essentially a cylinder that encompasses the whole base with an inner radius of 1.5 m and with the maximal outer radius of 8 m.
원문 Figure 4.3, PDF 134쪽
원문 Figure 4.3 · PDF p.134 — Figure 4.3: Structure of the proposed planning and control system. The planner (green color) sends the desired references to the controller (red color). The WBC computes desired torques for both contact and swing end-effectors. In addition to the WBC, we run an impedance controller for the stance end-effectors and the Inverse Kinematics (IK) controller for the swing end-effectors. Impedance controller torques are added to the WBC torques and sent to the contact limbs. Velocities computed from IK are sent to the low-level controller. Note how the WBC torques computed for swing limbs W BCτnc are not used. While the planner runs offline, the proposed controller runs at 100 Hz. The limiting factor in achieved frequency is the bandwidth of the Controller Area Network (CAN) bus.
원문 Figure 5.2, PDF 151쪽
원문 Figure 5.2 · PDF p.151 — Figure 5.2: Left: Elevation map of a block with a height jump. The color gradually changes from blue to white, where blue areas are the lowest. Right: Filtered elevation map shown in yellow color. Areas with dark yellow color have the lowest height. The filtered elevation can be used to compute base pose, as described in Sec. 5.3
원문 Figure 6.2, PDF 173쪽
원문 Figure 6.2 · PDF p.173 — Figure 6.2: Planning pipeline overview
원문 Figure 6.18, PDF 198쪽
원문 Figure 6.18 · PDF p.198 — Fig. 6.18 depicts the system architecture. The workflow starts from LPC re- ceiving a goal pose, which is then sent to the NPC. Subsequently, the NPC requests a local elevation map from Jetson and performs pre-processing. SBP plans a trajectory using the processed map and sends it to the MPC for track- ing.

3.핵심 기술

전신 contact를 직접 다루는 궤적최적화

HEAP을 차체와 arm의 별도 subsystem으로 쪼개지 않고 31 DoF 전부를 최적화한다. robust support polygon, no-lateral-slip, joint/velocity, collision, shovel orientation을 함께 넣어 planner가 상황에 따라 주행·stepping·arm support를 선택한다. 3 m gap과 1 m block, 90도 방향전환에서 사람이 명시하지 않은 전신 협응을 얻는다.

초기 offline planner는 단순 driving에서 horizon보다 약 10배 빠르게, 장애물 동작에서 약 2.5배 빠르게 계산한다. 접촉계획이 포함된 7초 구간은 약 15초가 걸리기도 해 완전 online에는 부족했지만, 이후 sampling initialization과 MPC로 무엇을 개선해야 하는지 명확히 보여줬다.

  • 31 DoF HEAP에서 base·legs·cabin·arm을 같은 decision space로 최적화한다.
  • 3 m gap, 1 m obstacle, 90° turn과 crab/cusp driving을 시뮬레이션한다.
  • robust support polygon margin이 실기체 오차에도 정적 안정성을 유지한다.

roadmap이 고차원 sampling 비용을 제거하는 hybrid planner

핵심 아이디어는 base pose만 online으로 샘플링하고 limb configuration은 offline roadmap에서 조회하는 것이다. HEAP leg 300 vertices와 arm 3000 vertices의 roadmap 생성에는 약 30분이 들지만 대부분 arm 계산이며 runtime planning에서는 재사용된다. rough terrain, gap, wall/step에서 linear initialization보다 높은 성공률을 유지하고 RRT 계획시간을 4초로 고정한 비교에서도 어려운 지형의 해를 찾는다.

탐색은 해의 위상을 찾고 최적화는 부드러움과 정확한 제약을 회복한다. 예시에서 shortest-duration objective는 114.98초, driving-preferred objective는 156.33초의 서로 다른 전신 동작을 만든다. 이는 동일 환경에서도 cost shaping으로 주행 우선·stepping 우선 전략을 바꿀 수 있음을 보여준다.

  • HEAP roadmap은 leg 300, arm 3000 vertices이며 generation 약 30분이다.
  • one-step motion subnode 간격은 최대 20 cm다.
  • terrain interpolation의 gradient clipping과 cubic convolution이 큰 grid cell에서 optimization convergence를 개선한다.

LSTP: 장기 위상과 단기 정밀도의 시간척도 분리

SBP는 0.5초 안팎의 예산으로 전역 경로와 비주기 contact schedule을 만들고 MPC는 가까운 구간만 반복 정제한다. hard terrain에서 ANYmal SBP는 0.5초 계획의 최악 성공률이 94%이고 2초면 모든 난도에서 100%에 도달한다. swing-leg deviation penalty를 넣으면 MPC convergence가 모든 시험에서 성공하지만 제거하면 stepping stones에서 30% 확률로 발산한다. 이는 전신 초기값이 optimizer의 지역최소를 실질적으로 바꾼다는 증거다.

  • ANYmal hard terrain은 2 s, ANYmal on Wheels는 5 s에서 모든 시험 100% success다.
  • candidate foothold roadmap lookup은 9±9 μs, terrain transform은 35±10 μs다.
  • SBP whole-body initialization과 swing-foot reference가 MPC convergence를 안정화한다.

유압장비 현실에 맞춘 MPC+VMC

HEAP의 wheel speed는 직접 측정·개별 제어가 어렵고, actuator bandwidth와 dynamics model도 전기 사족보다 부정확하다. 논문은 dynamic MPC를 과도하게 복잡하게 만드는 대신 kinematic MPC가 장기 motion constraint를 풀고 VMC가 접촉 순응성과 base leveling을 담당하게 한다. flat-ground plan을 주더라도 한쪽 hole과 반대쪽 hill에서 좌우 leg를 반대로 움직여 chassis를 수평에 가깝게 유지한다.

  • HEAP MPC는 5~20 Hz, VMC 및 filtering/velocity loop는 더 빠른 하위주기로 실행된다.
  • 15 s out of 약 250 s trajectory snippet을 MPC가 추종해 전역 최적성 일부와 실시간 보정을 교환한다.
  • wheel drift와 불완전 terrain model을 반복 최적화와 compliant control로 흡수한다.
원문 Figure 3.5, PDF 119쪽
원문 Figure 3.5 · PDF p.119 — Figure 3.5: Subfig. 1 shows HEAP repositioning itself diagonally from (0, 0) m to (10, 10) m. Subfig. 2a-2d shows HEAP performing cusps to arrive at a goal pose 5 m to the left. We do not impose any constraints on the final EE configuration. Blue line shows the CoM trajectory.
원문 Figure 5.5, PDF 157쪽
원문 Figure 5.5 · PDF p.157 — Figure 5.5: Evaluation metrics Left: Costs and computation times of the RRT (opti- mization excluded). t-time until first solution (blue), ci-initial solution cost (red), cf-final solution cost (yellow). Middle: Success rates for different terrains versus difficulty. Maxi- mal difficulty of 1, corresponds to roughness of ±2 m, gap width of 3.5 m and step height of 1.5 m. Minimal difficulty corresponds to roughness of ±0.25 m, gap width of 1 m and step height of 0.5 m. HEAP wheel radius is 0.6 m for comaprison. For the hole terrain and flat terrain, the difficulty remains unchanged and the curves are shown for the sake of com- pleteness. Right Computation time until optimization convergence when initializing using planner’s first stage versus using linear interpolation. For terrains with obstacles, gap, step and hole, linear interpolation cannot find a solution.
원문 Figure 6.16, PDF 195쪽
원문 Figure 6.16 · PDF p.195 — Fig. 6.16 shows two contact schedules discovered by our planner. These two examples highlight that when the terrain is easy, the planner resorts to using well-understood and efficient cyclic gait patterns. On the other hand, in the presence of obstacles, an acyclic contact schedule can emerge and enable the robot to precisely orient its body in anticipation of difficult terrain.
원문 Figure 6.17, PDF 198쪽
원문 Figure 6.17 · PDF p.198 — Figure 6.17: a) & b) Improved optimization convergence through penalizing swing leg deviation. We show an example for the LF leg, whose trajectory planned by the MPC is colored in blue. The reference foothold at the end of the swing phase is shown with the blue disk. The initial solution is shown on the left after the optimization iteration on the right. a) Without penalization, the foothold of the optimized trajectory is far away from the reference foothold (distance shown with red arrows). b) The optimized swing motion lands smoothly on the reference foothold with penalization. c) While the LiDAR correctly detects the closer stepping stones, it cannot see holes between the far away stepping stones (marked with red arrows). Hence, the foot placement might be incorrect.

4.실험 결과

실험 환경·장비·데이터

실험 프로토콜

비교 기준

평가 지표

원문 Figure 6.15, PDF 195쪽
원문 Figure 6.15 · PDF p.195 — Figure 6.15: Top: Non-randomized terrains at the highest difficulty level; robot cannot negotiate some terrain features, and a detour must be taken. Bottom: Four randomized terrain types with the highest difficulty level. We do not know whether a solution exists a priori. If we cannot find a feasible plan within 20 s planning time, the terrain is re-generated until one is found.
원문 Figure 6.19, PDF 200쪽
원문 Figure 6.19 · PDF p.200 — Figure 6.19: Various terrains tested on the real robot.
원문 Figure 6.20, PDF 200쪽
원문 Figure 6.20 · PDF p.200 — Figure 6.20: Anymal using a bridge to cross a 47 cm wide gap. The bridge is too narrow to place all 4 feet on it. Hence the robot has to figure out a contact schedule and coordinate limb motion to avoid this situation.
원문 Figure 6.21, PDF 202쪽
원문 Figure 6.21 · PDF p.202 — Figure 6.21: Top to Bottom: HEAP stepping over a virtual gap, the timeline goes from top to bottom. Left: snapshots of the machine per- forming the maneuver. Right: ter- rain representation as seen by the planner and the controller.
원문 Figure 6.22, PDF 203쪽
원문 Figure 6.22 · PDF p.203 — Figure 6.22: Left: Start and end configuration of HEAP performing a driving maneuver. The base is commanded to move sideways, and MPC discovers a motion satisfying the rolling constraint, which involves called crab steering. It involves all four wheels pointing in the same direction while the machine moves diagonally. Right: Base and end-effector positions during the crab steering experiment. The lines denote the path taken by each wheel and the base. The coordinate frames denote the base’s starting (S) and finishing (F) position of the base, where red color denotes x axis and the green denotes y axis. For HEAP, x axis is aligned with the direction of travel.
원문 Figure 6.23, PDF 204쪽
원문 Figure 6.23 · PDF p.204 — Figure 6.23: HEAP performing a stepping turn in place. The x −y position stays approx- imately the same, while the azimuth of the chassis changes.
원문 Figure 6.24, PDF 204쪽
원문 Figure 6.24 · PDF p.204 — Figure 6.24: HEAP performing a stepping turn and moving laterally. The chassis keeps the azimuth approximately the same as at the beginning of the maneuver.
원문 Figure 6.25, PDF 204쪽
원문 Figure 6.25 · PDF p.204 — Figure 6.25: Top: HEAP is commanded forward and there is a hole in front of it (blue arrow) and a hill (red arrow). Since the MPC is planning with a flat terrain assumption, VMC has to coordinate the front legs to keep the chassis leveled. Bottom: Base and joint tracking. While the base is tracking (with some offset) the MPC commands, HFE joints ignore the MPC references to accommodate for the unmodelled terrain.

핵심 결과 해석

초기 full-body trajectory optimization은 HEAP에서 3 m gap과 1 m block, crab/diagonal drive, cusp, 90도 turn을 계획했다. 일반 driving은 계획 horizon보다 약 10배 빠르게, 장애물 동작은 약 2.5배 빠르게 계산됐으나 contact-rich 7초 horizon 사례는 약 15초가 걸려 offline 성격이 남았다. 계층 whole-body controller를 100 Hz 수준으로 통합한 실차에서는 driving plan을 약 1초, stepping/turn plan을 10~15초에 만들고 혼합 torque/position joints로 실행했다.

hybrid sampling/optimization 장에서는 roadmap 기반 initial guess가 rough terrain, gap, step/wall의 어려운 조건에서 linear baseline의 실패를 회복했다. RRT 계획은 각 trial 4초로 제한됐고, 성공한 10회 평균을 사용했다. HEAP roadmap generation은 약 30분이며 99% 이상이 arm roadmap 계산이다. 동일 경로에서도 shortest-duration cost는 114.98초, driving-preferred cost는 156.33초 계획을 만들어 비용설계가 contact mode를 바꿀 수 있음을 보였다.

최종 LSTP의 ANYmal SBP는 hard terrain에서 0.5초 계획의 최저 성공률이 maze와 stepping stones의 0.94였고, 2초면 모든 terrain/difficulty에서 100%였다. easy와 medium은 최대 1초면 전부 성공했다. ANYmal on Wheels는 같은 tuning을 쓰면서 성공률이 조금 낮아 hard 0.5초에서 stepping stones 0.91, bricks 0.94 등이었고, 모든 hard case의 100% 도달에는 5초가 필요했다. swing-leg deviation penalty가 있는 MPC는 모든 평가에서 수렴했으나 없으면 stepping stones에서 30% 확률로 발산했다.

ANYmal 실차는 36 cm gap을 건넜는데 simulation 40 cm에 근접하고 제조사 사양 30 cm보다 크다. 47 cm gap은 직접 넘지 않고 네 발을 모두 놓을 수 없는 좁은 bridge의 비주기 접촉을 찾아 통과했다. 20 cm step up/down, 세 stepping-stone 배치, straight-line이 dead end인 maze도 수행했다. 최대 기록속도는 약 20 cm/s이며 8×8 m local map을 갱신해 LiDAR 폐색으로 보이지 않던 먼 hole을 다음 계획에서 회피했다.

HEAP LSTP는 virtual gap을 arm support와 wheel/leg 협응으로 103초에 넘었다. 별도의 long-horizon MPC는 25초 prediction horizon에서 2.53 m sideways crab motion과 네 번의 방향전환을 발견해 46초에 실행했다. 약 30도씩 stepping해 chassis yaw를 약 108도 바꾸는 동작은 177초, 6.1 m lateral stepping은 266초였다. flat terrain을 가정한 planner에도 실제 한쪽 hole·반대쪽 hill에서 VMC가 좌우 HFE joint를 반대로 움직여 base leveling을 유지했다. 논문은 HEAP의 MPC 재계획이 5~20 Hz여도 이러한 저속 quasi-static 동작에 충분했다고 결론낸다.

정량 결과

평가 항목정량 결과조건·맥락원문 근거
offline obstacle planning speedplan length 대비 약 2.5× 빠름HEAP 31-DoF gap crossing과 1 m block trajectory optimizationPDF p.121
roadmap generation약 30 min, 99% 이상 arm 계산HEAP leg 300 및 arm 3000 vertices 구성PDF p.160
비용별 motion duration114.98 s vs 156.33 sshortest-duration과 driving-preferred objectivePDF p.159
terrain preprocessing20×20 m, 3 cm map에서 1 Hz 이상6-thread pipeline; 8×8 m 3D SDF 평균 115 msPDF p.194
ANYmal SBP 최악 0.5 s 성공률0.94hard maze 및 hard stepping stones; hard 전체 2 s에서 1.0PDF p.197
MPC convergencepenalty 포함 100%; 제외 시 stepping stones 30% 발산swing-leg joint deviation penalty ablationPDF p.197
ANYmal 실차 gap36 cm 통과simulation 40 cm, manufacturer specification 30 cmPDF p.199
HEAP virtual gap103 sSBP+MPC+arm support 실차 maneuverPDF p.201
HEAP crab steering2.53 m sideways, 46 s25 s MPC horizon, 네 번 direction changesPDF p.202
HEAP stepping maneuvers108° turn 177 s; lateral 6.1 m 266 s30° increment turn 및 sideways steppingPDF p.203
실패 사례와 경계조건
원문 Figure 5.6, PDF 159쪽
원문 Figure 5.6 · PDF p.159 — Figure 5.6: Traversing terrain in different manners. Limb names: LF stands for Left Front, whereas RH stands for Right Hind etc. Left: HEAP reaches goal pose via shortest path Middle Left: Contact schedule traversing over the gap. Total duration: 114.98 s Middle Right: HEAP trying to minimize stepping while reaching the goal. Not that two legs still have to be lifted since the bridge is too narrow for both legs. Right: Contact schedule for driving whenever possible. Total duration: 156.33 s

5.한계 및 향후 연구

현재 한계

  • LSTP initialization은 static gait만 생성하고 refinement도 그 contact schedule을 근본적으로 동적 gait로 바꾸지 못한다.
  • 2.5D height map은 overhang·동굴·사다리 같은 수직/천장 접촉과 confined-space base pose를 표현할 수 없다.
  • Reeds-Shepp 연결은 최소 회전반경을 우아하게 반영하지만 quadruped의 straight connection보다 계산비가 크다.
  • HEAP actuator bandwidth와 sensing이 낮고 wheel velocity를 직접 측정·개별제어할 수 없어 정밀 추종에 한계가 있다.
  • traversability가 기하 heuristic 중심이어서 잘못 분류된 foothold가 불안정 전신구성을 만들 수 있다.
  • SBP와 MPC가 순차 실행되며 장기 최적성 일부를 포기하고 가까운 snippet만 추종한다.

향후 연구

  • static stability를 완화하고 switching-time optimization 또는 hierarchical dynamic model로 trot·jump 같은 dynamic gait를 다룬다.
  • 3D map/implicit surface 표현을 도입해 overhang·ladder·confined contact와 효율적인 base pose selection을 연구한다.
  • GPU parallel sampling과 SBP 별도 thread를 사용해 MPC가 이전 plan 종료 전에 다음 global plan을 요청하도록 한다.
  • geometry와 vision을 결합한 learned traversability 및 raw terrain에서 6D base pose를 출력하는 RL sampling policy를 도입한다.
  • 유압 전신 tracking controller를 데이터로 학습해 수작업 tuning을 줄이고 actuator aging·nonlinearity를 보상한다.
  • 더 정확한 terrain perception, wheel sensing, hydraulic dynamics를 통합해 계획·제어·상태추정의 불확실성을 공동 처리한다.

6.한마디로 정리

핵심 방법은?

저차원 base sampling과 offline limb roadmap이 장기 whole-body/contact 초기값을 찾고, 궤적최적화·DMS-MPC가 단기 제약을 정제하며 WBC/VMC가 실기체를 실행한다.

핵심 결과는?

0.5초 계획에서도 ANYmal hard terrain 최악 94% 성공, 실차 36 cm gap·20 cm step, HEAP arm-supported gap과 2.53 m crab motion을 달성했다.

한계는?

quasi-static·height-map 전제, 계산량, traversability 오류, 낮은 유압 sensing/bandwidth와 human-tuned control이 완전한 동적 전신자율을 제한한다.

#작업·궤적계획#제어·MPC#RRT와 도달성 roadmap#단기 궤적최적화#MPC#가상모델제어

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

이 학위논문은 ETH 자율굴착 연구의 locomotion substrate다. Towards Autonomous Excavation Planning이나 dry-stone construction은 작업 pose 사이 이동을 주로 SE(2) navigation으로 다루지만, 진흙·ditch·stone pile 때문에 바퀴만으로 접근할 수 없는 현장에서는 LSTP가 leg와 arm을 사용해 새로운 feasible workspace를 만든다. 즉 상위 작업계획은 ‘어디서 파거나 놓을지’를 정하고 LSTP는 ‘그 자세에 전신으로 어떻게 도달할지’를 해결한다.

반대로 작업계획의 의미와 위험을 LSTP에 되돌려야 한다. ETHcavation의 사람·장비 dynamic map을 SBP collision layer로, adaptive hydraulic controller의 latent uncertainty를 MPC constraint margin으로, bucket-filling의 토양반력 추정을 contact feasibility로 연결하면 기하적으로 가능한 동작과 현장 안전·실행 가능성을 함께 판단할 수 있다.

7.전체 그림·표

섹션별 원문 근거 페이지

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

추출·교차검증 근거