실차 계측에서 제어기까지,
하나의 신호 사슬로 읽기
이 가이드는 PDF의 기구학, 실린더 기하, 실차 동특성, 강체 동역학, 유압 근사, PID·VFF, 시뮬레이션 결과를 재구성합니다. 동시에 자료가 실제로 증명한 것과 아직 증명하지 못한 것을 분리합니다.
읽기 모드
개요는 핵심만, 학습은 대부분의 내용, 감사는 수식 오류와 검증 한계에 집중합니다.
장비를 숫자로 옮기는 첫 단계
본문은 KIMM 실차의 핀 간 거리, 실린더 장착점, 링크 질량과 stroke를 측정해 3-link 평면 모델의 기준을 만듭니다.
실측 핵심값
| 계통 | 주요 길이 | 질량 |
|---|---|---|
| Boom | OB 2475, OC 1225, OS 340 mm | 182 kg |
| Arm | AB 1365, AE 1495, GJ 1045 mm | 122 kg |
| Bucket | AK 840, HJ 315, HI 280 mm | 92 kg |
실린더 stroke
Boom CS 1095–1470 mmArm DE 995–1655 mmBucket GH 785–1295 mm관절 범위
θ₁ −4.7–66°θ₂ 225–348°θ₃ 216–395°3R 기구학을 직접 움직여 보기
링크 길이와 세 관절각으로 bucket tip의 위치와 자세를 계산합니다. 아래 슬라이더는 PDF 7쪽의 FK를 그대로 구현했습니다.
관절각과 실린더 길이는 같은 상태가 아니다
Boom·arm은 코사인 법칙, bucket은 bell-crank/4절 링크를 연쇄 계산합니다. 제어와 힘 추정을 연결하는 핵심은 길이 함수의 미분입니다.
Boom · CS
단일 삼각형. 방향각과 ‘각의 크기’를 구분해야 합니다.
Arm · DE
Reflex-angle 표현이라 단위와 wrap에 민감합니다.
Bucket · GH
acos 연쇄는 조립 모드와 방향을 잃으므로 atan2/연속성 검사가 필요합니다.
실차 동특성 실험 프로토콜
네 homing 자세에서 양·음 방향과 여러 입력 크기를 시험해 pose, direction, amplitude 효과를 보려 했습니다.
Homing
임시 PI로 목표 자세 이동. 이미 4–5° residual error 존재.
Single axis
Boom 또는 arm 한 축만 선택.
0.5 s pulse
정규화 속도명령을 open loop로 인가.
Measure
command, feedback, joint angle, pressure, EE 기록.
Abort
기계 한계점 도달 전 강제 종료.
계획된 입력
| 축 | 입력 | 자세 |
|---|---|---|
| Arm | ±0.70, ±0.50, ±0.45 | 4 poses |
| Boom | ±0.50, ±0.40, ±0.30 |
총 48회 계획: 축당 24회.
데이터 품질
평균 sampling ≈16 ms, 비균일누락·이상값한계점 도달Homing error 4–5°네 자세에서 max/min을 버리고 중간 두 값만 평균했습니다. 이는 outlier를 줄이는 대신 실제 pose dependence도 지울 수 있습니다.
지연·불감대·속도 이득
슬라이더를 움직이면 자료의 채택 모델이 현재 명령에서 무엇을 예측하는지 볼 수 있습니다.
Boom
deadband
Arm
deadband
Bucket
deadband
기구학에서 힘과 관성으로
표준 manipulator 방정식으로 토크가 관절 가속도를 만드는 과정을 모델링하고 Simscape rigid body tree로 구현합니다.
M(q)
질량행렬. 링크 COM 선속도 Jacobian과 각속도 Jacobian·관성으로 구성.
C(q,q̇)q̇
Coriolis·centripetal torque. C 자체는 force가 아니라 행렬입니다.
G(q)
Potential energy gradient. 중력벡터 정의에 따라 부호가 달라집니다.
Inverse dynamics
원하는 움직임에 필요한 torque 계산.
Forward dynamics
입력 torque에서 실제 가속도 계산. PDF 31쪽은 이 식도 ‘Inverse’로 잘못 표기합니다.
간단한 모델과 실제 연속방정식의 차이
자료는 빠른 제어 시뮬레이션을 위해 입력 유량의 적분을 힘으로 바꾸지만, 움직이는 실린더에서는 빠진 항이 큽니다.
모든 유량이 압력을 만든다
Piston displacement, leakage, relief, 양 chamber를 생략합니다. 작은 bias도 force로 계속 누적될 수 있습니다.
유량은 이동과 압축에 나뉜다
공급·탱크압, valve flow map, cavitation, relief와 chamber volume을 포함해야 합니다.
대수감쇠율로 얻은 국소 등가 K/C
| 축 | Ieq | ωn | ζ | PDF 최종 K/C | 일관 재계산 평균 K/C |
|---|---|---|---|---|---|
| Boom | 1732.94 | 18.72 | .0697 | 6.22e5 / 4.72e3 | 6.083e5 / 4.579e3 |
| Arm | 216.08 | 38.32 | .1143 | 3.35e5 / 2.16e3 | 3.178e5 / 1.852e3 |
| Bucket | 21.64 | 57.20 | .1314 | 7.2e4 / 3.26e2 | 7.165e4 / 3.178e2 |
실제 구현은 PID + 속도 앞먹임
CTC를 설명하지만 최종 controller는 M·C를 cancel하지 않습니다. 중력 유지압을 plant 특성으로 넣은 grey-box 위치제어기입니다.
xₑ
kinematics
+ VFF
+ deadband
force model
F → τ
dynamics
EE output
Multi-rate
| Solver / plant | 1 kHz |
| Angle sensor | 100 Hz |
| Reference / controller | 20 Hz |
Gains
| 축 | Kp / Ki / Kd | VFF |
|---|---|---|
| Boom | 3e7 / 1e2 / 5e5 | .17 |
| Arm | 1.5e7 / 1e3 / 2e5 | .08 |
| Bucket | 2e6 / 1e3 / 1e5 | .04 |
단위·signal scaling에 종속되어 다른 장비로 복사할 수 없습니다.
무엇이 좋아졌고, 무엇은 검증되지 않았나
VFF는 동일 시뮬레이터 안에서 phase lag를 줄였지만, 실차·토양·독립 궤적에 대한 일반화는 확인되지 않았습니다.
VFF 적용 전 → 후 RMSE
Circle
center (2,0), 10 s. 자유공간 다양한 궤적의 내부 추종 예시.
Digging replay
평균 EE 오차. 실제 실차 tip ground truth가 아니라 동일 FK 내부 기준.
Peak error
6–10 s bucket 5.5° 급변이 EE에서 확대된 값.
수학·검증 감사 결과
자료의 연구적 가치는 유지하면서, 재사용 전에 반드시 바로잡아야 할 부분입니다.
길이와 길이제곱을 비교한 차원 오류. 손목점 식과 elbow 분기도 누락.
cmd−response로 적혔지만 양의 결과를 얻으려면 반대 부호.
35쪽 동일 유도에서 +d₂가 −d₂로 바뀜. 위 기하식 기준 +d₂가 일관.
q̈=M⁻¹(τ−Cq̇−G)를 inverse dynamics라고 표기.
일부 run이 표시된 Ieq·ωn·ζ와 맞지 않아 최종 평균도 수정 필요.
비압축성을 근거로 upstream torque를 삭제하면 가상일·에너지 일관성이 깨짐.
평균 각속도에 맞춘 k와 같은 모델 내부 결과를 독립 검증으로 볼 수 없음.
앞으로의 올바른 활용 경로
숫자를 복사하지 않고, 기구학–실린더–압력–동역학–제어를 식별 가능한 신호 사슬로 만드는 방법을 계승합니다.
q, q̇, q̈
s(q), Jₛ(q)
pressure
=AhPh−ArPr
Mq̈+h
APEX가 이미 더 나은 부분
- Swing 포함 4축
- AGX 실제 질량·COM·관성
- CasADi Lagrangian M(q), h(q,q̇)
- 에너지·역/정동역학 테스트
KMM에서 가져올 부분
- 다중 자세·양방향 식별 프로토콜
- 실린더 좌표와 joint 좌표 분리
- JₛᵀF force mapping
- Deadzone·delay·VFF 구조
- 실차 pressure 기반 입력토크
70쪽 전체 페이지 지도
원문의 거의 모든 항목을 주제별로 다시 찾을 수 있도록 정리했습니다.
1–14 · 기구학 모델링
15–27 · 실차 동특성 실험
28–45 · 동역학·유압 모델링
46–55 · 제어 블록
56–70 · 시뮬레이션·결론·부록
이해 확인 질문
질문을 먼저 생각한 뒤 열어 보세요. 이 PDF를 정확히 읽었다면 답은 모델의 ‘경계’에 있습니다.
왜 3.0 cm를 실차 굴착 정확도라고 부르면 안 되는가?
실린더 반력을 비압축성 때문에 없앨 수 있는가?
Deadband 40.4%는 무엇을 직접 측정한 값인가?
자료의 제어기를 full computed torque control이라고 볼 수 있는가?
APEX가 이 자료에서 가져와야 하는 것은 수치인가 구조인가?
원문과 나란히 검증
아래는 분석 대상 원본 PDF입니다. 브라우저 PDF 뷰어에서 페이지를 이동하며 이 가이드의 내용을 교차 확인할 수 있습니다. 모바일 내장 브라우저에서 PDF가 보이지 않으면 원본 PDF를 새 창에서 여세요.