在带有惯性轮的倒立摆系统中,使用拉格朗日方程进行分析时,确定摆杆角度和惯性轮角度的方程右边的步骤如下:
- 系统建模与广义坐标
• 摆杆角度:定义为摆杆与垂直方向的夹角,记为 θ。
• 惯性轮角度:定义为惯性轮相对于摆杆的转角,记为 ϕ。惯性轮的绝对转角为 θ+ϕ。
- 动能与势能
• 摆杆的动能:
Tp=21Ipθ˙2,其中 Ip 为摆杆的转动惯量。
• 惯性轮的动能:
Tw=21Iw(θ˙+ϕ˙)2,其中 Iw 为惯性轮的转动惯量。
• 总动能:
T=Tp+Tw=21Ipθ˙2+21Iw(θ˙+ϕ˙)2。
• 势能:
摆杆的重心高度为 lcosθ(假设摆杆质心距支点距离为 l),势能为:
V=mpglcosθ,其中 mp 为摆杆质量,g 为重力加速度。
• 拉格朗日函数:
L=T−V=21Ipθ˙2+21Iw(θ˙+ϕ˙)2−mpglcosθ。
- 拉格朗日方程推导
对每个广义坐标 θ 和 ϕ 应用拉格朗日方程:
dtd(∂q˙i∂L)−∂qi∂L=Qi,
其中 Qi 为广义力。
对于摆杆角度 θ:
• 动量项:
∂θ˙∂L=Ipθ˙+Iw(θ˙+ϕ˙),
对时间求导:
dtd(∂θ˙∂L)=Ipθ¨+Iw(θ¨+ϕ¨).
• 势能项:
∂θ∂L=mpglsinθ.
• 方程:
Ipθ¨+Iw(θ¨+ϕ¨)−mpglsinθ=Qθ.
对于惯性轮角度 ϕ:
• 动量项:
∂ϕ˙∂L=Iw(θ˙+ϕ˙),
对时间求导:
dtd(∂ϕ˙∂L)=Iw(θ¨+ϕ¨).
• 势能项:
∂ϕ∂L=0(无显式依赖)。
• 方程:
Iw(θ¨+ϕ¨)=Qϕ.
- 广义力的确定
• 电机扭矩:假设电机施加扭矩 τ 驱动惯性轮相对于摆杆转动。根据虚功原理,虚位移 δθ 和 δϕ 对应的虚功为:
δW=−τδθ+τδϕ.
因此,广义力为:
Qθ=−τ,Qϕ=τ.
- 最终运动方程
• 摆杆角度方程:
Ipθ¨+Iw(θ¨+ϕ¨)−mpglsinθ=−τ.
• 惯性轮角度方程:
Iw(θ¨+ϕ¨)=τ.
结论
• 摆杆角度 θ 的方程右边:广义力 Qθ=−τ。
• 惯性轮角度 ϕ 的方程右边:广义力 Qϕ=τ。
答案:
摆杆角度的方程右边为 −τ,惯性轮角度的方程右边为 τ。
为了将系统转换为状态方程,首先定义状态变量并解出加速度项:
- 状态变量定义
设状态向量为:
x=⎣⎡x1x2x3x4⎦⎤=⎣⎡θθ˙ϕϕ˙⎦⎤
输入为惯性轮的扭矩 τ。
- 联立求解加速度项
从之前的运动方程:
{(Ip+Iw)θ¨+Iwϕ¨−mpglsinθ=−τIw(θ¨+ϕ¨)=τ
解得:
θ¨=Ipmpglsinθ−2τ,ϕ¨=IpIwτ(Ip+2Iw)−Iwmpglsinθ
- 状态方程推导
根据状态变量定义,写出各状态的导数为:
x˙1x˙2x˙3x˙4=x2=Ipmpglsinx1−2τ=x4=IpIwτ(Ip+2Iw)−Iwmpglsinx1
- 非线性状态方程
系统状态方程表示为:
x˙=⎣⎡x2Ipmpglsinx1−2τx4IpIwτ(Ip+2Iw)−Iwmpglsinx1⎦⎤
- 线性化状态方程(平衡点 θ≈0)
在平衡点附近线性化(sinθ≈θ),得到:
x˙=Ax+Bτ
其中:
A=⎣⎡0Ipmpgl0−Ipmpgl100000000010⎦⎤,B=⎣⎡0−Ip20IpIwIp+2Iw⎦⎤
答案:
系统的非线性状态方程为:
x˙=⎣⎡x2Ipmpglsinx1−2τx4IpIwτ(Ip+2Iw)−Iwmpglsinx1⎦⎤
当在平衡点 θ≈0 附近线性化时,状态方程简化为:
x˙=Ax+Bτ
其中矩阵 A 和 B 如上所述。