2重剛体振り子

(問題) 2つの剛体によって構成された2重剛体振り子(Double Rigid Pendulum)がある。 これらは重力と逆向きの方向を$y$軸とする$xy$平面上で回転運動するものとする。 剛体1は質量$m_1$で、原点$O$に固定された回転軸$O_1$をもち、 $O_1$から剛体1の重心$G_1$までの距離を$c_1$とする。 また、剛体1の$O_1$周りの慣性モーメントを$I_{O_1}$とする。 もうひとつの剛体2は質量$m_2$で、剛体1上の$O_1$から距離$b$、 角度 $\angle G_1O_1O_2=\beta$の回転軸$O_2$をもち、 $O_2$から剛体2の重心$G_2$までの距離を$c_2$とする。 また、剛体2の$G_2$周りの慣性モーメントを$I_{G_2}$とする。 この2重剛体振り子のラグランジュ運動方程式を記述せよ。 また、計算機シミュレーションなどをしやすいように、 求められた2階常微分方程式を連立の1階常微分方程式に変換せよ。 また、この振り子が各々の角速度に比例する抵抗 や外力 を受けている場合においても同様に求めよ。

(解答) 剛体1,2のy軸に対する角度を $\theta_1,\theta_2$とする。 剛体1の重心$G_1$の座標 $(x_{G_1},y_{G_1})$およびその速度$V_{G_1}$の2乗は、

$$x_{G_1} = c_1\sin\theta_1$$ (53)

$$y_{G_1} = -c_1\cos\theta_1$$ (54)

$$V_{G_1}^2 = \dot x_{G_1}^2 + \dot y_{G_1}^2$$

$$= (c_1\dot\theta_1\cos\theta_1)^2 + (c_1\dot\theta_1\sin\theta_1)^2$$

$$= c_1^2\dot\theta_1^2$$ (55)

となる。 剛体2の重心$G_2$の座標 $(x_{G_2},y_{G_2})$およびその速度$V_{G_2}$の2乗は、

$$x_{G_2} = b\sin(\theta_1+\beta)+c_2\sin\theta_2$$ (56)

$$y_{G_2} = -b\cos(\theta_1+\beta)-c_2\cos\theta_2$$ (57)

$$V_{G_2}^2 = \dot x_{G_2}^2 + \dot y_{G_2}^2$$

$$= \left\{ b\dot\theta_1\cos(\theta_1+\beta)+c_2\dot\theta_2\cos\the... ...left\{ b\dot\theta_1\sin(\theta_1+\beta)+c_2\dot\theta_2\sin\theta_2 \right\}^2$$

$$= b^2\dot\theta_1^2 + c_2^2\dot\theta_2^2 + 2bc_2\dot\theta_1\dot\theta_2\cos(\theta_1+\beta-\theta_2)$$ (58)

となる。 ここで、剛体1の運動エネルギー$T_1$および位置エネルギー$U_1$は、

$$T_1 = \frac12 I_{O_1} \dot\theta_1^2$$ (59)

$$U_1 = m_1 g y_{G_1}$$

$$= -m_1 g c_1\cos\theta_1$$ (60)

また、剛体2の運動エネルギー$T_2$および位置エネルギー$U_2$は、

$$T_2 = \frac12 I_{G_2} \dot\theta_2^2 + \frac12 m_2 V_{G_2}^2$$

$$= \frac12 I_{G_2} \dot\theta_2^2 + \frac12 m_2 \left\{ b^2\dot\thet... ...theta_2^2 + 2bc_2\dot\theta_1\dot\theta_2\cos(\theta_1+\beta-\theta_2) \right\}$$ (61)

$$U_2 = m_2 g y_{G_2}$$

$$= -m_2 g \left\{ b\cos(\theta_1+\beta) + c_2\cos\theta_2 \right\}$$ (62)

となる。 この2重剛体振り子のラグランジュ関数$L$は、

$$L = T - U$$

$$= (T_1+T_2) - (U_1+U_2)$$

$$= \frac12 I_{O_1} \dot\theta_1^2 + \frac12 I_{G_2} \dot\theta_2^2 + \frac12 m_2 b^2\dot\theta_1^2 + \frac12 m_2 c_2^2\dot\theta_2^2$$

$$+ m_2 bc_2\dot\theta_1\dot\theta_2\cos(\theta_1+\beta-\theta_2) +... ... c_1\cos\theta_1 + m_2 g \left( b\cos(\theta_1+\beta) + c_2\cos\theta_2 \right)$$

$$= \frac12 \left( I_{O_1} + m_2 b^2 \right) \dot\theta_1^2 + \frac12 \left( I_{G_2} + m_2 c_2^2 \right) \dot\theta_2^2$$

$$+ m_2 bc_2\dot\theta_1\dot\theta_2\cos(\theta_1+\beta-\theta_2) + m_1 g c_1\cos\theta_1 + m_2 g b\cos(\theta_1+\beta) + m_2 g c_2\cos\theta_2$$ (63)

となる。 このラグランジュ関数$L$から $\theta_1,\theta_2$ に関するラグランジュ運動方程式をたてるには、 以下の関係式を用いればよい。

$$\begin{eqnarray*} \frac{d}{dt} \frac{\partial L}{\partial\dot\theta_1} - \frac... ...rtial\dot\theta_2} - \frac{\partial L}{\partial\theta_2} &=& 0 \end{eqnarray*}$$

これを具体的に求めると、

$$\frac{\partial L}{\partial\dot\theta_1} = \left( I_{O_1} + m_2 b^2 \right) \dot\theta_1 + m_2 bc_2\dot\theta_2\cos(\theta_1+\beta-\theta_2)$$

$$\Rightarrow \frac{d}{dt} \frac{\partial L}{\partial\dot\theta_1} = \left( I_{O_1} + m_2 b^2 \right) \ddot\theta_1 + m_2 bc_2\left\{ ... ... \dot\theta_2(\dot\theta_1-\dot\theta_2) \sin(\theta_1+\beta-\theta_2) \right\}$$ (64)

$$- \frac{\partial L}{\partial\theta_1} = m_2 bc_2\dot\theta_1\dot\theta_2\sin(\theta_1+\beta-\theta_2) + m_1 g c_1\sin\theta_1 + m_2 g b\sin(\theta_1+\beta)$$ (65)

$$\frac{\partial L}{\partial\dot\theta_2} = \left( I_{G_2} + m_2 c_2^2 \right) \dot\theta_2 + m_2 bc_2\dot\theta_1\cos(\theta_1+\beta-\theta_2)$$

$$\Rightarrow \frac{d}{dt} \frac{\partial L}{\partial\dot\theta_2} = \left( I_{G_2} + m_2 c_2^2 \right) \ddot\theta_2 + m_2 bc_2\left\... ... \dot\theta_1(\dot\theta_1-\dot\theta_2) \sin(\theta_1+\beta-\theta_2) \right\}$$ (66)

$$- \frac{\partial L}{\partial\theta_2} = -m_2 bc_2\dot\theta_1\dot\theta_2\sin(\theta_1+\beta-\theta_2) + m_2 g c_2\sin\theta_2$$ (67)

ゆえに、 $\theta_1,\theta_2$に関するラグランジュ運動方程式は、

$$\left( I_{O_1} + m_2 b^2 \right) \ddot\theta_1 + m_1 g c_1\sin\th... ...\theta_1+\beta-\theta_2) + \dot\theta_2^2\sin(\theta_1+\beta-\theta_2) \right\} = 0$$ (68)

$$\left( I_{G_2} + m_2 c_2^2 \right) \ddot\theta_2 + m_2 g c_2\sin\... ...\theta_1+\beta-\theta_2) - \dot\theta_1^2\sin(\theta_1+\beta-\theta_2) \right\} = 0$$ (69)

となる⁵。$\Box$

ここで、求められた2階の微分方程式を連立1階微分方程式に直すため、 便宜上以下のようにおく。

$$\begin{eqnarray*} C &=& \cos(\theta_1+\beta-\theta_2) = \cos\beta\cos(\theta_1-... ...I_{1,2} &=& I_{O_1} + m_2 b^2 \\ I_{2} &=& I_{G_2} + m_2 c_2^2 \end{eqnarray*}$$

$$I_{1,2} \ddot\theta_1 + m_1 g c_1\sin\theta_1 + m_2 g b\sin(\theta_1+\beta) + m_2 bc_2 \left( C\ddot\theta_2 + S\dot\theta_2^2 \right) = 0$$ (70)

$$I_{2} \ddot\theta_2 + m_2 g c_2\sin\theta_2 + m_2 bc_2 \left( C\ddot\theta_1 - S\dot\theta_1^2 \right) = 0$$ (71)

上式を整理すると,

$$\begin{eqnarray*} I_{1,2}\ddot\theta_1 + m_2 bc_2 C\ddot\theta_2 &=& -m_2 bc_2 ... ...ot\theta_1 &=& m_2 bc_2 S\dot\theta_1^2 - m_2 g c_2\sin\theta_2 \end{eqnarray*}$$

$$\begin{eqnarray*} I_{1,2}I_{2}\ddot\theta_1 + m_2 bc_2 CI_{2}\ddot\theta_2 &=& ... ...^2 b^2 c_2^2 CS\dot\theta_1^2 - m_2 bc_2 Cm_2 g c_2\sin\theta_2 \end{eqnarray*}$$

$$\Downarrow$$

$$(I_{1,2}I_{2}- m_2^2 b^2 c_2^2 C^2)\ddot\theta_1 = -m_2 bc... ...theta_1+\beta) \right\}I_{2}+ m_2 bc_2 Cm_2 g c_2\sin\theta_2$$

$$\begin{eqnarray*} I_{1,2}m_2 bc_2 C\ddot\theta_1 + m_2^2 b^2 c_2^2 C^2\ddot\the... ... I_{1,2}m_2 bc_2 S\dot\theta_1^2 - I_{1,2}m_2 g c_2\sin\theta_2 \end{eqnarray*}$$

$$\Downarrow$$

$$( m_2^2 b^2 c_2^2 C^2- I_{1,2}I_{2})\ddot\theta_2 = -m_2^2... ...heta_1+\beta) \right\}m_2 bc_2 C+I_{1,2}m_2 g c_2\sin\theta_2$$

$$\ddot\theta_1 = \frac{-m_2 bc_2 SI_{2}\dot\theta_2^2 - m_2... ...^2 g bc_2^2 C\sin\theta_2 }{I_{1,2}I_{2}- m_2^2 b^2 c_2^2 C^2}$$ (72)

$$\ddot\theta_2 = \frac{-m_2^2 b^2 c_2^2 CS\dot\theta_2^2 - ... ...1,2}m_2 g c_2\sin\theta_2 }{ m_2^2 b^2 c_2^2 C^2-I_{1,2}I_{2}}$$ (73)

となる。さらに、

$$\vartheta_1 = \dot\theta_1, \qquad \vartheta_2 = \dot\theta_2$$

とおくことにより以下の連立1階微分方程式を得る。

$$\dot\theta_1 = \vartheta_1$$ (74)

$$\dot\theta_2 = \vartheta_2$$ (75)

$$\dot\vartheta_1 = \frac{-m_2 bc_2 SI_{2}\vartheta_2^2 - m_2^2 b^2 c_2^2 CS\vartheta... ...right\}I_{2}+ m_2^2 g bc_2^2 C\sin\theta_2 }{I_{1,2}I_{2}- m_2^2 b^2 c_2^2 C^2}$$ (76)

$$\dot\vartheta_2 = \frac{-m_2^2 b^2 c_2^2 CS\vartheta_2^2 - I_{1,2}m_2 bc_2 S\varthe... ...a) \right\}+ I_{1,2}m_2 g c_2\sin\theta_2 }{ m_2^2 b^2 c_2^2 C^2- I_{1,2}I_{2}}$$ (77)

$\Box$ また、各々の角速度に比例する抵抗などの減衰 や強制振動のような外力 がある場合は、 $\dot\theta_1,\dot\theta_2$それぞれに対する減衰定数を $\lambda_1,\lambda_2$、外力を $\sigma_1,\sigma_2$ とすると、 $\theta_1,\theta_2$に関するラグランジュ運動方程式は 式(68),(69)から、

$${%% \left( I_{O_1} + m_2 b^2 \right) \ddot\theta_1 + m_1 g c_1\sin\theta_1 + m_2 g b\sin(\theta_1+\beta) }$$

$$\mbox{~} + m_2 bc_2\left\{ \ddot\theta_2\cos(\theta_1+\beta-\thet... ...ta_2^2\sin(\theta_1+\beta-\theta_2) \right\} = \sigma_1 - \lambda_1\dot\theta_1$$ (78)

$${%% \left( I_{G_2} + m_2 c_2^2 \right) \ddot\theta_2 + m_2 g c_2\sin\theta_2 }$$

$$\mbox{~} + m_2 bc_2\left\{ \ddot\theta_1\cos(\theta_1+\beta-\thet... ...ta_1^2\sin(\theta_1+\beta-\theta_2) \right\} = \sigma_2 - \lambda_2\dot\theta_2$$ (79)

となる⁶。 $\Box$

よって、式(74)-(77)に対応する減衰 や外力 がある場合の連立一階微分方程式は以下のようになる。

$$\dot\theta_1 = \vartheta_1$$ (80)

$$\dot\theta_2 = \vartheta_2$$ (81)

$$\dot\vartheta_1 = \frac{\displaystyle{\left\{ \begin{array}{l} \displaystyle{ -m_2 ... ...eta_2 } \end{array}\right\}}}{\displaystyle{I_{1,2}I_{2}- m_2^2 b^2 c_2^2 C^2}}$$ (82)

$$\dot\vartheta_2 = \frac{\displaystyle{\left\{ \begin{array}{l} \displaystyle{ -m_2^... ...ta_2 } \end{array}\right\}}}{\displaystyle{ m_2^2 b^2 c_2^2 C^2- I_{1,2}I_{2}}}$$ (83)

$\Box$ ［補足］ ハミルトンの正準方程式の導出

ここで、運動エネルギー$T$を以下のように表す。

$$T = \frac12 \dot{\bm\theta}^\top {R} \dot{\bm\theta}$$ (84)

但しここで、 $\bm\theta\in\mathbb{R}^2$、

$${R} = \left(\begin{array}{cc} I_{1,2}& m_2 bc_2 C\\ m_2 bc_2 C& I_{2} \end{array} \right)$$ (85)

である。すると、角運動量$\bm{p}$は、 と表される。ハミルトニアン$H$は

$$H = \frac12 \bm{p}^\top {R}^{-1} \bm{p} + U$$ (86)

であり、ハミルトニアン$H$からハミルトンの正準方程式を得るには以下

$$\dot{\bm\theta} = \frac{\partial H}{\partial \bm{p}} = \frac{\partial}{\partial \bm{p}} \left( \frac12 \bm{p}^\top {R}^{-1} \bm{p} + U \right)$$

$$= {R}^{-1} \bm{p}$$ (87)

$$\dot{\bm{p}} = - \frac{\partial H}{\partial \bm\theta} + \bm{F} = - \frac{\parti... ...tial \bm\theta} \left( \frac12 \bm{p}^\top {R}^{-1} \bm{p} + U \right) + \bm{F}$$

$$= - \frac12 \frac{\partial}{\partial \bm\theta} \left( \bm{p}^\top {R}^{-1} \bm{p} \right) - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$

$$= \frac12 \frac{\partial}{\partial \bm\theta} \left( \dot{\bm\theta... ...op {R} \dot{\bm\theta} \right) - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$ (88)

の関係式を用いればよい。 ちなみに$\bm{F}$は、前述の抵抗や外力がある場合は、

$$\bm{F} = \left[\begin{array}{c} \sigma_1 - \lambda_1\dot\... ...1 \\ \sigma_2 - \lambda_2\dot\theta_2 \end{array} \right]$$ (89)

さもなくば${F}_d=0$($d=1,2$)である。

具体的に求めると、ハミルトンの正準方程式は以下のようになる。

$$\dot{\bm\theta} = {R}^{-1} \bm{p}$$

$$= \frac1{I_{1,2}I_{2}- m_2^2 b^2 c_2^2 C^2}\left[\begin{array}{c} I_{2}{p}_1 - m_2 bc_2 C{p}_2\\ - m_2 bc_2 C{p}_1 + I_{1,2}{p}_2 \end{array}\right]$$ (90)

$$\dot{\bm{p}} = \frac12 \frac{\partial}{\partial \bm\theta} \left( \dot{\bm\theta... ...bm\theta}, \ldots \right)^\top - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$

$$= \left[\begin{array}{c} -m_2 bc_2 S\dot\theta_1\dot\theta_2\\ m_2... ...n(\theta_1+\beta) \right\}\\ m_2 g c_2\sin\theta_2 \end{array}\right] + \bm{F}$$ (91)

$\Box$ ［発展］ 動座標系におけるラグランジュ運動方程式及びハミルトンの正準方程式の導出

$O_1$が時変の位置 $\bm{\Gamma}=(\Gamma_x, \Gamma_y)$によって動くことに より、振り子が強制振動される場合を考える。 $i$番目の質点の位置ベクトルを $\bm{r}_i=(x_{G_i},y_{G_i})$として、この 動座標系における運動エネルギー$T$は、

$$T = \frac12\sum_{i=1}^n m_i\vert\dot{\bm{r}}_i\vert^2 + ... ...bm{r}}_i + \frac12\sum_{i=1}^n m_i\vert\dot{\bm\Gamma}\vert^2$$ (92)

となり、位置エネルギー$U$は、

$$U = \sum_{i=1}^n m_i g y_{G_i} + \sum_{i=1}^n m_i g \Gamma_y$$ (93)

となる。ここで、

$$\sum_{i=1}^n m_i\dot{\bm\Gamma}^\top\dot{\bm{r}}_i = m_1 (\dot\Gamma_x, \dot\Gamma_y)\left[\begin{array}{c} c_1\dot\th... ...\dot\theta_1\sin(\theta_1+\beta)+c_2\dot\theta_2\sin\theta_2 \end{array}\right]$$

$$= \left[\begin{array}{c} \displaystyle{m_1 c_1 \left(\dot\Gamma_x\c... ... \dot\theta_1\\ \dot\theta_2 \end{array}\right] = \bm{p}_O^\top\dot{\bm\theta}$$

とおくと、ラグランジュ関数$L$は$L=T-U$より、

$$L = \frac12 \dot{\bm\theta}^\top {R} \dot{\bm\theta} + \bm{p}_O^\top\dot{\bm\theta} + \frac12\sum_{i=1}^n m_i\vert\dot{\bm\Gamma}\vert^2 - U$$ (94)

となり、ラグランジュ運動方程式は、

$${R} \ddot{\bm\theta} + \dot{R} \dot{\bm\theta} + \frac{\p... ...heta}\right) + \frac{\partial U}{\partial\bm\theta} = \bm{F}$$ (95)

となる。但しここで、

$$\frac{\partial \bm{p}_O}{\partial t} = \left[\begin{array... ...\theta_2+\ddot\Gamma_y\sin\theta_2\right)} \end{array}\right]$$ (96)

である。 この場合の角運動量$\bm{p}$は、 であるので、 より、ハミルトニアン$H$は、

$$H = \frac12 \left( \bm{p} - \bm{p}_O \right)^\top {R}^{-1} ... ...ight) + \frac12\sum_{i=1}^n m_i\vert\dot{\bm\Gamma}\vert^2 + U$$ (97)

であり、ハミルトニアン$H$からハミルトンの正準方程式を得るには以下

$$\dot{\bm\theta} = \frac{\partial H}{\partial \bm{p}} = \frac{\partial}{\partial \bm... ...{p}_O \right) + \frac12\sum_{i=1}^n m_i\vert\dot{\bm\Gamma}\vert^2 + U \right\}$$

$$= {R}^{-1} \left( \bm{p} - \bm{p}_O \right)$$ (98)

$$\dot{\bm{p}} = - \frac{\partial H}{\partial \bm\theta} + \bm{F} = - \frac{\parti... ...ght) + \frac12\sum_{i=1}^n m_i\vert\dot{\bm\Gamma}\vert^2 + U \right\} + \bm{F}$$

$$= - \frac12 \frac{\partial}{\partial \bm\theta} \left\{ \left( \bm{... ...p} - \bm{p}_O \right) \right\} - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$

$$= - \left( \frac12 \left( \bm{p} - \bm{p}_O \right)^\top \frac{\par... ..._O \right) ,\ldots\right)^\top - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$

$$= - \left( - \frac12 \dot{\bm\theta}^\top \frac{\partial {R}}{\part... ...\bm\theta} ,\ldots\right)^\top - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$

$$= \frac12 \frac{\partial}{\partial \bm\theta} \left( \dot{\bm\theta... ...O^\top \dot{\bm\theta} \right) - \frac{\partial U}{\partial \bm\theta} + \bm{F}$$ (99)

の関係式を用いればよい。但しここで、

$$\frac{\partial}{\partial \bm\theta}\left( \bm{p}_O^\top \dot... ...t\Gamma_y\cos\theta_2\right) \dot\theta_2} \end{array}\right]$$ (100)

である。

... となる⁵

これは$\beta=0$であるときに、文献[8]の 式(2.156)の $\tau_1=\tau_2=0$であるときと等しい。

... となる⁶

これは$\beta=0$であるときに、文献[8]の 式(2.156)の $\tau_1=\sigma_1+\sigma_2$, $\tau_2=\sigma_2$であるときと等 しい。

このサイトについてのご意見ご要望は taiji@aihara.co.jp までお願いします。 Copyright (C) 1996-1998,2003-2004 Taiji Yamada, AIHARA Electrical Engineering Co., Ltd.
All rights reserved.