Maurício C. de Oliveira
Chapter 6: Controller Design
linearcontrol.info/fundamentals
\[\begin{align} s^2 + 2 \, \zeta \, \omega_n s + \omega_n^2 &= 0, \qquad \omega_n > 0, \end{align}\]
\[\begin{align*} s^2 + 2 \, \zeta \, \omega_n s &+ \omega_n^2 = (s - s_1)(s - s_2), & s_1 &= - \omega_n (\zeta + \sqrt{\zeta^2 - 1}), & s_2 &= - \omega_n (\zeta - \sqrt{\zeta^2 - 1}) \end{align*}\]
\(|\zeta| \geq 1\)
\(|\zeta| < 1\)
\[\begin{align} s &= - \omega_n (\zeta \pm \sqrt{\zeta^2 - 1}), & \omega_d &= \omega_n \sqrt{1 - \zeta^2}, & \phi_d &= \sin^{-1} \frac{\zeta \omega_n}{\omega_n} = \tan^{-1} \frac{\zeta \, \omega_n}{\omega_d} = \sin^{-1}\zeta \end{align}\]
\(\zeta > 0\)
\[\begin{align*} G(s) &= \frac{\omega_n^2}{s^2 + 2 \zeta \omega_n s + \omega_n^2}, & y(t) = 1 - \frac{1}{\sqrt{1 - \zeta^2}} e^{- \zeta \omega_n t} \sin( \omega_d t + \pi/2 - \phi_d), \quad t \geq 0 \end{align*}\]
\[\begin{align*} \frac{t_r}{t_n} &\approx 0.16 + 0.14 \, \zeta + 0.24 \, \zeta^3, & \frac{\tau}{t_n} &\approx 0.19 + 0.1 \, \zeta + 0.054 \, \zeta^3, & t_n &= \frac{2 \pi}{\omega_n} \end{align*}\]
\[\begin{align*} t_p &= \frac{\pi}{\omega_d}, & y_p &= 1 + e^{-\left.{\zeta \pi}\middle/{\sqrt{1-\zeta^2}}\right.}, & t_s &= \frac{\log(50)}{\zeta \, \omega_n} \approx \frac{3.9}{\zeta \, \omega_n} \end{align*}\]
\[\begin{align} G(s) &= \frac{\frac{p}{m}}{s + \frac{b}{m}}, & K(s) &= \frac{K_i}{s} \end{align}\]
\[\begin{align} H(s) &= \frac{K(s) G(s)}{1 + K(s) G(s)} = \frac{\frac{p}{m} K_i}{s^2 + \frac{b}{m} s + \frac{p}{m} K_i} \end{align}\]
\[\begin{align} \omega_n &= \sqrt{\frac{p}{m} K_i}, & \zeta &= \frac{b/m}{2 \sqrt{(p / m) \, K_i}} = \frac{b}{2 \sqrt{p \, m \, K_i}} \end{align}\]
\[\begin{align} G(s) &= \frac{\frac{p}{m}}{s + \frac{b}{m}}, & K(s) &= K_p + \frac{K_i}{s} \end{align}\]
\[\begin{align} H(s) &= \frac{K(s) G(s)}{1 + K(s) G(s)} = \frac{\frac{p}{m} (K_p s + K_i)}{s^2 + (\frac{b}{m} + \frac{p}{m} K_p ) s + \frac{p}{m} K_i} \end{align}\]
\[\begin{align} \omega_n &= \sqrt{\frac{p}{m} K_i}, & \zeta &= \frac{b/m + p/m K_p}{2 \sqrt{(p / m) \, K_i}} = \frac{b + p K_p}{2 \sqrt{p \, m \, K_i}} \end{align}\]
\[\begin{align*} G_0(s) &= \frac{1/J_r}{s^2 + (b/J_r) s + m \, g \, r / J_r} \end{align*}\]
\[\begin{align*} \omega_{n_\mathrm{ol}} &= \sqrt{\frac{m g r}{J_r}}, & \zeta_{\mathrm{ol}} &= \frac{b}{2\sqrt{J_r m g r}} \end{align*}\]
\[\begin{align*} G_\pi(s) &= \frac{1/J_r}{s^2 + (b/J_r) s - m \, g \, r / J_r} \end{align*}\]
\[\begin{align*} G_\pi(s) &= \frac{1}{J_r s^2 + b s - m \, g \, r} \end{align*}\]
\[\begin{align*} H_\pi(s) = \frac{K G_\pi(s)}{1 + K G_\pi(s)} &= \frac{K}{J_r s^2 + b s + K - m \, g \, r}, \\ \omega_{n_\pi} &= \sqrt{\frac{K - m \, g \, r}{J_r}}, \qquad \zeta_\pi = \frac{b}{2 \sqrt{J_r (K - m \, g \, r)}} \end{align*}\]
\(K > m g r\), for example \[\begin{align*} K &= 3 m g r & & \implies & \omega_{n_\pi} &= \sqrt{2} \, \omega_{n_\mathrm{ol}}, & \zeta_\pi &= \frac{1}{\sqrt{2}} \zeta_\mathrm{ol} \end{align*}\]
\[\begin{align*} G_0(s) &= \frac{1}{J_r s^2 + b s + m \, g \, r}, & \omega_{n_\mathrm{ol}} &= \sqrt{\frac{m g r}{J_r}}, & \zeta_{\mathrm{ol}} &= \frac{b}{2\sqrt{J_r m g r}} \end{align*}\]
\[\begin{align*} H_0(s) = \frac{K G_0(s)}{1 + K G_0(s)} &= \frac{K}{J_r s^2 + b s + K + m \, g \, r}, \\ \omega_{n_0} &= \sqrt{\frac{K + m \, g \, r}{J_r}}, \qquad \zeta_0 = \frac{b}{2 \sqrt{J_r (K + m \, g \, r)}} \end{align*}\]
\(K > -m g r\), for example \[\begin{align*} K &= 3 m g r & & \implies & \omega_{n_0} &= 2 \, \omega_{n_\mathrm{ol}}, & \zeta_0 &= \frac{1}{2} \zeta_\mathrm{ol} \end{align*}\]
\[\begin{align} u(t) &= K_p \left ( \bar{\theta}(t) - \theta(t) \right ) - K_d \, \dot{\theta}(t) \end{align}\]
\[\begin{align} u(t) &= K_p \left ( \bar{y}(t) - y(t) \right ) - K_d \, \dot{y}(t) \end{align}\]
\[\begin{align} U(s) &= K_p E(s) - K_d \, s Y(s), & E(s) &= \bar{Y}(s) - Y(s) \end{align}\]
\[\begin{align} u(t) &= K_p \, e(t) + K_d \, \dot{e}(t), & e(t) &= \bar{y}(t) - y(t) \end{align}\]
\[\begin{align} U(s) &= ( K_p + s K_d) E(s), & E(s) &= \bar{Y}(s) - Y(s) \end{align}\]
\[\begin{align*} H_\pi(s) = \frac{(K_p + K_d s) G_\pi(s)}{1 + (K_p + s K_d) G_\pi(s)} &= \frac{K_p + K_d s}{J_r s^2 + (K_d + b) s + (K_p - m \, g \, r)}, \\ \omega_{n_\pi} &= \sqrt{\frac{K_p - m \, g \, r}{J_r}}, \qquad \zeta_\pi = \frac{K_d + b}{2 \sqrt{J_r (K_p - m \, g \, r)}} \end{align*}\]
Choose \(K_p\) to set desired natural frequency, e.g. \[\begin{align*} K &= 3 m g r & & \implies & \omega_{n_\pi} &= \sqrt{2} \, \omega_{n_\mathrm{ol}} \end{align*}\]
Choose \(K_d\) to set desired damping ratio, e.g. \(\zeta_\pi = \frac{\sqrt{2}}{2} \approx 0.7\) \[\begin{align*} K_d &= 2 \, \zeta_\pi \sqrt{J_r (K_p - m \, g \, r)} - b = 2 \sqrt{J_r m \, g \, r} - b \end{align*}\]
Similarly around stable equilibrium
\[\begin{align} u(t) &= K_p \, e(t) + K_d \, \dot{e}(t) + K_i \int_{0}^{t} e(\tau)\, d \tau, & e(t) &= \bar{y}(t) - y(t) \end{align}\]
\[\begin{align} U(s) &= \left ( K_p + K_d \, s + K_i s^{-1} \right ) E(s) = \frac{K_d \, s^2+ K_p \, s + K_i}{s} E(s), & E(s) &= \bar{Y}(s) - Y(s) \end{align}\]
\[\begin{align} u(t) &= K_p \, e(t) + K_d \, \dot{e}(t) + K_i \int_{0}^{t} e(\tau)\, d \tau, & e(t) &= \bar{y}(t) - y(t) \end{align}\]
\[\begin{align} U(s) &= \left ( K_p + K_d \, s + K_i s^{-1} \right ) E(s) = \frac{K_d \, s^2+ K_p \, s + K_i}{s} E(s), & E(s) &= \bar{Y}(s) - Y(s) \end{align}\]
\(\hspace{0.8ex}\) as a function of \(\alpha > 0\)
\[\begin{align*} 1 + \alpha L(s) &= 0, & K(s) &= \alpha C(s), & L(s) &= C(s) G(s) \end{align*}\]
\[\begin{align} \label{eq:rlcrossing} L(s) &= - \frac{1}{\alpha} < 0 & & \implies & \angle L(s) &= \pi \end{align}\]
\[\begin{align*} L &= \beta \frac{N_L}{D_L} = \frac{\beta \, (s - z_1)(s - z_2)\cdots(s - z_m)}{(s - p_1)(s - p_2)\cdots(s - p_n)} \end{align*}\] then \[\begin{align*} \angle L = \angle \beta + \angle N_L - \angle D_L = \angle \beta + \sum_{i = 1}^{m} \angle (s - z_i) - \sum_{k = 1}^{n} \angle (s - p_k) \end{align*}\]
\[\begin{align*} \angle L(s_0) &= \angle \beta + \sum_{i = 1}^{m} \angle (s_0 - z_i) - \sum_{k = 1}^{n} \angle (s_0 - p_k) \\ &= \angle \beta + \psi_1 - \theta_1 - \theta_2 - \theta_3 \end{align*}\]
\(L\) rational and strictly proper with real coefficients
begin at the poles of \(L\) \[\begin{align*} \lim_{\alpha \rightarrow 0} D_L(s) \left ( 1 + \alpha L(s) \right ) &= \lim_{\alpha \rightarrow 0} D_L(s) + \alpha \beta N_L(s) = D_L(s) \end{align*}\]
end at the zeros of \(L\) \[\begin{align*} \lim_{\alpha \rightarrow \infty} \alpha^{-1} D_L(s) \left ( 1 + \alpha L(s) \right ) &= \lim_{\alpha \rightarrow \infty} \alpha^{-1} D_L(s) + \beta N_L(s) = \beta N_L(s) \end{align*}\]
\(L\) rational and strictly proper with real coefficients and \(\beta > 0\)
\(L\) rational and strictly proper with real coefficients and \(\beta > 0\)
\[\begin{align*} \alpha &= K_p, & L(s) &= \frac{\frac{p}{m}}{s + \frac{b}{m}} = \frac{3.7}{s + 0.05} \end{align*}\]
\(L\) rational and strictly proper with real coefficients
\[\begin{align*} \alpha &= K_i, & L(s) &= G(s) \, C(s) = \frac{3.7}{s (s + 0.05)} \end{align*}\]
\[\begin{align*} c &= \frac{-0.05 + 0}{2} = -0.025, & \phi_1 &= \frac{\pi}{2}, & \phi_2 &= \frac{3\pi}{2} \end{align*}\]
\[\begin{align*} p_1 &= a, & p_2 &= - a + j b, & p_2 &= - a - j b, & z_1 &= - a \end{align*}\]
\[\begin{align*} c &= \frac{(-a - j b) + (-a + j b) + (a) - (-a)}{3 - 1} = 0, & \phi_1 &= \frac{\pi}{2}, & \phi_2 &= \frac{3\pi}{2} \end{align*}\]
\[\begin{align*} G &= \frac{\frac{p}{m}}{s + \frac{b}{m}} = \frac{3.7}{s + 0.05}, & K(s) &= K_p + \frac{K_i}{s} = K_p \frac{s + K_i/K_p}{s} \end{align*}\]
\[\begin{align*} \alpha &= K_p, & L &= G \, C = \frac{3.7 \left (s + {K_i}/{K_p} \right )}{s \, (s + 0.05)} \end{align*}\]
\[\begin{align*} \frac{K_i}{K_p}= \gamma \frac{b}{m} = \gamma \, 0.05 \end{align*}\]
\[\begin{align*} C_\mathrm{PD}(s) &= K_d \left (s + z \right), & z &= \frac{K_p}{K_d} \end{align*}\]
\[\begin{align} m &= 0.5 \text{kg}, & \ell &= 0.3 \text{m}, & r &= \ell/2 = 0.15 \text{m} \\ b &= 0 \text{kg/s}, & g &= 9.8 \text{m/s}^2, & % J &= \frac{m \ell^2}{3} = 0.015 \text{kg m}^2. J &= \frac{m \ell^2}{12} = 3.75 \times 10^{-3} \text{kg m}^2, & J_r &= J + m r^2 = 0.015 \end{align}\]
\[\begin{align*} K_d &=3 \, m \, g \, r \approx 0.21, & K_p &=2 \sqrt{J_r m \, g \, r} - b \approx 2.21, & z &\approx 10.5, & C_\mathrm{PD}(s) &\approx 0.21 (s + 10.5) \end{align*}\]
\[\begin{align*} G_\pi(s) &= \frac{66.7}{(s + 7)(s - 7)} \end{align*}\]
\[\begin{align*} K(s) &= C_\mathrm{PD}(s) = K_d (s + z), & z &= \frac{K_p}{K_d} > 0 \end{align*}\]
\[\begin{align*} \alpha &= K_d, & L &= \frac{1}{K_d} G_\pi \, C_\mathrm{PD} = \frac{66.7 (s + z)}{(s + 7)(s - 7)} \end{align*}\]
\(\qquad z = 10.5\)
\[\begin{align*} K &= K_p \frac{(s + z)}{s} \end{align*}\]
\[\begin{align*} \alpha &= K_p, & L &= \frac{66.7 (s + z)}{s (s + 7)(s - 7)} \end{align*}\]
\[\begin{align*} K(s) = K \frac{s + z}{s + p} \end{align*}\]
\[\begin{align*} \alpha &= K & L &= \frac{66.7 (s + z)}{(s + 7)(s - 7)(s + p)} \end{align*}\]
\[\begin{align*} c &= \frac{7 - 7 + (-p) - (-z)}{n - m} = \frac{z - p}{2}, & \phi_1 &= \frac{\pi}{2}, & \phi_2 &= \frac{3\pi}{2} \end{align*}\]
Possible with large \(K\) only if \[\begin{align*} c &< 0 & & \implies & p &> z \end{align*}\]
\[\begin{align*} \alpha &= K & L &= \frac{66.7 (s + z)}{(s + 7)(s - 7)(s + p)} \end{align*}\]
\(p = 8 z \gg z \approx 10.5\)
Root-locus near origin is mostly unaffected
\[\begin{align*} \alpha &= K & L &= \frac{66.7 (s + z)}{(s + 7)(s - 7)(s + p)} \end{align*}\]
\[\begin{align*} \alpha &= K & L &= \frac{66.7 (s + z)}{(s + 7)(s - 7)(s + p)} \end{align*}\]
\[\begin{align*} \alpha &= K_i, & L = - \frac{E}{\tilde{W}} = - s^{-1} \frac{E}{W} = s^{-1} D = \frac{s^{-1} G_\pi}{1 + G_\pi \, C_\mathrm{lead}} \end{align*}\]
\[\begin{align*} \alpha &= K_i, & L = - \frac{E}{\tilde{W}} = - s^{-1} \frac{E}{W} = s^{-1} D = \frac{s^{-1} G_\pi}{1 + G_\pi \, C_\mathrm{lead}} \end{align*}\]