1. 二级倒立摆系统概述
二级倒立摆是一种经典的动力学系统，由两个相互连接的摆杆和一个可移动的小车组成。这个系统在控制理论研究中具有重要地位，因为它展示了非线性、不稳定和多变量等复杂动力学特性。二级倒立摆的控制目标是保持两个摆杆在垂直向上的不稳定平衡位置，同时控制小车的位置。
从工程角度看，二级倒立摆系统可以抽象为：
- 底座：可水平移动的小车（通常由电机驱动）
- 一级摆杆：通过旋转关节连接在小车上
- 二级摆杆：通过另一个旋转关节连接在一级摆杆末端
这种结构使得系统具有两个自由度的旋转运动和一个自由度的平移运动，构成了一个典型的多输入多输出（MIMO）控制系统。
2. 系统动力学建模
2.1 坐标系与变量定义
建立系统模型前，我们需要明确定义坐标系和变量：
- 小车位置：x（水平方向）
- 一级摆杆角度：θ₁（相对于垂直向上方向）
- 二级摆杆角度：θ₂（相对于一级摆杆方向）
- 小车质量：M
- 一级摆杆质量：m₁，长度：l₁
- 二级摆杆质量：m₂，长度：l₂
2.2 拉格朗日方程推导
使用拉格朗日力学方法推导系统动力学方程。拉格朗日量L定义为系统动能T与势能V之差：
L = T - V
系统总动能包括：
- 小车平移动能
- 一级摆杆的平移和旋转动能
- 二级摆杆的平移和旋转动能
系统势能主要来自两个摆杆的重力势能。通过计算各部件的位置坐标及其导数，可以得到完整的动能和势能表达式。
2.3 非线性动力学方程
经过推导，我们得到系统的非线性动力学方程：
[M + m₁ + m₂ (m₁l₁ + m₂L₁)cosθ₁ m₂l₂cosθ₂] [ẍ] [F + (m₁l₁ + m₂L₁)θ₁̇²sinθ₁ + m₂l₂θ₂̇²sinθ₂] [(m₁l₁ + m₂L₁)cosθ₁ (I₁ + m₁l₁² + m₂L₁²) m₂L₁l₂cos(θ₁-θ₂)] [θ₁̈] = [(m₁l₁ + m₂L₁)gsinθ₁ - k₁θ₁̇ + m₂L₁l₂θ₂̇²sin(θ₁-θ₂)] [m₂l₂cosθ₂ m₂L₁l₂cos(θ₁-θ₂) (I₂ + m₂l₂²)] [θ₂̈] [m₂l₂gsinθ₂ - k₂θ₂̇ - m₂L₁l₂θ₁̇²sin(θ₁-θ₂)]
其中：
- F为施加在小车上的控制力
- k₁,k₂为关节处的摩擦系数
- I₁,I₂为摆杆的转动惯量
- L₁为一级摆杆长度
3. 系统线性化与状态空间模型
3.1 平衡点附近的线性化
在垂直平衡位置附近（θ₁≈0，θ₂≈0，sinθ≈θ，cosθ≈1），对非线性方程进行线性化处理。忽略高阶小量后，得到线性化方程：
[M + m₁ + m₂ m₁l₁ + m₂L₁ m₂l₂] [ẍ] [F] [m₁l₁ + m₂L₁ I₁ + m₁l₁² + m₂L₁² m₂L₁l₂] [θ₁̈] = [(m₁l₁ + m₂L₁)gθ₁ - k₁θ₁̇] [m₂l₂ m₂L₁l₂ I₂ + m₂l₂²] [θ₂̈] [m₂l₂gθ₂ - k₂θ₂̇]
3.2 状态空间表示
选择状态变量： x = [x, ẋ, θ₁, θ₁̇, θ₂, θ₂̇]ᵀ
将二阶微分方程转化为一阶状态空间形式：
ẋ = Ax + Bu y = Cx + Du
其中A为系统矩阵，B为输入矩阵，C为输出矩阵，D为直接传输矩阵。具体形式取决于选择的输出变量。
4. 控制系统设计
4.1 可控性与可观测性分析
首先需要验证系统的可控性和可观测性。通过计算可控性矩阵和可观测性矩阵的秩，可以确认系统是完全可控和可观测的，这意味着我们可以设计有效的状态反馈控制器。
4.2 线性二次型调节器(LQR)设计
LQR是一种常用的最优控制方法，通过最小化性能指标：
J = ∫(xᵀQx + uᵀRu)dt
其中Q为状态加权矩阵，R为控制加权矩阵。通过求解Riccati方程，可以得到最优反馈增益矩阵K，使控制律u = -Kx。
Q矩阵的选择需要权衡不同状态变量的重要性，通常需要多次调整以获得满意的控制效果。
4.3 状态观测器设计
在实际系统中，可能无法直接测量所有状态变量。这时需要设计状态观测器来估计不可测状态。常用的方法是Luenberger观测器：
ẋ̂ = Ax̂ + Bu + L(y - Cx̂)
其中L为观测器增益矩阵，可以通过极点配置或其他方法确定。
5. Simulink仿真实现
5.1 仿真模型搭建
在Simulink中搭建二级倒立摆仿真模型的主要步骤：
- 创建非线性动力学子系统：根据推导的方程实现非线性模型
- 添加控制器模块：实现LQR控制算法
- 设计状态观测器模块（如果需要）
- 添加信号源和显示模块
5.2 关键模块实现
非线性动力学模块： 使用S-Function或基本运算模块实现非线性微分方程 包括三角函数、乘法、积分等运算
LQR控制器模块： 实现状态反馈u = -Kx 包括矩阵乘法运算
观测器模块： 实现观测器动态方程 需要处理测量噪声和过程噪声
5.3 仿真参数设置
- 求解器选择：通常使用ode45或ode15s
- 仿真时间：根据系统响应特性设置
- 步长设置：固定步长或变步长
- 初始条件：设置合理的初始偏移
6. 仿真结果与分析
6.1 平衡控制仿真
展示系统从初始偏移位置回到平衡状态的过程。分析：
- 小车位置响应
- 摆杆角度变化
- 控制力变化
- 稳定时间
6.2 抗干扰仿真
在系统平衡状态下施加脉冲干扰，观察系统的恢复能力。评估：
- 最大偏移量
- 恢复时间
- 控制力需求
6.3 参数敏感性分析
改变系统参数（如质量、长度等），观察控制效果的变化。这有助于理解控制器的鲁棒性。
7. 实际实现考虑
7.1 传感器选择
实际实现需要考虑：
- 编码器：测量摆杆角度
- 位置传感器：测量小车位置
- IMU：辅助测量角度和角速度
7.2 执行机构
- 电机选择：直流电机或步进电机
- 驱动电路：H桥驱动
- 力/力矩转换：考虑传动机构
7.3 实时性考虑
- 采样频率选择
- 计算延迟补偿
- 离散化影响
8. 进阶研究方向
- 非线性控制方法：滑模控制、自适应控制等
- 智能控制方法：模糊控制、神经网络控制
- 鲁棒控制设计：考虑参数不确定性和干扰
- 能量控制方法：基于能量的控制策略
