4、动力学建模（上）：拉格朗日方程法、Delta机器人动能与势能计算

各位工程师朋友，欢迎来到动力学建模的环节。

说实话，做机器人控制这么多年，我最大的体会就是：不懂动力学，你永远只能做“笨”控制。什么意思呢？就是你的机器人只能跑预设好的轨迹，负载一变就抖，速度一快就偏。嗯，今天我们要聊的拉格朗日方程法，就是解决这个问题的钥匙。

4.1 为什么非得用拉格朗日法？

你可能要问：牛顿-欧拉法不是也能建模吗？为什么我推荐拉格朗日法？

我个人习惯用拉格朗日法，原因很简单——它不用处理约束力。Delta机器人有3条并联支链，每条支链都有好几个关节。如果用牛顿法，你得把每个关节的反力、摩擦力全列出来，那方程组能写满一黑板。而拉格朗日法只关心能量，你算动能和势能就行了，约束力自动被消掉。

d/dt(∂L/∂q̇) - ∂L/∂q = τ

说白了，你只要会算能量，就能得到动力学方程。我在做第一个Delta机器人项目时，就是用这个方法，三天就把模型搭出来了。如果用牛顿法，估计得一周。

4.2 Delta机器人的能量从哪来？

Delta机器人结构看着复杂，其实能量来源就三部分：

• 主动臂（上臂）： 固定在电机轴上，做旋转运动
• 从动臂（下臂）： 平行四边形结构，做复杂空间运动
• 动平台（末端）： 三个支链共同驱动，做平动

你想想看，这三部分的运动形式完全不同。主动臂是纯转动，动平台是纯平动，而从动臂最麻烦——它既有平动又有转动。嗯，这里要注意，从动臂的质量通常比较轻，但你不能忽略它，尤其是在高速工况下。

4.3 动能计算：分三块算

我记得第一次算Delta机器人动能时，差点被从动臂搞崩溃。后来我总结了一个套路：分块计算，逐项叠加。

4.3.1 主动臂动能

主动臂就是绕电机轴旋转的杆件。它的动能很简单：

T_arm = ½ * I_arm * θ̇²

其中 I_arm 是主动臂绕电机轴的转动惯量，θ̇ 是角速度。这里有个坑——转动惯量一定要用平行轴定理换算到电机轴，而不是用质心处的惯量。我曾经在这个问题上吃过亏，算出来的模型频率对不上，查了两天才发现是惯量算错了。

4.3.2 从动臂动能

从动臂是平行四边形结构，它的一端连着主动臂，另一端连着动平台。它的运动可以分解为：

• 随主动臂的牵连运动（整体转动）
• 相对于主动臂的相对运动（平动+微转动）

实际工程中，我们通常做简化处理：将从动臂的质量等效到两端。我个人习惯把从动臂质量的一半放在主动臂末端，另一半放在动平台连接点。这样算出来的误差在5%以内，但计算量大大降低。

4.3.3 动平台动能

动平台做纯平动，它的动能最简单：

T_platform = ½ * m_platform * (ẋ² + ẏ² + ż²)

其中 m_platform 是动平台质量（含负载），(ẋ, ẏ, ż) 是动平台在笛卡尔空间的速度分量。

这里我要强调一点：负载的质量一定要实时更新。我在做食品分拣项目时，抓取的饼干重量从10g到50g不等，如果不更新负载质量，动力学模型就失效了。所以实际代码中，m_platform 应该是一个变量，而不是常量。

4.4 势能计算：重力是主角

Delta机器人的势能主要来自重力。弹性势能？嗯，在刚性假设下可以忽略。磁势能？一般也没有。

总势能就是三部分的重力势能之和：

V = V_arm + V_forearm + V_platform

其中：

• V_arm = m_arm * g * h_arm，h_arm 是主动臂质心高度
• V_forearm = m_forearm * g * h_forearm，h_forearm 是从动臂质心高度
• V_platform = (m_platform + m_load) * g * z，z 是动平台高度

注意，势能的零点可以任意选取，因为拉格朗日方程只关心势能的变化量。我一般把零点选在动平台的最低工作位置，这样算出来的势能都是正值，不容易出错。

4.5 知识体系总览

为了让你更直观地理解本章的知识结构，我画了一张图：

这张图把整个建模流程串起来了。你从拉格朗日方程出发，分别算动能和势能，然后代入方程，最后得到动力学方程。每一步都有对应的物理量，不会乱。

4.6 实际项目中的注意事项

最后，我分享几个实际项目中的经验：

1. 参数辨识很重要： 理论算出来的惯量、质心位置，和实际总有偏差。我建议做一次参数辨识实验，用最小二乘法拟合出真实参数。
2. 摩擦项别忘了： 拉格朗日方程本身不包含摩擦。实际控制时，需要在 τ 里加上摩擦补偿项。我一般用库仑+粘滞摩擦模型。
3. 实时性要求： 完整的动力学模型计算量不小。如果控制器算力有限，可以考虑做模型降阶。比如忽略从动臂的转动动能，只保留平动动能。