144、混合力位控制：接触任务中的力位协调从一次打磨事故说起去年做3C打磨项目，机械臂装着力控法兰去磨铝合金边框。示教器上力控参数调得挺顺，空跑轨迹也漂亮，结果一上工件就出事——Z轴力波动从设定5N直接飙到18N，法兰哐哐响，工件表面一道深痕。查了半天，问题出在力控和位控打架：轨迹规划器在Z方向还在按位置模式走，力控回路同时也在调这个轴，两个控制器抢同一个关节，不抖才怪。那会儿才真正理解什么叫“混合力位控制”——不是简单把力传感器数据接进位置环，而是要在任务空间里把自由度拆开，该让位置说了算的轴绝不让力插手，该让力说了算的轴位置指令就得闭嘴。核心思想：自由度分家混合力位控制（Hybrid Force/Position Control）最早是Raibert和Craig在1981年提出的，思想直白得让人怀疑：把任务空间按笛卡尔坐标轴拆成两个子空间——位置控制子空间和力控制子空间。比如你拿机械臂去擦桌子，桌面法线方向（通常是Z）需要恒力接触，那这个轴就走力控；桌面平面内（X、Y）要跟踪轨迹，那这两个轴就走位控。但这里有个关键坑：力控轴和位控轴不是简单按世界坐标系的XYZ来分的，而是按接触表面的法线方向来分。工件斜面30度，你还在用世界坐标系Z轴做力控，实际接触力方向跟Z轴差着30度，力控精度直接崩。正确做法是先做表面法线估计，把力控方向旋转到法线方向上去。代码里体现这个分家逻辑，通常是在控制循环里维护一个选择矩阵S：