목표보다 조금 아래에서 멈춤

목표보다 조금 아래에서 멈추고, 팔을 멀리 뻗을수록 오차가 커집니다. 손으로 예측 → 시뮬레이션으로 실험 → 예측과 비교 순서로 원인을 확인합니다.

MuJoCo 엔진과 OMX 모델을 불러오는 중입니다… (약 17 MB)
t = 0.00 s 준비
joint2 처짐 (실제 − 목표) [°]

1개념: PD만 쓰면 중력만큼 처진다

PD 제어기는 오차가 있어야 힘을 냅니다. 팔이 멈춘 상태에서는 속도가 0이라 Kd 항이 없고, 스프링 힘 Kp·e가 중력 토크 g(q)와 같아지는 곳에서 멈춥니다.

Kp · e = g(q) → 처짐 e ≈ g(q) ÷ Kp [rad]

중력보상은 모델로 계산한 g(q)를 처음부터 더해 주는 방법입니다. 그러면 스프링은 중력을 버틸 필요가 없어 처짐이 0이 됩니다.

τ = Kp·(q목표 − q) − Kd·q + g(q)

팔을 뻗은 자세(joint2 +80.2°, joint3 −80.2°)에서 joint2만 이 제어기로 버팁니다. 관절 마찰은 끄고 봅니다(마찰이 있으면 그 근처 어딘가에서 멈춰 결과가 흩어집니다).

2예측: Kp = 10이면 몇 도 처질까?

모델을 불러오는 중…
°
풀이 보기

3실험: Kp와 중력보상

목표 자세에서 시작해 4초 동안 버팁니다. 4초 뒤 joint2가 목표에서 몇 도 처졌는지 잽니다.

  1. 중력보상 끔, Kp 10 → 2단계 예측과 비교
  2. Kp를 5, 20, 50으로 바꿔 보기 → 처짐이 Kp에 반비례하나요?
  3. 중력보상 켬 → 처짐이 얼마가 되나요?
#Kp중력보상손끝 물체예측 g÷Kp실험 처짐

4응용: 모델에 없는 무게가 있으면?

중력보상은 모델의 질량으로 g(q)를 계산합니다. 손끝에 모델이 모르는 물체(예: 케이블, 카메라)가 달려 있으면, 그만큼은 다시 스프링이 버텨야 합니다.

처짐 ≈ m · g · x손끝 ÷ Kp

중력보상을 켜고 Kp = 10일 때, 모델에 없는 100 g이 손끝(joint2에서 수평거리 — m)에 있으면 몇 도 처질까요?

°

이 실행은 Kp 10, 중력보상 켬으로 합니다. 결과는 위 표에 함께 쌓입니다.

5정리 퀴즈

팔이 처지는 것을 고치는 가장 좋은 방법은?