编辑
2025-04-21
自动控制
00

在带有惯性轮的倒立摆系统中,使用拉格朗日方程进行分析时,确定摆杆角度和惯性轮角度的方程右边的步骤如下:

  1. 系统建模与广义坐标 • 摆杆角度:定义为摆杆与垂直方向的夹角,记为 θ\theta

• 惯性轮角度:定义为惯性轮相对于摆杆的转角,记为 ϕ\phi。惯性轮的绝对转角为 θ+ϕ\theta + \phi

  1. 动能与势能 • 摆杆的动能:

Tp=12Ipθ˙2T_p = \frac{1}{2} I_p \dot{\theta}^2,其中 IpI_p 为摆杆的转动惯量。 • 惯性轮的动能:

Tw=12Iw(θ˙+ϕ˙)2T_w = \frac{1}{2} I_w (\dot{\theta} + \dot{\phi})^2,其中 IwI_w 为惯性轮的转动惯量。 • 总动能:

T=Tp+Tw=12Ipθ˙2+12Iw(θ˙+ϕ˙)2T = T_p + T_w = \frac{1}{2} I_p \dot{\theta}^2 + \frac{1}{2} I_w (\dot{\theta} + \dot{\phi})^2

• 势能:

摆杆的重心高度为 lcosθl \cos\theta(假设摆杆质心距支点距离为 ll),势能为:
V=mpglcosθV = m_p g l \cos\theta,其中 mpm_p 为摆杆质量,gg 为重力加速度。

• 拉格朗日函数:

L=TV=12Ipθ˙2+12Iw(θ˙+ϕ˙)2mpglcosθL = T - V = \frac{1}{2} I_p \dot{\theta}^2 + \frac{1}{2} I_w (\dot{\theta} + \dot{\phi})^2 - m_p g l \cos\theta

  1. 拉格朗日方程推导 对每个广义坐标 θ\thetaϕ\phi 应用拉格朗日方程:
ddt(Lq˙i)Lqi=Qi,\frac{d}{dt} \left( \frac{\partial L}{\partial \dot{q}_i} \right) - \frac{\partial L}{\partial q_i} = Q_i,

其中 QiQ_i 为广义力。

对于摆杆角度 θ\theta: • 动量项:

Lθ˙=Ipθ˙+Iw(θ˙+ϕ˙),\frac{\partial L}{\partial \dot{\theta}} = I_p \dot{\theta} + I_w (\dot{\theta} + \dot{\phi}),

对时间求导:

ddt(Lθ˙)=Ipθ¨+Iw(θ¨+ϕ¨).\frac{d}{dt} \left( \frac{\partial L}{\partial \dot{\theta}} \right) = I_p \ddot{\theta} + I_w (\ddot{\theta} + \ddot{\phi}).

• 势能项:

Lθ=mpglsinθ.\frac{\partial L}{\partial \theta} = m_p g l \sin\theta.

• 方程:

Ipθ¨+Iw(θ¨+ϕ¨)mpglsinθ=Qθ.I_p \ddot{\theta} + I_w (\ddot{\theta} + \ddot{\phi}) - m_p g l \sin\theta = Q_\theta.

对于惯性轮角度 ϕ\phi: • 动量项:

Lϕ˙=Iw(θ˙+ϕ˙),\frac{\partial L}{\partial \dot{\phi}} = I_w (\dot{\theta} + \dot{\phi}),

对时间求导:

ddt(Lϕ˙)=Iw(θ¨+ϕ¨).\frac{d}{dt} \left( \frac{\partial L}{\partial \dot{\phi}} \right) = I_w (\ddot{\theta} + \ddot{\phi}).

• 势能项:

Lϕ=0\frac{\partial L}{\partial \phi} = 0(无显式依赖)。 • 方程:

Iw(θ¨+ϕ¨)=Qϕ.I_w (\ddot{\theta} + \ddot{\phi}) = Q_\phi.
  1. 广义力的确定 • 电机扭矩:假设电机施加扭矩 τ\tau 驱动惯性轮相对于摆杆转动。根据虚功原理,虚位移 δθ\delta\thetaδϕ\delta\phi 对应的虚功为:
δW=τδθ+τδϕ.\delta W = -\tau \delta\theta + \tau \delta\phi.

因此,广义力为:

Qθ=τ,Qϕ=τ.Q_\theta = -\tau, \quad Q_\phi = \tau.
  1. 最终运动方程 • 摆杆角度方程:
Ipθ¨+Iw(θ¨+ϕ¨)mpglsinθ=τ.I_p \ddot{\theta} + I_w (\ddot{\theta} + \ddot{\phi}) - m_p g l \sin\theta = -\tau.

• 惯性轮角度方程:

Iw(θ¨+ϕ¨)=τ.I_w (\ddot{\theta} + \ddot{\phi}) = \tau.

结论 • 摆杆角度 θ\theta 的方程右边:广义力 Qθ=τQ_\theta = -\tau

• 惯性轮角度 ϕ\phi 的方程右边:广义力 Qϕ=τQ_\phi = \tau

答案:
摆杆角度的方程右边为 τ-\tau,惯性轮角度的方程右边为 τ\tau

为了将系统转换为状态方程,首先定义状态变量并解出加速度项:

  1. 状态变量定义 设状态向量为:
x=[x1x2x3x4]=[θθ˙ϕϕ˙]\mathbf{x} = \begin{bmatrix} x_1 \\ x_2 \\ x_3 \\ x_4 \end{bmatrix} = \begin{bmatrix} \theta \\ \dot{\theta} \\ \phi \\ \dot{\phi} \end{bmatrix}

输入为惯性轮的扭矩 τ\tau

  1. 联立求解加速度项 从之前的运动方程:
{(Ip+Iw)θ¨+Iwϕ¨mpglsinθ=τIw(θ¨+ϕ¨)=τ\begin{cases} (I_p + I_w)\ddot{\theta} + I_w\ddot{\phi} - m_p g l \sin\theta = -\tau \\ I_w (\ddot{\theta} + \ddot{\phi}) = \tau \end{cases}

解得:

θ¨=mpglsinθ2τIp,ϕ¨=τ(Ip+2Iw)IwmpglsinθIpIw\ddot{\theta} = \frac{m_p g l \sin\theta - 2\tau}{I_p}, \quad \ddot{\phi} = \frac{\tau(I_p + 2I_w) - I_w m_p g l \sin\theta}{I_p I_w}
  1. 状态方程推导 根据状态变量定义,写出各状态的导数为:
x˙1=x2x˙2=mpglsinx12τIpx˙3=x4x˙4=τ(Ip+2Iw)Iwmpglsinx1IpIw\begin{aligned} \dot{x}_1 &= x_2 \\ \dot{x}_2 &= \frac{m_p g l \sin x_1 - 2\tau}{I_p} \\ \dot{x}_3 &= x_4 \\ \dot{x}_4 &= \frac{\tau(I_p + 2I_w) - I_w m_p g l \sin x_1}{I_p I_w} \end{aligned}
  1. 非线性状态方程 系统状态方程表示为:
x˙=[x2mpglsinx12τIpx4τ(Ip+2Iw)Iwmpglsinx1IpIw]\dot{\mathbf{x}} = \begin{bmatrix} x_2 \\ \frac{m_p g l \sin x_1 - 2\tau}{I_p} \\ x_4 \\ \frac{\tau(I_p + 2I_w) - I_w m_p g l \sin x_1}{I_p I_w} \end{bmatrix}
  1. 线性化状态方程(平衡点 θ0\theta \approx 0) 在平衡点附近线性化(sinθθ\sin\theta \approx \theta),得到:
x˙=Ax+Bτ\dot{\mathbf{x}} = \mathbf{A}\mathbf{x} + \mathbf{B}\tau

其中:

A=[0100mpglIp0000001mpglIp000],B=[02Ip0Ip+2IwIpIw]\mathbf{A} = \begin{bmatrix} 0 & 1 & 0 & 0 \\ \frac{m_p g l}{I_p} & 0 & 0 & 0 \\ 0 & 0 & 0 & 1 \\ -\frac{m_p g l}{I_p} & 0 & 0 & 0 \end{bmatrix}, \quad \mathbf{B} = \begin{bmatrix} 0 \\ -\frac{2}{I_p} \\ 0 \\ \frac{I_p + 2I_w}{I_p I_w} \end{bmatrix}

答案:
系统的非线性状态方程为:

x˙=[x2mpglsinx12τIpx4τ(Ip+2Iw)Iwmpglsinx1IpIw]\dot{\mathbf{x}} = \begin{bmatrix} x_2 \\ \frac{m_p g l \sin x_1 - 2\tau}{I_p} \\ x_4 \\ \frac{\tau(I_p + 2I_w) - I_w m_p g l \sin x_1}{I_p I_w} \end{bmatrix}

当在平衡点 θ0\theta \approx 0 附近线性化时,状态方程简化为:

x˙=Ax+Bτ\dot{\mathbf{x}} = \mathbf{A}\mathbf{x} + \mathbf{B}\tau

其中矩阵 A\mathbf{A}B\mathbf{B} 如上所述。

如果对你有用的话,可以打赏哦
打赏
ali pay
wechat pay

本文作者:Dong

本文链接:

版权声明:本博客所有文章除特别声明外,均采用 CC BY-NC。本作品采用《知识共享署名-非商业性使用 4.0 国际许可协议》进行许可。您可以在非商业用途下自由转载和修改,但必须注明出处并提供原作者链接。 许可协议。转载请注明出处!