굴삭기 동적 모델 및 제어 · 70쪽 완전 해설
Interactive technical study guide · source-grounded

실차 계측에서 제어기까지,
하나의 신호 사슬로 읽기

이 가이드는 PDF의 기구학, 실린더 기하, 실차 동특성, 강체 동역학, 유압 근사, PID·VFF, 시뮬레이션 결과를 재구성합니다. 동시에 자료가 실제로 증명한 것과 아직 증명하지 못한 것을 분리합니다.

읽기 모드
개요는 핵심만, 학습은 대부분의 내용, 감사는 수식 오류와 검증 한계에 집중합니다.

70PDF pages reviewed
3Rboom · arm · bucket
48planned boom/arm pulse tests
4+explicit formula inconsistencies
01 / GEOMETRY

장비를 숫자로 옮기는 첫 단계

본문은 KIMM 실차의 핀 간 거리, 실린더 장착점, 링크 질량과 stroke를 측정해 3-link 평면 모델의 기준을 만듭니다.

OBAKBoom actuatorArm actuatorBucket actuator

실측 핵심값

계통주요 길이질량
BoomOB 2475, OC 1225, OS 340 mm182 kg
ArmAB 1365, AE 1495, GJ 1045 mm122 kg
BucketAK 840, HJ 315, HI 280 mm92 kg

실린더 stroke

Boom CS 1095–1470 mmArm DE 995–1655 mmBucket GH 785–1295 mm

관절 범위

θ₁ −4.7–66°θ₂ 225–348°θ₃ 216–395°
Convention 경고225°·395°는 표준 ±π 상대각이 아니라 reflex/unwrapped 표현입니다. 이식할 때 zero·offset·sign을 새로 정의해야 합니다.
02 / KINEMATICS

3R 기구학을 직접 움직여 보기

링크 길이와 세 관절각으로 bucket tip의 위치와 자세를 계산합니다. 아래 슬라이더는 PDF 7쪽의 FK를 그대로 구현했습니다.

x = l₁cosθ₁ + l₂cos(θ₁+θ₂) + l₃cos(θ₁+θ₂+θ₃) z = l₁sinθ₁ + l₂sin(θ₁+θ₂) + l₃sin(θ₁+θ₂+θ₃) φ = θ₁ + θ₂ + θ₃
x tip—
z tip—
φ—
IK의 올바른 분해먼저 손목점 x′=x−l₃cosφ, z′=z−l₃sinφ를 만든 뒤 2R 해를 구하고 θ₃를 복원합니다. elbow-up/down 두 해와 stroke 제한을 함께 평가해야 합니다.
PDF 7쪽 명시적 오류l₁−l₂ ≤ x′²+z′² ≤ l₁+l₂는 차원이 맞지 않습니다. 양변을 제곱하거나 가운데에 제곱근이 필요합니다.
03 / ACTUATORS

관절각과 실린더 길이는 같은 상태가 아니다

Boom·arm은 코사인 법칙, bucket은 bell-crank/4절 링크를 연쇄 계산합니다. 제어와 힘 추정을 연결하는 핵심은 길이 함수의 미분입니다.

Boom · CS

xCS² = OC² + OS² − 2·OC·OS·cos(θ₁+49.7°+15°)

단일 삼각형. 방향각과 ‘각의 크기’를 구분해야 합니다.

Arm · DE

xDE² = BD² + BE² − 2·BD·BE·cos(3π−θ₂−∠EBA−∠OBD)

Reflex-angle 표현이라 단위와 wrap에 민감합니다.

Bucket · GH

θ₃ → ∠JAI → JI → ∠AJI, ∠HJI → ∠GJH → xGH

acos 연쇄는 조립 모드와 방향을 잃으므로 atan2/연속성 검사가 필요합니다.

가상일로 통일s=s(q), ṡ=Jₛ(q)q̇, τ=Jₛ(q)ᵀF. 이 식은 실린더 반력과 upstream joint torque를 자동으로 포함하며, Fᵀṡ=τᵀq̇로 전력을 보존합니다.
04 / EXPERIMENT

실차 동특성 실험 프로토콜

네 homing 자세에서 양·음 방향과 여러 입력 크기를 시험해 pose, direction, amplitude 효과를 보려 했습니다.

01

Homing

임시 PI로 목표 자세 이동. 이미 4–5° residual error 존재.

02

Single axis

Boom 또는 arm 한 축만 선택.

03

0.5 s pulse

정규화 속도명령을 open loop로 인가.

04

Measure

command, feedback, joint angle, pressure, EE 기록.

05

Abort

기계 한계점 도달 전 강제 종료.

계획된 입력

축입력자세
Arm±0.70, ±0.50, ±0.454 poses
Boom±0.50, ±0.40, ±0.30

총 48회 계획: 축당 24회.

데이터 품질

평균 sampling ≈16 ms, 비균일누락·이상값한계점 도달Homing error 4–5°

네 자세에서 max/min을 버리고 중간 두 값만 평균했습니다. 이는 outlier를 줄이는 대신 실제 pose dependence도 지울 수 있습니다.

05 / IDENTIFICATION

지연·불감대·속도 이득

슬라이더를 움직이면 자료의 채택 모델이 현재 명령에서 무엇을 예측하는지 볼 수 있습니다.

Effective deadband—
Predicted speed—
Reported delay—

Boom

28.8%

deadband

|q̇|≈15.1|u|−4.3 TD=1059(|u|−1)² ms

Arm

40.4%

deadband

|q̇|≈58.8|u|−23.8 TD≈200 ms

Bucket

13.2%

deadband

|q̇|≈70.7|u|−9.3 TD≈200 ms
정확한 해석이 deadband는 직접 측정한 무응답 구간이 아니라 큰 입력의 평균속도 직선을 0까지 외삽한 영점입니다. Bucket은 측정 최솟값 0.3보다 훨씬 아래인 0.132를 예측합니다.
Delay 모델의 경계 문제Boom 식은 |u|=1에서 0 ms, u=0에서 1059 ms를 예측합니다. 실험 범위 0.3–0.5 밖에서는 물리 법칙이 아니라 외삽입니다. 20쪽의 delay 정의 부호도 보고값과 반대로 적혀 있습니다.
06 / DYNAMICS

기구학에서 힘과 관성으로

표준 manipulator 방정식으로 토크가 관절 가속도를 만드는 과정을 모델링하고 Simscape rigid body tree로 구현합니다.

M(q)q̈ + C(q,q̇)q̇ + G(q) = τ

M(q)

질량행렬. 링크 COM 선속도 Jacobian과 각속도 Jacobian·관성으로 구성.

C(q,q̇)q̇

Coriolis·centripetal torque. C 자체는 force가 아니라 행렬입니다.

G(q)

Potential energy gradient. 중력벡터 정의에 따라 부호가 달라집니다.

Inverse dynamics

τ = Mq̈ + Cq̇ + G

원하는 움직임에 필요한 torque 계산.

Forward dynamics

q̈ = M⁻¹(τ − Cq̇ − G)

입력 torque에서 실제 가속도 계산. PDF 31쪽은 이 식도 ‘Inverse’로 잘못 표기합니다.

반력 무시 가정은 물리적으로 부당38–39쪽은 arm 실린더가 boom에도, bucket 실린더가 arm에도 토크를 준다고 유도합니다. 그런데 30쪽은 비압축성을 이유로 이를 무시합니다. 비압축성은 힘 전달을 없애지 않습니다.
07 / HYDRAULICS

간단한 모델과 실제 연속방정식의 차이

자료는 빠른 제어 시뮬레이션을 위해 입력 유량의 적분을 힘으로 바꾸지만, 움직이는 실린더에서는 빠진 항이 큽니다.

PDF simplified plant

모든 유량이 압력을 만든다

u → Q F = Kᵥ∫Qdt = KᵥΔV

Piston displacement, leakage, relief, 양 chamber를 생략합니다. 작은 bias도 force로 계속 누적될 수 있습니다.

→
Required physical model

유량은 이동과 압축에 나뉜다

Vₐ/β · Ṗₐ = Qₐ − Aₐẋ − leakage Vᵦ/β · Ṗᵦ = Qᵦ + Aᵦẋ − leakage F = AₐPₐ − AᵦPᵦ − friction

공급·탱크압, valve flow map, cavitation, relief와 chamber volume을 포함해야 합니다.

K라는 문자의 함정40–44쪽의 회전강성 Kq [N·m/rad]와 45쪽의 체적-힘 gain Kv [N/m³]는 차원이 다른 값입니다.

대수감쇠율로 얻은 국소 등가 K/C

축IeqωnζPDF 최종 K/C일관 재계산 평균 K/C
Boom1732.9418.72.06976.22e5 / 4.72e36.083e5 / 4.579e3
Arm216.0838.32.11433.35e5 / 2.16e33.178e5 / 1.852e3
Bucket21.6457.20.13147.2e4 / 3.26e27.165e4 / 3.178e2
43쪽 개별 계산 오류예: boom (18.49,.0342)은 PDF K=6.46e5/C=2.80e3이지만 동일 Ieq로 재계산하면 5.92e5/2.19e3입니다. Arm 첫 run도 3.78e5/1.58e3이 아니라 3.44e5/.971e3입니다.
08 / CONTROL

실제 구현은 PID + 속도 앞먹임

CTC를 설명하지만 최종 controller는 M·C를 cancel하지 않습니다. 중력 유지압을 plant 특성으로 넣은 grey-box 위치제어기입니다.

EE trajectory
xₑ
→
Inverse
kinematics
→
Joint PID
+ VFF
→
Delay
+ deadband
→
k/s
force model
→
r(q)
F → τ
→
Forward
dynamics
→
q → FK
EE output

Multi-rate

Solver / plant1 kHz
Angle sensor100 Hz
Reference / controller20 Hz

Gains

축Kp / Ki / KdVFF
Boom3e7 / 1e2 / 5e5.17
Arm1.5e7 / 1e3 / 2e5.08
Bucket2e6 / 1e3 / 1e5.04

단위·signal scaling에 종속되어 다른 장비로 복사할 수 없습니다.

09 / RESULTS

무엇이 좋아졌고, 무엇은 검증되지 않았나

VFF는 동일 시뮬레이터 안에서 phase lag를 줄였지만, 실차·토양·독립 궤적에 대한 일반화는 확인되지 않았습니다.

VFF 적용 전 → 후 RMSE

Boom
−54.7%
Arm
−60.5%
Bucket
−66.9%

Circle

r=0.5 m

center (2,0), 10 s. 자유공간 다양한 궤적의 내부 추종 예시.

Digging replay

3.0 cm

평균 EE 오차. 실제 실차 tip ground truth가 아니라 동일 FK 내부 기준.

Peak error

8.3 cm

6–10 s bucket 5.5° 급변이 EE에서 확대된 값.

“실차 굴착 3 cm”가 아니다Digging 4는 흙을 담지 않은 실험 command 98개를 균일 0.134 s로 replay했습니다. 원 실험은 point 도달 이벤트 기반의 비균일 timing이었고, 목표 EE도 실제 목표값이 아니라 reference joint angle을 같은 FK에 넣은 값입니다.
10 / AUDIT

수학·검증 감사 결과

자료의 연구적 가치는 유지하면서, 재사용 전에 반드시 바로잡아야 할 부분입니다.

IK 도달조건

길이와 길이제곱을 비교한 차원 오류. 손목점 식과 elbow 분기도 누락.

Delay 정의

cmd−response로 적혔지만 양의 결과를 얻으려면 반대 부호.

Arm d₂ 부호

35쪽 동일 유도에서 +d₂가 −d₂로 바뀜. 위 기하식 기준 +d₂가 일관.

Forward dynamics 라벨

q̈=M⁻¹(τ−Cq̇−G)를 inverse dynamics라고 표기.

K/C 개별 계산

일부 run이 표시된 Ieq·ωn·ζ와 맞지 않아 최종 평균도 수정 필요.

실린더 반력

비압축성을 근거로 upstream torque를 삭제하면 가상일·에너지 일관성이 깨짐.

Calibration ≠ validation

평균 각속도에 맞춘 k와 같은 모델 내부 결과를 독립 검증으로 볼 수 없음.

11 / APEX

앞으로의 올바른 활용 경로

숫자를 복사하지 않고, 기구학–실린더–압력–동역학–제어를 식별 가능한 신호 사슬로 만드는 방법을 계승합니다.

Joint state
q, q̇, q̈
+
Cylinder map
s(q), Jₛ(q)
+
Head/Rod
pressure
→
Fhyd
=AhPh−ArPr
→
τhyd=JₛᵀF
↔
4-axis
Mq̈+h

APEX가 이미 더 나은 부분

  • Swing 포함 4축
  • AGX 실제 질량·COM·관성
  • CasADi Lagrangian M(q), h(q,q̇)
  • 에너지·역/정동역학 테스트

KMM에서 가져올 부분

  • 다중 자세·양방향 식별 프로토콜
  • 실린더 좌표와 joint 좌표 분리
  • JₛᵀF force mapping
  • Deadzone·delay·VFF 구조
  • 실차 pressure 기반 입력토크
현재 APEX의 두 가지 주의점새 4축 rigid model은 아직 라이브 MPC/DOB의 기존 placeholder dynamics를 대체하지 않았습니다. 또한 현재 CylinderPressureSensor는 AGX controller force를 면적으로 나눈 가상 압력이므로 독립 검증 센서가 아닙니다.
12 / PAGE MAP

70쪽 전체 페이지 지도

원문의 거의 모든 항목을 주제별로 다시 찾을 수 있도록 정리했습니다.

1–14 · 기구학 모델링
01–03표지, 목차, Chapter 1
04KIMM 실차 도식·CCW sign
05–06핀 거리, 고정각, 질량, 압력센서·단면적
073R FK/IK 및 도달조건
08Boom CS 길이–θ₁
09Arm DE 길이–θ₂
10Bucket 4절 GH 길이–θ₃
11–12Stroke→joint range→workspace
13–145차 EE 궤적과 Matlab 동작
15–27 · 실차 동특성 실험
15–16Chapter 2, time delay/deadband 정의
17–19계측 채널, 4 poses, 48회 protocol
20–22Delay 취득·절사평균·boom fitting
23–24Arm/Boom 속도 선형 fit·deadband
25–26Bucket 및 digging protocol·bucket 결과
273축 delay/deadband/gain 총괄
28–45 · 동역학·유압 모델링
28–31Chapter 3, 필요성, 가정, M/C/G
32–33중력 지배 torque 예시·Simscape tree
34–36Boom/Arm/Bucket torque↔force 유도
37–39실린더 반력의 upstream joint torque
40–41대수감쇠율·K/C 식별 흐름
42자세 고정 등가관성 계산
43–44ωn·ζ·K·C 결과와 Simscape 적용
45Flow integral의 물리적 의미
46–55 · 제어 블록
46–48Chapter 4, 전체 제어 블록과 인덱스
491kHz/100Hz/20Hz sample time
50–51CTC 설명·PID 단순화·중력 유지압
52–53Transport delay→1차 lag, deadband
54u_eff 적분과 경험 gain k
55PID gain·velocity feedforward
56–70 · 시뮬레이션·결론·부록
56–58Chapter 5, VFF A/B, circle motion
59–61Digging 4 데이터와 replay 방식 차이
62–63Angle/EE error, 3.0cm·8.3cm
64–65결론과 future work
66–694 homing 자세 원시 angle plot·이상 사례
70Bucket Exp 9–14 angle plot·선형성
13 / CHECK

이해 확인 질문

질문을 먼저 생각한 뒤 열어 보세요. 이 PDF를 정확히 읽었다면 답은 모델의 ‘경계’에 있습니다.

왜 3.0 cm를 실차 굴착 정확도라고 부르면 안 되는가?
흙 없는 Digging 4의 joint command를 시뮬레이션에 replay했고, 목표 EE도 동일 FK로 만든 내부 기준이기 때문입니다. 실제 tip ground truth와 비교하지 않았습니다.
실린더 반력을 비압축성 때문에 없앨 수 있는가?
없습니다. 비압축성은 힘 전달을 없애지 않습니다. 실린더 길이 Jacobian의 전치로 generalized torque를 계산하면 양 끝 힘과 upstream torque가 자동 포함됩니다.
Deadband 40.4%는 무엇을 직접 측정한 값인가?
직접적인 zero-neighborhood hysteresis 폭이 아니라, 큰 입력에서 얻은 평균 각속도 직선의 영점 절편입니다. valve overlap, 마찰, pressure buildup 등이 섞인 effective deadzone입니다.
자료의 제어기를 full computed torque control이라고 볼 수 있는가?
엄밀히는 아닙니다. M과 C를 controller에서 cancel하지 않고 PID+VFF를 쓰며, 중력 torque는 plant 내부의 유지 압력 특성으로 처리합니다.
APEX가 이 자료에서 가져와야 하는 것은 수치인가 구조인가?
구조입니다. s(q), Jₛ(q), pressure→force→torque, 다중 자세 식별, deadzone/delay/VFF 검증 절차를 가져오고 수치는 AGX와 실차에서 다시 식별해야 합니다.
14 / SOURCE

원문과 나란히 검증

아래는 분석 대상 원본 PDF입니다. 브라우저 PDF 뷰어에서 페이지를 이동하며 이 가이드의 내용을 교차 확인할 수 있습니다. 모바일 내장 브라우저에서 PDF가 보이지 않으면 원본 PDF를 새 창에서 여세요.