궤적을 늦게 따라옴

계획한 궤적을 늦게 따라오고, 빠른 구간에서 오차가 크게 벌어집니다. 손으로 예측 → 시뮬레이션으로 실험 → 예측과 비교 순서로 원인을 확인합니다.

MuJoCo 엔진과 OMX 모델을 불러오는 중입니다… (약 17 MB)
t = 0.00 s 준비
joint1 각도 [°] — 계획(점선)과 실제

1개념: 빨리 돌리려면 토크가 필요하다

관절을 각가속도 α로 돌리려면 관성 × 가속도만큼 토크가 필요합니다(τ = I·α, 운동방정식의 M(q)·q 항). 같은 각도를 더 짧은 시간에 가려면 α가 시간의 제곱에 반비례해 커집니다.

0에서 Δq만큼 부드러운 코사인 궤적으로 T초 동안 움직이면 가장 큰 가속도는:

α최대 = Δq · π² ÷ (2·T²)
필요 토크 I·α최대 ≤ τ한계 → T최소 = π · √(I·Δq ÷ (2·τ한계))

피드포워드는 필요한 토크 I·α를 미리 계산해 넣는 방법입니다. PD만 쓰면 오차가 생긴 뒤에야 힘을 내서 늦습니다. 하지만 T최소보다 빠른 궤적은 어떤 제어기로도 따라갈 수 없습니다.

joint1(바닥 회전)을 0° → 90°로 돌립니다. 팔은 뻗은 자세, 손끝에 200 g 물체, 모터 한계 1.5 N·m (XL430), PD는 Kp 20, Kd 0.5. 관절 마찰은 끕니다.

2예측: 90°를 가장 빨리 몇 초에 갈 수 있을까?

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

3실험: 내 예측이 맞는지 확인

이동이 끝난 뒤 1.5초 더 봅니다. 계획과 실제의 최대 차이가 2° 이하면 따라감입니다.

피드포워드를 켜고, 내 예측 T최소보다 10% 짧게, 예측 그대로, 10% 길게 세 번 움직여 봅니다. 짧으면 늦고 길면 따라가야 예측이 맞습니다.

내 예측(2단계): 아직 없음

이번에는 피드포워드를 끄고 같은 시간(내 예측 + 10%)으로 움직여 봅니다.

직접 값 넣어 보기 (선택) — 피드포워드 없이는 얼마나 느려야 할까?
#T피드포워드최대 오차토크 한계에 걸린 시간결과

4정리 퀴즈

T = 0.4초(T최소보다 빠름)로 실행했더니 피드포워드를 켜도 크게 늦습니다. 맞는 해결책은?