MATLAB倒立摆仿真：从建模到LQR控制实战-代码聚汇网

MATLAB倒立摆仿真：从建模到LQR控制实战

moumoon沐月

1. 倒立摆系统仿真概述

倒立摆作为经典的控制系统教学案例，一直是自动控制原理课程中的"明星实验对象"。这个看似简单的物理系统，实际上包含了非线性、不稳定、强耦合等典型控制难题。在MATLAB环境下，我们可以通过Simulink和Simscape两大工具实现从建模到控制的完整仿真流程。

我最近用两周时间完整走通了这套流程，从物理建模到PID参数整定，积累了不少实战经验。不同于教科书上的理论推导，实际仿真中会遇到采样时间选择、传感器噪声处理、执行器饱和等工程实际问题。本文将分享基于MATLAB R2023a的完整实现过程，特别适合需要完成课程设计或准备控制类竞赛的同学参考。

2. 仿真环境搭建

2.1 硬件参数定义

首先需要明确倒立摆的物理参数，这对后续建模精度至关重要。我们以常见的直线式倒立摆为例：

matlab复制% 系统参数定义
M = 0.5;    % 小车质量(kg)
m = 0.2;    % 摆杆质量(kg)
b = 0.1;    % 小车摩擦系数(N/m/s)
l = 0.3;    % 摆杆质心到转轴长度(m)
I = 0.006;  % 摆杆转动惯量(kg*m^2)
g = 9.8;    % 重力加速度(m/s^2)

注意：这些参数需要与实际物理系统保持一致。若参数未知，可通过频响测试或系统辨识方法获取近似值。

2.2 Simscape多体建模

在Simulink中新建空白模型，从Simscape > Multibody库中拖入以下组件：

Revolute Joint（旋转关节）
Rigid Transform（刚性变换）
Body Element（质量元件）
PS-Simulink Converter（物理信号转换器）

关键建模技巧：

将摆杆建模为两个刚体：旋转关节上方的连杆和下方的配重块
为小车添加Prismatic Joint（平移关节）约束
使用Spatial Contact Force模块模拟小车与轨道的摩擦

matlab复制% 模型初始化脚本
pendulum_model = 'inverted_pendulum';
open_system(new_system(pendulum_model));
% ...添加各组件并配置参数...

3. 控制系统设计

3.1 系统线性化分析

在平衡点（θ=0）附近对非线性系统进行线性化：

matlab复制[A,B,C,D] = linmod('pendulum_model', [0;0;0;0], 0);
sys = ss(A,B,C,D);

通过eig(A)查看系统极点，理论上应该有一个右半平面极点，验证了系统的不稳定性。

3.2 LQR控制器设计

采用线性二次型调节器（LQR）作为主控制器：

matlab复制Q = diag([10 1 100 1]);  % 状态权重矩阵
R = 0.1;                 % 控制量权重
[K,S,e] = lqr(A,B,Q,R);

权重矩阵的选取原则：

对角度误差给予更高惩罚（Q(3,3)=100）
控制量权重不宜过大，否则响应迟缓
可通过Bryson规则初步确定权重范围

3.3 PID参数整定

作为备用方案，同时设计PID控制器：

matlab复制pidTuner(sys, 'pid');

实际调试中发现以下经验：

先调P使系统出现等幅振荡
记录临界增益Ku和振荡周期Tu
按Ziegler-Nichols公式计算PID参数
微调微分时间避免测量噪声放大

4. 仿真实现细节

4.1 Simulink模型搭建

控制器子系统包含以下关键模块：

State-Space（实现LQR控制）
PID Controller（备用控制）
Switch（控制策略切换）
Saturation（执行器输出限幅）

传感器子系统需考虑：

Encoder分辨率设置
添加Band-Limited White Noise模块
配置低通滤波器（截止频率10Hz）

4.2 仿真参数配置

matlab复制set_param('pendulum_model', 'Solver', 'ode4',...
          'FixedStep', '0.001',...
          'StopTime', '10');

重要提示：固定步长求解器（ode4）比变步长更稳定，步长建议取控制系统带宽的1/10~1/20

5. 典型问题排查

5.1 仿真发散问题

现象：仿真过程中角度值迅速增大至NaN
解决方法：

检查关节约束方向是否正确
减小仿真步长至0.0001s
添加速度饱和限制

5.2 稳态误差问题

现象：小车无法稳定在设定位置
排查步骤：

验证系统是否包含积分环节
检查执行器饱和限幅值
调整LQR的Q矩阵位置权重

5.3 高频振荡问题

现象：系统稳定但存在小幅抖动
处理方案：

降低微分增益
在传感器后添加一阶低通滤波
检查Simscape的Solver Configuration设置

6. 进阶优化方向

鲁棒控制设计：考虑参数不确定性

matlab复制usys = ublock(sys, 'Type', 'Percentage', 'Amount', 20);

状态观测器设计：当只有角度可测时

matlab复制obsv(A,C)  % 检验能观性
L = place(A',C',[-10 -11 -12 -13])';

硬件在环测试：通过Arduino支持包连接实际电机

经过实测，这套方案在1米轨道长度内可将倒立摆稳定控制在±2°范围内。最大的收获是理解了理论设计与工程实现的差距——比如实际必须考虑的执行器饱和问题，这在教科书上往往一笔带过。下次尝试将摆杆改为柔性体，应该会面临更有趣的挑战。