이론 노트 · 실험 10 · 역진자 카트

역진자를 세우는 최소 비례 이득: 선형화 계산

실험실은 막대가 기울 때 카트가 어느 쪽으로 움직여야 하는지 묻습니다. 이 노트는 힘으로 답합니다. 제어기가 내는 첫 힘과 그 출처, 막대를 세울 수 있는 가장 작은 각도 이득, 그리고 단순한 PD 극점이 눈에 보이는 움직임을 설명하지 못하는 이유입니다.

실험실의 막대 균형 잡기 실험에 딸린 이론 노트입니다. 실험은 실험실에서 하고, 무엇이 왜 보일지는 여기서 미리 계산합니다.

이 실험에 쓰이는 모델

M = 0.5 kg 카트 위에 길이 l = 0.3 m의 질량 없는 막대 끝 점질량 m = 0.2 kg이 있습니다. 카트 감쇠는 b = 0.1 N·s/m, 힘 한계는 ±30 N입니다. 제어기는 20 ms마다 F = kp(θ − θd) + kd·θ̇f를 계산하며 kp = 15 N/rad, kd = 3 N·s/rad, θ̇f는 측정 각도 차분을 거른 값입니다. 캐스케이드 모드에서 바깥 루프는 ±0.18 rad로 자른 θd = −0.10x − 0.16ẋ를 요구합니다. 막대는 6°에서 시작합니다.

x¨=F+msin⁡θ (lθ˙2−gcos⁡θ)−bx˙M+msin⁡2θ,θ¨=gsin⁡θ−x¨cos⁡θl\ddot{x}=\frac{F+m\sin\theta\,(l\dot{\theta}^2-g\cos\theta)-b\dot{x}}{M+m\sin^2\theta},\qquad \ddot{\theta}=\frac{g\sin\theta-\ddot{x}\cos\theta}{l}
θ¨≈45.78 θ+0.67 x˙−6.67 F,x¨≈2F−0.2 x˙−3.92 θ\ddot{\theta}\approx 45.78\,\theta+0.67\,\dot{x}-6.67\,F,\qquad \ddot{x}\approx 2F-0.2\,\dot{x}-3.92\,\theta

여기서 중요한 단순화

  • 선형 모델은 직립점 주위의 1차 항만 남깁니다. 6°에서 sin θ와 θ의 차이는 0.2%입니다.
  • PD 예측은 카트 항, 20 ms 갱신, 미분 필터를 무시합니다. 필터 시정수(72.9 ms)가 막대 자체의 시정수 0.148 s의 절반이므로 여기서는 이 생략이 중요합니다.

손으로 먼저 예측하기

선형화하면 중력은 라디안당 45.78 rad/s²로 막대를 직립에서 멀어지게 하고, 카트에 가한 1 N은 막대를 6.67 rad/s²로 되돌립니다. 각도 비례 이득은 중력을 이겨야 하므로 6.67 kp > 45.78입니다. 프리셋 이득에서 이상적인 PD 루프는 실수 극점 두 개를 갖습니다. 첫 갱신에는 킥이 더해집니다. 미분 항의 이전 측정값이 0에서 시작하므로 초기 각도 6°가 20 ms 한 주기 만에 나타난 것처럼 보입니다.

kp>45.786.67=6.87 N/radk_p>\frac{45.78}{6.67}=6.87\ \mathrm{N/rad}
s2+6.67kd s+(6.67kp−45.78)=s2+20s+54.22 ⇒ s=−3.23, −16.77s^2+6.67k_d\,s+(6.67k_p-45.78)=s^2+20s+54.22\ \Rightarrow\ s=-3.23,\ -16.77
F(0)=kpθ0+kd⋅0.24 θ0Ts=1.57+3.77=5.34 NF(0)=k_p\theta_0+k_d\cdot 0.24\,\frac{\theta_0}{T_s}=1.57+3.77=5.34\ \mathrm{N}
x¨(0)=10.23 m/s2,θ¨(0)=−30.49 rad/s2\ddot{x}(0)=10.23\ \mathrm{m/s^2},\quad \ddot{\theta}(0)=-30.49\ \mathrm{rad/s^2}

시뮬레이션 결과와 비교

엔진의 첫 힘은 계산대로 기운 쪽으로 5.34 N이고 카트는 막대 밑으로 가속합니다. 막대는 회복하고 카트는 원점으로 돌아오지만 이상적인 PD 극점이 말하는 방식은 아닙니다. 각도는 0.20 s에 −7.96°까지 넘어갔다가 0.10, 0.34, 0.56 s에 부호를 바꾸며 진동합니다. 시작 킥, 필터 지연, 20 ms 지연이 모두 2극점 모델에서 빠졌기 때문입니다. 카트는 최대 0.08 m 움직입니다.

다음에 바꿔 볼 것

  1. kp를 한계 6.87보다 낮은 6 N/rad로 하기

    선형 각도 루프에 +0.28 s⁻¹의 우반평면 근이 생깁니다. 갑자기 쓰러지기보다 천천히 기운다고 예측합니다. 엔진은 회복하지 못합니다. 막대는 30.51°까지 기울고 8초 실행을 29.59°, 카트는 원점에서 0.92 m인 채로 끝냅니다.

  2. 막대를 20°에서 시작하기

    첫 힘은 각도에 비례해 17.80 N이 되지만 ±30 N 안이므로 카트가 더 크게 움직이며 회복한다고 예측합니다. 엔진은 최대 17.80 N, 카트 이동 0.25 m로 회복합니다.

이 결과를 읽을 때 흔한 실수

  • 기운 반대쪽으로 카트를 움직이는 것. 힘은 기운 쪽으로 향합니다. 5.34 N이 카트를 10.23 m/s²로 가속해 막대를 30.49 rad/s²로 되돌립니다.
  • 균형을 위치 제어로 읽는 것. 여기서 카트가 돌아오는 것은 캐스케이드 모드가 목표 각도를 더하기 때문이며, 위치 실험에서 이를 빼 봅니다.
  • 시간 예측에 2극점 모델을 믿는 것. 이 모델은 진동이 없다고 예측하지만 실행은 필터와 시계 때문에 진동합니다.

이어서 볼 곳

실험실에서 이 실험 해 보기에서 결과를 고정하고 위의 두 가지 변화를 시험해 보세요.

강의

이 노트의 용어

계산기

근궤적 계산기: 근궤적 계산기에서 선형화한 각도 루프 kd(s + kp/kd) × 6.67/(s² − 45.78)를 K = kd = 3으로 엽니다. 극점은 −3.23과 −16.77이고, K가 1.373보다 클 때, 곧 kp = 5K가 6.87 N/rad보다 클 때 안정합니다.