東京大学 工学系研究科 機械工学専攻 2022年8月実施 機械工学第2部 問題 2
Author
祭音Myyura (Based on zzy's answer refined with GPT 6 Astra)
Description
下記の I、II の両方について解答せよ。なお、I の解答に答案用紙1枚を、II の解答に答案用紙1枚を、それぞれ用いること。
図2-1に示すように、正方形の板と2個のばねからなる系を考える。正方形の板の角が点 O でピン支持されており、平面内で点 O まわりに回転する。この板の一辺の長さを l l l 、質量を m m m 、厚さおよび密度は一様とする。点 O まわりの板の慣性モーメントを J J J とする。点 G は板の重心である。また、2個のばねが点 O から鉛直下方向に h h h の位置にある点 P で板に固定されている。ばねの他端はそれぞれ点 Q と点 R で壁に固定されている。ばねのばね定数はともに k k k とする。重力加速度は g g g である。図は系の静止状態を示している。点 O まわりに板の微小振動が生じる場合を考える。鉛直方向からの板の回転角を θ \theta θ とする。ただし、回転角 θ \theta θ と、ばねの変位は微小であるものとし、cos θ ≅ 1 − 1 2 θ 2 \cos\theta\cong1-\dfrac12\theta^2 cos θ ≅ 1 − 2 1 θ 2 、sin θ ≅ θ \sin\theta\cong\theta sin θ ≅ θ と近似する。板の回転運動の摩擦、空気抵抗、ばねの質量は無視できるものとする。以下の設問に答えよ。
(1) 点 O まわりの板の慣性モーメント J J J を求めよ。
(2) この系の運動エネルギーと、ポテンシャルエネルギーを求めよ。
(3) この系の運動方程式を求めよ。
(4) この系の固有振動数 ω 0 \omega_0 ω 0 を求めよ。
(5) ばねの固定点 P、Q、R が水平の位置にあり、h h h が大きくなるように固定点 P、Q、R を鉛直下方向にスライドすると、系の固有振動数はどう変わるか述べよ。
(6) 点 O まわりに、周期的に変化するトルク T ( t ) = X sin ω t T(t)=X\sin\omega t T ( t ) = X sin ω t を加える場合を考える。X X X および ω ( ω ≠ ω 0 ) \omega\ (\omega\ne\omega_0) ω ( ω = ω 0 ) は定数、t t t は時間である。ここでは、振動振幅がとても小さい場合を考える。板の定常応答における強制振動の振動振幅を求めよ。
図2-2に示すように、剛体 A の両端に設置されたプロペラによって回転姿勢制御を行う機械を考える。この剛体 A は重心 G まわりで平面内での回転運動のみを行う。プロペラの推進力によって剛体 A の両端で、中心軸 B に垂直な力 f f f が発生する。力 f f f は剛体 A の左右両端で図2-2に示すように作用する。各プロペラは重心 G から L / 2 L/2 L /2 の位置に設置されている。剛体 A の姿勢角を θ \theta θ で表現し、目標姿勢角度を θ T \theta_T θ T で表現する。剛体 A の重心 G まわりの慣性モーメントを J J J とする。剛体 A は、回転抵抗として回転速度と逆向きのトルク c θ ˙ c\dot\theta c θ ˙ を受ける。c c c は正の定数とする。t t t を時間とし、推進力、姿勢角、目標姿勢角の時間関数をそれぞれ f ( t ) , θ ( t ) , θ T ( t ) f(t),\theta(t),\theta_T(t) f ( t ) , θ ( t ) , θ T ( t ) とし、それらをラプラス変換したものをそれぞれ F ( s ) , Θ ( s ) , Θ T ( s ) F(s),\Theta(s),\Theta_T(s) F ( s ) , Θ ( s ) , Θ T ( s ) とする。以下の設問に答えよ。
(1) F ( s ) F(s) F ( s ) から Θ ( s ) \Theta(s) Θ ( s ) までの伝達関数を求めよ。
(2) 姿勢角 θ \theta θ に対する PD 制御を行うために、式(2-1)で表される F ( s ) F(s) F ( s ) を考える。k d k_d k d と k p k_p k p は PD 制御のゲインとなる正の定数とする。
F ( s ) = − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s ) ] 1 + τ s + F e r r ( s ) (2-1) F(s)=\frac{-k_ds\Theta(s)+k_p[\Theta_T(s)-\Theta(s)]}{1+\tau s}
+F_{\mathrm{err}}(s)\tag{2-1} F ( s ) = 1 + τ s − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s )] + F err ( s ) ( 2-1 )
このプロペラの出力は一次遅れ系としてモデル化され、その際の時定数を τ \tau τ とする。また、出力 F ( s ) F(s) F ( s ) には誤差が含まれ、その誤差を F e r r ( s ) F_{\mathrm{err}}(s) F err ( s ) とする。目標姿勢角と実際の姿勢角の誤差 Θ T ( s ) − Θ ( s ) \Theta_T(s)-\Theta(s) Θ T ( s ) − Θ ( s ) を求めよ。
(3) 設問(2)の結果を基に、θ T ( t ) \theta_T(t) θ T ( t ) と f e r r ( t ) f_{\mathrm{err}}(t) f err ( t ) が両方とも単位ステップ入力である場合を考える。なお、F e r r ( s ) F_{\mathrm{err}}(s) F err ( s ) を逆ラプラス変換したものを f e r r ( t ) f_{\mathrm{err}}(t) f err ( t ) とする。十分な時間が経過した後の目標姿勢角と実際の姿勢角の誤差 θ T ( t ) − θ ( t ) \theta_T(t)-\theta(t) θ T ( t ) − θ ( t ) を求めよ。
(4) 本設問では c = 0 c=0 c = 0 、F e r r ( s ) = 0 F_{\mathrm{err}}(s)=0 F err ( s ) = 0 とする。姿勢角 θ \theta θ に対する PD 制御を行うために、式(2-2)で表される F ( s ) F(s) F ( s ) を考える。
F ( s ) = − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s ) ] 1 + τ s (2-2) F(s)=\frac{-k_ds\Theta(s)+k_p[\Theta_T(s)-\Theta(s)]}{1+\tau s}\tag{2-2} F ( s ) = 1 + τ s − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s )] ( 2-2 )
剛体 A の姿勢角制御を安定させるための k d k_d k d と k p k_p k p の条件を求めよ。
题目描述
I、II 均须作答,每部分各用一张答题纸。
如图2-1,系统由正方形板和两个弹簧构成。板的一个角在 O 点铰支,可在平面内绕 O 转动。板边长为 l l l 、质量为 m m m 、厚度与密度均匀,绕 O 的转动惯量为 J J J ,重心为 G。两个弹簧均在 O 点竖直下方距离 h h h 的 P 点与板相连,另一端分别固定在墙上的 Q、R 点,刚度均为 k k k 。重力加速度为 g g g ,图中为静止状态。考虑板绕 O 的微小振动,板相对于竖直方向的转角为 θ \theta θ 。转角和弹簧位移均微小,可用 cos θ ≅ 1 − θ 2 / 2 \cos\theta\cong1-\theta^2/2 cos θ ≅ 1 − θ 2 /2 、sin θ ≅ θ \sin\theta\cong\theta sin θ ≅ θ 。忽略板转动摩擦、空气阻力和弹簧质量。回答以下问题。
(1) 求板绕 O 的转动惯量 J J J 。
(2) 求系统的动能和势能。
(3) 求系统的运动方程。
(4) 求系统的固有频率 ω 0 \omega_0 ω 0 。
(5) 保持弹簧固定点 P、Q、R 处于同一水平线上,将三点竖直向下移动以增大 h h h 。说明固有频率如何变化。
(6) 绕 O 施加周期力矩 T ( t ) = X sin ω t T(t)=X\sin\omega t T ( t ) = X sin ω t ,其中 X , ω X,\omega X , ω 为常数、ω ≠ ω 0 \omega\ne\omega_0 ω = ω 0 ,t t t 为时间。考虑振幅很小的情况,求板在稳态强迫振动中的振幅。
如图2-2,利用刚体 A 两端的螺旋桨控制转动姿态。A 只在平面内绕重心 G 转动,两端螺旋桨产生垂直于中心轴 B 的力 f f f ,方向如图。各螺旋桨距 G 均为 L / 2 L/2 L /2 。姿态角为 θ \theta θ ,目标姿态角为 θ T \theta_T θ T ,A 绕 G 的转动惯量为 J J J 。A 受到与角速度方向相反的阻力矩 c θ ˙ c\dot\theta c θ ˙ ,c > 0 c>0 c > 0 。以 t t t 表示时间,推力、姿态角、目标姿态角分别为 f ( t ) , θ ( t ) , θ T ( t ) f(t),\theta(t),\theta_T(t) f ( t ) , θ ( t ) , θ T ( t ) ,相应拉普拉斯变换为 F ( s ) , Θ ( s ) , Θ T ( s ) F(s),\Theta(s),\Theta_T(s) F ( s ) , Θ ( s ) , Θ T ( s ) 。回答以下问题。
(1) 求从 F ( s ) F(s) F ( s ) 到 Θ ( s ) \Theta(s) Θ ( s ) 的传递函数。
(2) 采用式(2-1)的 F ( s ) F(s) F ( s ) 对姿态角进行 PD 控制,k d , k p k_d,k_p k d , k p 是正的控制增益。
F ( s ) = − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s ) ] 1 + τ s + F e r r ( s ) (2-1) F(s)=\frac{-k_ds\Theta(s)+k_p[\Theta_T(s)-\Theta(s)]}{1+\tau s}
+F_{\mathrm{err}}(s)\tag{2-1} F ( s ) = 1 + τ s − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s )] + F err ( s ) ( 2-1 )
螺旋桨输出用时间常数为 τ \tau τ 的一阶惯性环节建模,输出 F ( s ) F(s) F ( s ) 含有误差 F e r r ( s ) F_{\mathrm{err}}(s) F err ( s ) 。求目标姿态角与实际姿态角的误差 Θ T ( s ) − Θ ( s ) \Theta_T(s)-\Theta(s) Θ T ( s ) − Θ ( s ) 。
(3) 根据 (2),考虑 θ T ( t ) \theta_T(t) θ T ( t ) 和 f e r r ( t ) f_{\mathrm{err}}(t) f err ( t ) 均为单位阶跃输入的情况,f e r r ( t ) f_{\mathrm{err}}(t) f err ( t ) 是 F e r r ( s ) F_{\mathrm{err}}(s) F err ( s ) 的拉普拉斯逆变换。求经过足够长时间后目标角与实际角的误差 θ T ( t ) − θ ( t ) \theta_T(t)-\theta(t) θ T ( t ) − θ ( t ) 。
(4) 本问取 c = 0 , F e r r ( s ) = 0 c=0,F_{\mathrm{err}}(s)=0 c = 0 , F err ( s ) = 0 ,采用式(2-2)进行 PD 控制:
F ( s ) = − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s ) ] 1 + τ s . (2-2) F(s)=\frac{-k_ds\Theta(s)+k_p[\Theta_T(s)-\Theta(s)]}{1+\tau s}.\tag{2-2} F ( s ) = 1 + τ s − k d s Θ ( s ) + k p [ Θ T ( s ) − Θ ( s )] . ( 2-2 )
求使刚体 A 的姿态角控制稳定的 k d , k p k_d,k_p k d , k p 条件。
Kai
(1) O G = l / 2 OG=l/\sqrt2 OG = l / 2 より、平行軸の定理を用いて
J = m l 2 6 + m ( l 2 ) 2 = 2 3 m l 2 . \boxed{J=\frac{ml^2}{6}+m\left(\frac{l}{\sqrt2}\right)^2=\frac23ml^2}. J = 6 m l 2 + m ( 2 l ) 2 = 3 2 m l 2 .
(2) 静止位置のポテンシャルエネルギーを零とすると
T = 1 2 J θ ˙ 2 = 1 3 m l 2 θ ˙ 2 , U = ( m g l 2 2 + k h 2 ) θ 2 . \begin{gathered}
\boxed{T=\frac12J\dot\theta^2=\frac13ml^2\dot\theta^2},\\
\boxed{U=\left(\frac{mgl}{2\sqrt2}+kh^2\right)\theta^2}.
\end{gathered} T = 2 1 J θ ˙ 2 = 3 1 m l 2 θ ˙ 2 , U = ( 2 2 m g l + k h 2 ) θ 2 .
ここで重心の上昇量は l θ 2 / ( 2 2 ) l\theta^2/(2\sqrt2) l θ 2 / ( 2 2 ) 、各ばねの変形量の大きさは h θ h\theta h θ である。
(3) ラグランジュ方程式から
2 3 m l 2 θ ¨ + ( m g l 2 + 2 k h 2 ) θ = 0 . \boxed{\frac23ml^2\ddot\theta+\left(\frac{mgl}{\sqrt2}+2kh^2\right)\theta=0}. 3 2 m l 2 θ ¨ + ( 2 m g l + 2 k h 2 ) θ = 0 .
(4) 設問の ω 0 \omega_0 ω 0 は加振角振動数 ω \omega ω に対応し、
ω 0 = 3 2 m g l + 12 k h 2 4 m l 2 . \boxed{\omega_0=\sqrt{\frac{3\sqrt2mgl+12kh^2}{4ml^2}}}. ω 0 = 4 m l 2 3 2 m g l + 12 k h 2 .
周波数を Hz で表す場合は f 0 = ω 0 / ( 2 π ) f_0=\omega_0/(2\pi) f 0 = ω 0 / ( 2 π ) である。
(5) 慣性モーメントは変わらず、回転剛性の 2 k h 2 2kh^2 2 k h 2 が増すので、固有振動数は増加する。
(6) J θ ¨ + J ω 0 2 θ = X sin ω t J\ddot\theta+J\omega_0^2\theta=X\sin\omega t J θ ¨ + J ω 0 2 θ = X sin ω t に正弦波の特解を代入すると
θ p ( t ) = X J ( ω 0 2 − ω 2 ) sin ω t . \theta_{\rm p}(t)=\frac{X}{J(\omega_0^2-\omega^2)}\sin\omega t. θ p ( t ) = J ( ω 0 2 − ω 2 ) X sin ω t .
したがって振幅は
Θ a m p = ∣ X ∣ J ∣ ω 0 2 − ω 2 ∣ = 6 ∣ X ∣ ∣ 3 2 m g l + 12 k h 2 − 4 m l 2 ω 2 ∣ . \boxed{\begin{gathered}
\Theta_{\rm amp}=\frac{|X|}{J|\omega_0^2-\omega^2|}\\
=\frac{6|X|}{|3\sqrt2mgl+12kh^2-4ml^2\omega^2|}
\end{gathered}}. Θ amp = J ∣ ω 0 2 − ω 2 ∣ ∣ X ∣ = ∣3 2 m g l + 12 k h 2 − 4 m l 2 ω 2 ∣ 6∣ X ∣ .
(1) 両端の力による合計トルクは L f Lf L f なので、
J θ ¨ + c θ ˙ = L f , Θ ( s ) F ( s ) = L s ( J s + c ) . J\ddot\theta+c\dot\theta=Lf,\qquad
\boxed{\frac{\Theta(s)}{F(s)}=\frac{L}{s(Js+c)}}. J θ ¨ + c θ ˙ = L f , F ( s ) Θ ( s ) = s ( J s + c ) L .
(2) 次の特性多項式をおく。
D ( s ) = s ( J s + c ) ( 1 + τ s ) + L ( k d s + k p ) . D(s)=s(Js+c)(1+\tau s)+L(k_ds+k_p). D ( s ) = s ( J s + c ) ( 1 + τ s ) + L ( k d s + k p ) .
制御則を運動方程式へ代入して整理すれば
Θ T − Θ = [ s ( J s + c ) ( 1 + τ s ) + L k d s ] Θ T − L ( 1 + τ s ) F e r r D ( s ) . \boxed{\Theta_T-\Theta=
\frac{[s(Js+c)(1+\tau s)+Lk_ds]\Theta_T-L(1+\tau s)F_{\rm err}}{D(s)}}. Θ T − Θ = D ( s ) [ s ( J s + c ) ( 1 + τ s ) + L k d s ] Θ T − L ( 1 + τ s ) F err .
(3) 閉ループが安定なら、Θ T = F e r r = 1 / s \Theta_T=F_{\rm err}=1/s Θ T = F err = 1/ s と最終値の定理から
lim t → ∞ ( θ T − θ ) = − 1 k p . \boxed{\lim_{t\to\infty}(\theta_T-\theta)=-\frac1{k_p}}. t → ∞ lim ( θ T − θ ) = − k p 1 .
この極限の成立には ( J + c τ ) ( c + L k d ) > J τ L k p (J+c\tau)(c+Lk_d)>J\tau Lk_p ( J + c τ ) ( c + L k d ) > J τL k p が必要である。
(4) c = 0 c=0 c = 0 の特性方程式は
J τ s 3 + J s 2 + L k d s + L k p = 0. J\tau s^3+Js^2+Lk_ds+Lk_p=0. J τ s 3 + J s 2 + L k d s + L k p = 0.
ラウス表の第1列は J τ , J , L ( k d − τ k p ) , L k p J\tau,J,L(k_d-\tau k_p),Lk_p J τ , J , L ( k d − τ k p ) , L k p 。よって
k p > 0 , k d > τ k p . \boxed{k_p>0,\qquad k_d>\tau k_p}. k p > 0 , k d > τ k p .
Reference