约束与接触：拉格朗日乘子到底是什么力

在拉格朗日法那篇文章里，我们把平面五杆机构沿一个关节暂时“切开”，先写成树形系统，再用闭环条件：

\phi(q)=0

要求左右两条支链回到同一个末端点。动力学方程随之多出一项：

M(q)\ddot q+h(q,\dot q) =B\tau+J_c(q)^T\lambda

其中 $h=c+g$ 汇总速度耦合与重力， $J_c=\partial\phi/\partial q$ 是约束雅可比。那篇文章把 $\lambda$ 称为拉格朗日乘子，也说它代表维持闭环所需的约束力。

这句话很容易留下几个疑问：

一个从方程里增加的未知量，为什么会具有力的意义？
真正作用在关节上的量是 $\lambda$ ，还是 $J_c^T\lambda$ ？
铰链可以推也可以拉，桌面接触却只能推；它们能使用同一种写法吗？
摩擦为什么会把一个等式问题变成互补问题？

这些疑问恰好把前面的拉格朗日法、五杆机构、雅可比和阻抗控制连接在一起。闭环机构关心“几何怎样始终成立”，接触问题还要决定“约束何时出现、何时消失，以及出现后能够传递什么力”。

本文从五杆机构的切口重新出发，逐步走到刚体接触与摩擦。

五杆机构切开后由闭环约束重新连接

1. 五杆机构的两条支链必须对上同一个点

设五杆机构的左右基座点为 $A,B$ ，四个关节坐标为：

q= \begin{bmatrix} q_1&q_2&q_3&q_4 \end{bmatrix}^T

定义平面单位向量：

u(\theta)= \begin{bmatrix} \cos\theta\\ \sin\theta \end{bmatrix}

从左支链走到末端，得到：

p_L(q) =A+L_1u(q_1)+L_2u(q_1+q_2)

从右支链走到末端，得到：

p_R(q) =B+L_3u(q_3)+L_4u(q_3+q_4)

切开机构时， $p_L$ 与 $p_R$ 暂时成为两个可以独立运动的端点。重新闭合只需要一个条件：

\phi(q) =p_L(q)-p_R(q) =0

$\phi\in\mathbb R^2$ ，因此它提供两个标量约束。四个关节坐标减去两个独立约束，留下五杆机构的两个自由度。

这个写法已经埋下了“力”的入口。 $\phi$ 使用笛卡尔位移描述两个切口之间的错位；如果没有闭环反力，两条支链在惯性、重力和驱动力矩作用下会产生不同加速度， $p_L$ 与 $p_R$ 随即分开。约束力的任务，就是恰好修正这份分离趋势。

2. 约束雅可比描述哪些速度被禁止

对闭环条件求时间导数：

\dot\phi =J_c(q)\dot q =0

其中：

J_c(q) =\frac{\partial\phi}{\partial q} = \begin{bmatrix} J_L(q_1,q_2)&-J_R(q_3,q_4) \end{bmatrix}

$J_L$ 把左侧关节速度映射为 $\dot p_L$ ， $J_R$ 把右侧关节速度映射为 $\dot p_R$ 。负号来自 $\phi=p_L-p_R$ 。

满足闭环的关节速度必须落在 $J_c$ 的零空间中：

\dot q\in\operatorname{Null}(J_c)

这就是机构真正允许的瞬时运动方向。任何让 $J_c\dot q\ne0$ 的速度，都会在切口处制造相对运动，因而被闭环铰链禁止。

再求一次导数，得到加速度约束：

J_c\ddot q+\dot J_c\dot q=0

$J_c\ddot q$ 描述关节加速度造成的切口相对加速度， $\dot J_c\dot q$ 则来自机构几何本身正在变化。漏掉后者，相当于只约束瞬时切线，却忘记约束流形本身是弯曲的。

约束雅可比把允许运动与约束反力分到互相正交的空间

3. 虚功把约束雅可比的转置变成了力

现在考虑一份满足闭环的微小虚位移 $\delta q$ 。它必须满足：

J_c\delta q=0

理想刚性约束不会沿允许运动方向做虚功。设广义约束力为 $Q_c$ ，于是：

Q_c^T\delta q=0 \qquad \text{对所有满足 }J_c\delta q=0\text{ 的 }\delta q

线性代数告诉我们，与 $J_c$ 零空间正交的向量必定位于 $J_c$ 的行空间，也就是 $J_c^T$ 的列空间。因此存在一组系数 $\lambda$ ，使：

Q_c=J_c^T\lambda

把它放回虚功：

Q_c^T\delta q =\lambda^TJ_c\delta q =0

力的形式由约束几何直接决定了。 $J_c$ 把关节速度映射到“违反约束的速度”； $J_c^T$ 则把约束空间中的反力映射回关节广义力。这与雅可比文章里的：

\tau=J^TF

完全是同一个对偶关系。

在五杆机构中：

J_c^T\lambda = \begin{bmatrix} J_L^T\lambda\\ -J_R^T\lambda \end{bmatrix}

它表示在切口两侧施加一对大小相等、方向相反的笛卡尔力，再由左右支链各自的雅可比转置映射成关节力矩。闭环反力由此自动满足作用力与反作用力。

4. 拉格朗日乘子何时可以直接叫“力”

在当前五杆例子里， $\phi=p_L-p_R$ 的单位是米，约束虚功写成：

\lambda^T\delta\phi

为了得到焦耳， $\lambda$ 的单位必须是牛顿。此时 $\lambda\in\mathbb R^2$ 确实可以解释为切口处的一对笛卡尔力分量。

但这个结论依赖约束函数的选择。假设把同一个约束重新缩放：

\bar\phi=S\phi=0

新的约束雅可比为 $\bar J_c=SJ_c$ 。为了保持同一份广义约束力，需要：

J_c^T\lambda =\bar J_c^T\bar\lambda =J_c^TS^T\bar\lambda

因此：

\lambda=S^T\bar\lambda

约束函数换了尺度或基底，乘子的数值也会跟着改变；真正作用在系统上的广义力 $J_c^T\lambda$ 保持不变。

所以更准确的表述是：

拉格朗日乘子是约束反力在所选约束坐标中的系数， $J_c^T\lambda$ 才是坐标无关的广义约束力。

当约束坐标就是正交笛卡尔距离时， $\lambda$ 可以直接读作力；若约束混合了角度、距离或人为缩放，乘子的分量可能分别具有牛米、牛顿或经过缩放的单位。符号也取决于 $\phi$ 的方向定义。

5. 加速度与约束力必须同时求解

把树形系统的动力学和加速度约束放在一起：

M\ddot q+h =B\tau+J_c^T\lambda

J_c\ddot q+\dot J_c\dot q=0

未知量同时包含 $\ddot q$ 和 $\lambda$ 。整理为块矩阵：

\begin{bmatrix} M&-J_c^T\\ J_c&0 \end{bmatrix} \begin{bmatrix} \ddot q\\ \lambda \end{bmatrix} = \begin{bmatrix} B\tau-h\\ -\dot J_c\dot q \end{bmatrix}

这是一组典型的 KKT 方程。第一行要求动力学平衡，第二行要求加速度留在约束流形上。左下与右上两个雅可比块，把“运动不能穿过约束”和“约束会产生反力”放进同一个线性系统。

约束动力学的 KKT 方程同时求加速度与拉格朗日乘子

也可以先消去 $\ddot q$ 。定义：

W=J_cM^{-1}J_c^T

若约束独立， $W$ 可逆，乘子为：

\lambda =-W^{-1} \left[ J_cM^{-1}(B\tau-h) +\dot J_c\dot q \right]

方括号里的量，是系统完全不施加约束力时切口将产生的相对加速度； $W^{-1}$ 把这份“想要分开”的趋势换算成恰好抵消它的约束力。

6. 约束空间逆质量衡量约束方向有多容易被推动

$W=J_cM^{-1}J_c^T$ 常被称为 Delassus 算子或约束空间逆质量矩阵。它回答一个直接的物理问题：在约束方向施加单位反力，会产生多大的约束空间加速度。

质量大、机械优势小的方向，单位力造成的加速度较小；接近机构奇异位形时，不同约束方向还可能变得线性相关。

对五杆机构，如果 $J_c$ 满行秩，两条闭环约束独立， $W$ 通常是 $2\times2$ 正定矩阵。到达并联奇异位形后，左右远端连杆提供的约束方向可能合并， $J_c$ 或相关约束映射失去秩。此时会出现两个重要现象：

某个方向失去有效约束，机构能够产生意外瞬时运动；
多组 $\lambda$ 可能生成相同的广义约束力，单独的乘子不再唯一。

四条腿支撑一张刚性桌子也会产生类似情况：桌面的加速度可以唯一，四条腿之间怎样分配法向力却未必唯一。伪逆会选出某个数学解，真实载荷分配还受结构柔性、制造误差和接触顺序影响。

这也是为什么“求出了 $\lambda$ ”还不等于“精确预测了每处真实载荷”。刚体模型只提供理想约束下的反力分配。

7. 闭环是双边约束，接触是单边约束

五杆机构的铰链始终闭合。它既能阻止两端分开，也能阻止两端互相穿过；对应的 $\lambda$ 可以取正值或负值。这类约束称为双边约束：

\phi(q)=0, \qquad \lambda\in\mathbb R^m

桌面与物体之间的接触规律不同。定义法向间隙函数 $g(q)$ ：

g(q)>0 \quad\text{表示分离}

g(q)=0 \quad\text{表示接触}

刚体不能互相穿透，因此：

g(q)\ge0

法向接触力只能把物体推离桌面，不能隔空把物体吸向桌面：

\lambda_n\ge0

接触雅可比：

J_n(q)=\frac{\partial g}{\partial q}

仍然通过转置把法向力映射成广义力：

Q_n=J_n^T\lambda_n

从闭环到接触，雅可比转置的作用没有变化。新的难点来自约束是否激活：闭环约束始终存在，接触约束会随运动建立和解除。

双边闭环约束与单边接触约束的区别

8. 互补条件把“接触或分离”写成一个方程组

法向接触需要同时满足三条规则：

g(q)\ge0, \qquad \lambda_n\ge0, \qquad g(q)\lambda_n=0

通常简写为：

0\le\lambda_n \;\perp\; g(q)\ge0

符号 $\perp$ 在这里表示互补，而非普通几何正交。它规定两个非负量至少有一个等于零：

$g>0$ 时，物体与环境分离，因此 $\lambda_n=0$ ；
$\lambda_n>0$ 时，接触正在传力，因此 $g=0$ ；
$g=0,\lambda_n=0$ 对应刚好贴住、尚未承受法向载荷。

这条关系同时消除了“穿透”和“隔空接触力”。接触集合无需提前完全确定，求解器会在每个候选接触上选择分离分支或接触分支。

连续时间里，已经建立且保持的接触还满足 $\dot g=0$ ，其法向力可以像双边约束一样由加速度方程求出。接触即将解除时，维持 $\ddot g=0$ 所需的 $\lambda_n$ 若变成负值，说明刚体模型要求环境“拉住”物体；正确的模式应切换为 $\lambda_n=0$ 、 $\ddot g\ge0$ 。