双自由度机械臂运动控制：LQR与MPC方案对比

markdown复制## 1. 项目背景与核心问题

在工业自动化领域，双自由度机械臂是最基础的模块化单元。去年调试某包装产线时，我发现机械臂从静止状态A点到B点的运动控制存在明显抖动，末端执行器到位后还要振荡2-3秒才能稳定——这种问题在需要快速连续作业的场景简直是灾难。

传统PID控制虽然简单，但在处理非线性因素（如关节摩擦、负载变化）时表现不佳。这个项目就是要解决两个核心问题：如何让机械臂从静止到静止的运动过程更平滑？如何确保末端定位精度在±0.1mm内？通过对比开环最优控制与模型预测控制(MPC)两种方案，配合Matlab仿真验证，最终得到了可工程化的解决方案。

## 2. 系统建模与动力学分析

### 2.1 双自由度机械臂建模

以常见的SCARA型机械臂为例，采用拉格朗日法建立动力学方程：

```matlab
% 动力学参数定义
syms m1 m2 l1 l2 q1 q2 dq1 dq2 ddq1 ddq2 g real
% 动能/势能计算
T = 0.5*m1*(l1*dq1)^2 + 0.5*m2*((l1*dq1)^2 + (l2*(dq1+dq2))^2 + 2*l1*l2*dq1*(dq1+dq2)*cos(q2));
V = m1*g*l1*sin(q1) + m2*g*(l1*sin(q1)+l2*sin(q1+q2));
% 拉格朗日方程
L = T - V;
tau1 = simplify(diff(diff(L,dq1),t) - diff(L,q1));
tau2 = simplify(diff(diff(L,dq2),t) - diff(L,q2));

建模时需要特别注意：

1. 连杆质量分布采用集中质量假设
2. 关节摩擦模型选用库伦+粘滞组合：friction = fc*sign(dq) + fv*dq
3. 电机惯量需折算到关节侧

2.2 状态空间表达

将二阶微分方程转化为状态空间形式：

code复制dx/dt = Ax + Bu
y = Cx + Du

其中状态变量x=[q1; q2; dq1; dq2]，控制输入u=[τ1; τ2]。通过线性化处理（如在工作点泰勒展开），可以得到系统矩阵A和控制矩阵B。

3. 开环最优控制实现

3.1 性能指标设计

采用二