목표 근처에서 부르르 떨림

목표 근처에서 부르르 떨거나, 멈추지 않고 왔다 갔다 합니다. 손으로 예측 → 시뮬레이션으로 실험 → 예측과 비교 순서로 원인을 확인합니다.

MuJoCo 엔진과 OMX 모델을 불러오는 중입니다… (약 17 MB)
t = 0.00 s 준비
joint1 각도 [°] — 목표 10°

1개념: 관절 하나 = 스프링 + 브레이크 + 질량

PD 제어기는 관절에 스프링(Kp)과 브레이크(Kd)를 달아 주는 것과 같습니다. 관절이 돌려야 하는 관성 I가 질량 역할을 합니다.

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

이 셋이 정하는 값이 감쇠비 ζ입니다. ζ가 1보다 작으면 목표를 지나쳤다가(오버슈트) 돌아오고, 작을수록 더 많이 지나치고 오래 흔들립니다.

ζ = (Kd + b) / (2·√(Kp·I))
오버슈트 = e−π·ζ/√(1−ζ²) × 100 %

b는 관절 자체의 점성 감쇠(ROBOTIS 모델 값 0.2 N·m·s/rad)입니다. 중력이 영향을 주지 않도록 바닥에서 도는 joint1로 실험합니다. 팔은 앞으로 뻗은 자세로 고정하고, 관절 마찰은 끕니다.

2예측: 브레이크 없이(Kd = 0) 얼마나 지나칠까?

모델을 불러오는 중…

joint1을 10° 돌리라고 명령합니다. Kp = 4, Kd = 0일 때 오버슈트는 몇 %일까요?

%
풀이 보기

3실험: 게인을 바꿔 떨림 줄이기

실행하면 0.2초 뒤에 목표가 0°에서 10°로 바뀝니다. 3초 동안 오른쪽 그래프로 움직임을 봅니다.

  1. Kp 4, Kd 0, 지연 0으로 실행해 2단계 예측과 비교합니다.
  2. Kd를 올려 오버슈트를 5% 이하로 만들어 보세요. 몇 Kd부터 되나요? (식으로 미리 계산해 보면 더 좋습니다)
#KpKd지연예측 오버슈트실험 오버슈트결과

4실험: 같은 게인인데 명령이 늦게 도착하면?

실제 로봇은 센서 값을 읽고 모터에 명령이 도착하기까지 시간이 걸립니다. 제어기가 몇 ms 전의 각도를 보고 힘을 낸다고 생각하면 됩니다.

Kp 4, Kd 0.05로 두고 지연만 0 → 20 → 40 → 60 ms로 올려 실행해 보세요. 식(ζ)에는 지연이 없는데, 결과는 어떻게 되나요?

왜 지연이 있으면 더 흔들릴까요?