场景交代:把图画成一维水平模型:左侧灰色墙是期望位置或固定参考端,右侧蓝色方块是机器人末端等效出来的虚拟质量 \(M_d\)。上方锯齿线是虚拟弹簧 \(K_d\),下方黄色圆角筒和伸出的杆是虚拟阻尼器 \(B_d\)。弹簧和阻尼器都一端连在左侧固定端,另一端连在右侧质量块上,所以它们是并联关系。末端相对期望位置的偏差、偏差速度、偏差加速度都沿这条水平接触方向定义。
题目:机器人末端沿水平方向与环境接触。把期望末端位置画成左侧固定参考端,把实际末端等效成右侧质量块;虚拟弹簧 \(K_d\) 和虚拟阻尼器 \(B_d\) 并联连接在固定参考端与末端质量块之间。规定向右为正方向,某时刻末端误差 \(e=0.01\,\mathrm m\),表示末端相对期望位置向右偏了 1 cm;误差速度 \(\dot e=-0.05\,\mathrm{m/s}\),表示这个偏差正在减小;误差加速度 \(\ddot e=0.2\,\mathrm{m/s^2}\)。若 \(M_d=1\), \(B_d=20\), \(K_d=200\),求阻抗模型输出的期望力 \(F_d\)。
阻抗模型示意:左侧灰色墙是期望位置/固定参考端;上方锯齿线是虚拟弹簧 Kd;下方黄色圆角筒和伸出的杆是虚拟阻尼器 Bd;右侧蓝色方块是机器人末端等效出来的虚拟质量 Md。弹簧和阻尼器并联连接在固定参考端与末端质量之间,箭头 Fd 表示模型计算出的期望接触力方向。
图中元素:读图时从左到右看:固定参考端提供期望位置,弹簧 \(K_d\) 看位移误差,阻尼器 \(B_d\) 看误差速度,质量 \(M_d\) 看误差加速度,三项共同形成 \(F_d\)。
建模顺序:- 先把图读成一维并联模型:弹簧、阻尼器和质量都沿同一水平接触方向作用。
- 规定正方向,并确认 \(e,\dot e,\ddot e\) 的正负号都按这个方向给出。
- 分别计算惯性项 \(M_d\ddot e\)、阻尼项 \(B_d\dot e\)、刚度项 \(K_de\)。
- 把三项相加得到 \(F_d\),最后解释为什么阻尼项可能为负。
解析过程
先把图和公式对应起来。右侧蓝色块是虚拟质量 \(M_d\),它对应惯性项 \(M_d\ddot e\);上方锯齿线是虚拟弹簧 \(K_d\),它对应刚度项 \(K_de\);下方黄色筒状元件是虚拟阻尼器 \(B_d\),它对应阻尼项 \(B_d\dot e\)。三者都连接在同一对端点之间,所以总力就是三项相加。
第一步写阻抗模型。这个模型不是环境真实长成弹簧和阻尼器,而是控制器希望机器人末端表现得像一个“质量-阻尼-弹簧”系统:
$$F_d=M_d\ddot e+B_d\dot e+K_de$$
第二步算虚拟质量项。误差加速度为正,说明偏差加速度沿正方向,因此惯性项也沿正方向:
$$M_d\ddot e=1\times0.2=0.2\,\mathrm N$$
第三步算虚拟阻尼项。阻尼器看的是误差速度 \(\dot e\)。这里 \(\dot e=-0.05\,\mathrm{m/s}\),负号表示误差正在往减小方向变化,所以阻尼项是负的:
$$B_d\dot e=20\times(-0.05)=-1\,\mathrm N$$
这个 \(-1\,\mathrm N\) 的含义是:系统已经在往“误差变小”的方向运动,阻尼器会像刹车一样减少继续推的力,防止冲过头或振荡。
第四步算虚拟弹簧项。误差 \(e=0.01\,\mathrm m\) 是当前偏离期望位置的位移,弹簧项按位移成比例产生恢复作用:
$$K_de=200\times0.01=2\,\mathrm N$$
最后把三项按同一正方向相加:
$$F_d=0.2-1+2=1.2\,\mathrm N$$
所以模型输出的期望力为 \(1.2\,\mathrm N\),方向为我们规定的正方向。它比单纯弹簧项 \(2\,\mathrm N\) 小,是因为阻尼项为负,正在抵消一部分弹簧力;这正是阻尼器让接触响应更平稳的作用。
易错点:阻尼项可能为负,表示误差正在回缩时产生反向阻尼作用。