MATLAB Simulink实战从零构建LQR自平衡小车系统两轮自平衡小车是学习现代控制理论的绝佳实验平台。相比传统的PID控制线性二次型调节器LQR能提供更优的系统性能和稳定性。本文将带你完整实现从动力学建模到硬件部署的全流程包含以下关键环节1. 平衡小车动力学建模建立准确的数学模型是LQR控制的基础。我们采用拉格朗日方程法推导相比牛顿力学分析法更简洁% 系统参数定义 M 0.5; % 底盘质量(kg) m 0.2; % 摆杆质量(kg) l 0.3; % 摆杆质心到转轴距离(m) g 9.8; % 重力加速度(m/s²) I 0.006; % 摆杆转动惯量(kg·m²)拉格朗日方程推导过程系统总动能底盘平动动能0.5Mẋ²摆杆平动动能0.5m(ẋ² (lθ̇cosθ)² (lθ̇sinθ)²)摆杆转动动能0.5Iθ̇²系统总势能摆杆重力势能mgl(1-cosθ)建立拉格朗日量L T - V代入欧拉-拉格朗日方程% 线性化后的状态方程系数 a21 m*g/M; a41 (Mm)*g/(M*l); b2 1/M; b4 1/(M*l);最终得到状态空间表达式ẋ A·x B·u y C·x D·u其中状态向量x [位置 速度 角度 角速度]ᵀ2. LQR控制器设计与实现LQR通过最小化代价函数J ∫(xᵀQx uᵀRu)dt来求解最优控制律u -Kx2.1 权重矩阵配置技巧Q和R矩阵的选取直接影响控制效果状态量物理意义典型权重范围调整策略位置(x)小车位移1-10增大可减少稳态误差速度(ẋ)移动速度0.1-1过大易引起振荡角度(θ)摆杆倾斜角10-100对平衡最关键角速度(θ̇)倾倒速度1-10影响动态响应控制量(u)电机输入电压0.1-1增大可限制控制能量消耗% 典型权重配置示例 Q diag([10, 0.5, 50, 5]); % 状态权重 R 0.3; % 控制权重2.2 MATLAB求解与验证使用lqr()函数计算反馈增益矩阵K[K, S, e] lqr(A, B, Q, R); disp(LQR反馈增益矩阵K:); disp(K);系统可控性检查Tc ctrb(A, B); if rank(Tc) size(A,1) disp(系统完全可控); else error(系统不可控请检查模型); end3. Simulink仿真模型搭建构建完整的控制仿真系统Plant Model实现状态方程的非线性动力学模型State Observer实际系统中可能需要卡尔曼滤波器估计状态LQR Controller应用计算得到的K矩阵Motor Dynamics包含电机响应延迟和饱和特性关键提示仿真时建议加入2-5%的测量噪声和0.1-0.5秒的执行器延迟使仿真更接近真实情况仿真参数配置示例参数项推荐值说明求解器类型ode4(Runge-Kutta)固定步长0.001s噪声强度0.03高斯白噪声标准差输入限制±12V模拟电机电压限制初始角度5°测试平衡恢复能力4. 实际部署与调参经验4.1 硬件接口实现将仿真结果移植到STM32等嵌入式平台时需注意将K矩阵转换为定点数格式Q格式状态量单位统一角度用弧度制添加软件限幅保护电机// STM32上的LQR控制代码示例 float K[4] {-1.0, -1.97, 36.24, 1.86}; // 仿真得到的K矩阵 float u 0; void LQR_Update(float x[4]) { u 0; for(int i0; i4; i) { u - K[i] * x[i]; // 负反馈 } u constrain(u, -12.0, 12.0); // 电压限幅 set_motor_voltage(u); }4.2 常见问题排查调试过程中遇到的典型问题及解决方案小车剧烈振荡检查角速度传感器极性是否正确适当减小Q矩阵中角度和角速度的权重增加低通滤波截止频率10-20Hz无法维持平衡确认所有状态量的单位一致检查电机输出是否达到饱和验证K矩阵元素符号是否正确响应迟缓增大Q矩阵中角度和角速度的权重检查是否存在通信延迟提高控制频率建议≥100Hz5. 进阶优化方向当基础LQR实现稳定后可考虑以下增强方案增益调度针对不同倾斜角范围使用多组K矩阵积分补偿添加状态积分项消除稳态误差鲁棒性优化使用H∞方法增强抗干扰能力参数自适应在线识别质量变化并调整K矩阵实验数据记录表明经过优化的LQR控制器可实现静态平衡误差 ±1.5°抗扰动恢复时间 0.8s对10°阶跃干扰最大平衡角度±25°受电机扭矩限制最后分享一个实用技巧先用PID实现基本平衡记录各状态量的典型值范围这将帮助您更合理地设置Q矩阵的初始权重。实际调试时可以先将小车倾斜到临界平衡位置观察各状态量的数值变化据此调整相应权重。