ラグランジュ/ニュートン-オイラー:
$$\mathbf{M}(\boldsymbol{\theta})\ddot{\boldsymbol{\theta}}+ \mathbf{C}(\boldsymbol{\theta},\dot{\boldsymbol{\theta}})\dot{\boldsymbol{\theta}}+ \mathbf{G}(\boldsymbol{\theta}) = \boldsymbol{\tau}$$慣性行列(一様棒、$l_{c}=L/2$、$I_{z}=mL^2/12$):$M_{11}= m_1 l_{c1}^2 + I_{z1} + m_2\left(L_1^2 + l_{c2}^2 + 2L_1 l_{c2} c_2\right) + I_{z2}$
重力ベクトル:$G_1 = (m_1 l_{c1}+m_2 L_1)g c_1 + m_2 g l_{c2} c_{12}$、$G_2 = m_2 g l_{c2} c_{12}$
三次スプライン:$\theta(t)=\theta_0+(\theta_f-\theta_0)\left[3(t/T)^2-2(t/T)^3\right]$