› 关节力矩动力学 返回
Robotics · Dynamics

机器人关节力矩·牛顿-欧拉动力学计算器

2 自由度平面机械臂的逆动力学计算。计算 M(θ)θ̈+C(θ,θ̇)θ̇+G(θ)=τ 的各项,并沿三次样条轨迹实时绘制力矩变化。实时显示峰值力矩与重力保持力矩。

参数设置
预设方案
连杆参数
L₁ [m]
m
L₂ [m]
m
m₁ [kg]
kg
m₂ [kg]
kg
当前姿态
θ₁ [deg]
°
θ₂ [deg]
°
轨迹设置
运动时间 T [s]
s
目标 θ₁ [deg]
°
目标 θ₂ [deg]
°
实时数值(动画中持续更新)
—
θ₁ [deg]
—
θ₂ [deg]
—
τ₁ 关节 1 [N·m]
—
τ₂ 关节 2 [N·m]
—
重力项 G₁ [N·m]
—
峰值 τ [N·m]
实时动力学动画
连杆 1 连杆 2 惯性 M θ̈ 科氏 C θ̇ 重力 G
力矩-时间曲线(整条轨迹)
理论与主要公式

拉格朗日/牛顿-欧拉:

$$\mathbf{M}(\boldsymbol{\theta})\ddot{\boldsymbol{\theta}}+ \mathbf{C}(\boldsymbol{\theta},\dot{\boldsymbol{\theta}})\dot{\boldsymbol{\theta}}+ \mathbf{G}(\boldsymbol{\theta}) = \boldsymbol{\tau}$$

惯性矩阵(均质杆,$l_{c}=L/2$,$I_{z}=mL^2/12$):$M_{11}= m_1 l_{c1}^2 + I_{z1} + m_2\left(L_1^2 + l_{c2}^2 + 2L_1 l_{c2} c_2\right) + I_{z2}$

重力向量:$G_1 = (m_1 l_{c1}+m_2 L_1)g c_1 + m_2 g l_{c2} c_{12}$,$G_2 = m_2 g l_{c2} c_{12}$

三次样条:$\theta(t)=\theta_0+(\theta_f-\theta_0)\left[3(t/T)^2-2(t/T)^3\right]$

关于机器人关节力矩·牛顿-欧拉动力学计算器

🙋
这个模拟器计算的「关节力矩」,是机器人哪个部位需要的力?
🎓
简单说,就是机器人肩部和肘部的电机必须输出的转动力。以这台两连杆机器人为例,与基座相连的是第 1 关节,两根连杆之间的连接是第 2 关节。改变连杆长度 (L₁, L₂)、质量 (m₁, m₂) 或设定想要的运动轨迹,工具就会算出各关节所需的力矩。试着用滑块把连杆加长,看看所需力矩如何变化。
🙋
显示的「M(θ)θ̈」「C(θ,θ̇)θ̇」「G(θ)」各自有什么不同?
🎓
在实际工作中把它们分开考虑很重要。G(θ) 是重力引起的力矩,是机器人静止时也需要的「保持力矩」。C(θ,θ̇)θ̇ 是抵抗连杆转动时产生的科氏力和离心力的力矩,比如高速挥动手臂时就需要它。M(θ)θ̈ 是抵抗加速度的惯性力矩。在模拟器里把「运动时间 T」缩短(高速运动),就能看到这一项大幅跳升。
🙋
为什么要特意使用「三次样条轨迹」?直接一条直线运动到目标角度不行吗?
🎓
问得好。只看位置的话,直线也可以。但如果速度或加速度从零骤然跳到最大值,电机会承受过大的负载,造成振动和噪声。三次样条是把运动的起点和终点平滑连接(两端速度为零)的轨迹。在模拟器里改变「目标 θ₁」和「运动时间 T」,对比力矩曲线:目标角度加大时峰值几乎不增,而把 T 减半惯性项就变成 4 倍。现场很多时候就是靠这种轨迹规划来决定电机尺寸的。

常见问题

会。在参数输入栏改变连杆长度或质量后,运动方程的各项(惯性矩阵 M、科氏项 C、重力项 G)会重新计算,力矩曲线也立即更新。峰值 τ 的数值同样会按整条轨迹重新计算。
三次样条轨迹是用两端速度为零的三次多项式在起点和终点角度之间进行插值,得到的角度、角速度、角加速度时间曲线。它可以模拟实际机器的加减速,实现避免力矩突变的、符合实际的逆动力学计算。
本工具不会发出警告,请把峰值 τ 与乘以减速比后的电机额定力矩进行比较。对策包括减轻连杆质量、降低运动速度(延长轨迹时间)或重新选择减速比。需要调整参数,使峰值力矩落在额定值以内。
牛顿-欧拉法递推计算各连杆的力和力矩,计算效率高,适合实时绘图。拉格朗日法由能量推导,公式往往比较复杂,但对两连杆而言两种方法得到的是同一个闭式运动方程,因此本工具在每一帧直接计算该闭式(M、C、G 各项)。

实际应用

工业机器人的电机选型:由此计算得到的峰值力矩和有效(RMS)力矩,是确定伺服电机和减速器容量的直接输入条件。电机过大会增加成本和重量,过小则导致过热和故障,因此在设计初期准确估算必不可少。

多体动力学(CAE)仿真的前处理:在用 Adams、Simpack 等进行正式的 MBD(多体动力学)分析之前,可用这类工具掌握关节力矩的概算,从而合理设定施加给 CAE 模型的驱动函数以及关节部位详细应力分析所需的载荷条件。

机器人控制器的设计与调试:计算得到的运动方程各项(惯性、科氏、重力)可直接用于「基于模型的控制」「重力补偿」等高级控制算法的设计,从而实现节能且高精度的运动。

协作机器人的安全验证:对于与人共处的协作机器人,可以预测意外动作(如与人接触)时的关节力矩,用于设定安全机构(力矩传感器检测并停机)的阈值。

常见误解与注意事项

开始使用这个工具时,尤其是面向实际工作时,有几点需要注意。首先是「连杆质量要按重心位置考虑」。工具里「连杆质量」只用一个数值设定,但在实际设计中,这些质量集中在连杆的「哪里」尤为重要。同样是 1 kg 的连杆,如果质量位于远离关节的末端,惯性矩会大上一个量级。本工具把连杆视为均质杆(重心在连杆中点,惯性矩 $mL^2/12$),因此在实机上务必另行计算并核对惯性矩。

其次是「计算结果只是理想的驱动力矩」这一认识。本模拟器输出的是理论上所需力矩的最小值。实际选择电机时要乘以安全系数(例如 1.5~2 倍),再加上减速器惯量与摩擦、线缆张力等各种损耗力矩。工具显示「10 Nm」时,现场往往会选用 20 Nm 级的电机。

最后,希望你能切身体会「轨迹规划决定一切」这一点。改变目标角度,力矩几乎不变;但仅把「运动时间 T」从 2.0 s 缩短到 0.5 s,默认机械臂的峰值 τ 就从约 16 N·m 翻倍到约 34 N·m,单看惯性项更是从约 1.4 N·m 增到约 23 N·m,达 16 倍。这是因为加速度项 $M(\theta)\ddot{\theta}$ 占了主导。盲目要求高速会使电机尺寸和成本急剧膨胀,所以运动速度的设定是最重要的权衡之一。

使用指南

  1. 输入连杆 1 的长度 (L1) 和质量 (m1),例如 L1=0.5 m、m1=2 kg
  2. 输入连杆 2 的长度 (L2) 和质量 (m2),例如 L2=0.4 m、m2=1.5 kg
  3. 参数一经改变,牛顿-欧拉力矩计算就会自动重新执行
  4. 实时数值卡显示 θ₁、θ₂、τ₁、τ₂、重力项 G₁ 和峰值 τ;动画内的柱状图显示惯性 M、科氏 C、重力 G 各分量
  5. 沿三次样条轨迹的力矩-时间曲线可查看运动过程中负载的变化

具体计算示例

取 L1=0.6 m、m1=3 kg、L2=0.5 m、m2=2 kg,当前姿态 θ1=0°、θ2=0°(水平伸展)时,重力保持力矩在关节 1 约为 25.5 N·m,在关节 2 约为 4.9 N·m。以运动时间 T=2.0 s 摆向目标 θ1=90°、θ2=0° 时,起动瞬间叠加约 4.4 N·m 的惯性项,峰值 τ 约为 29.9 N·m。把 T 缩短到 1.0 s,惯性项增至 4 倍约 17.4 N·m,峰值升到约 42.9 N·m。

实务注意事项

  1. 重力项与 cos θ 成正比:水平伸展(θ₁=θ₂=0°)时最大,手臂竖直向上(θ₁=90°、θ₂=0°)时为零;默认机械臂从约 17.2 N·m 降到 0
  2. 重型臂预设(m₁=10 kg、m₂=8 kg)的重力保持力矩约为 90 N·m,接近轻型臂预设(约 9 N·m)的 10 倍;减轻连杆质量最为有效
  3. 默认机械臂的科氏项在 T=2.0 s 时低于 0.1 N·m,T=0.5 s 时也只有约 1.2 N·m;随速度急剧增大的是惯性项(T=0.5 s 时约 23 N·m)
  4. 选择电机时,应在本工具的理论力矩上加上减速器摩擦与惯量、线缆张力等损耗,并留出 1.5~2 倍的安全系数