混合位置 / 力控制
- 一、先从一个简单例子说起
- 二、为什么不能只用位置控制，或者只用力控制？
-
- [1. 只用位置控制不够](#1. 只用位置控制不够)
- [2. 只用力控制也不够](#2. 只用力控制也不够)
- 三、什么是混合位置/力控制？
- 四、任务空间分解：先把任务拆开来看
-
- [1. 什么叫任务空间分解？](#1. 什么叫任务空间分解？)
- [2. 还是用擦桌子的例子](#2. 还是用擦桌子的例子)
- 五、选择矩阵：告诉系统"哪些方向控力，哪些方向控位置"
-
- [1. 选择矩阵是什么？](#1. 选择矩阵是什么？)
- [2. 为什么需要选择矩阵？](#2. 为什么需要选择矩阵？)
- [3. 用一个直观比喻理解](#3. 用一个直观比喻理解)
- 六、法向力控制：接触时"压多少"要合适
- 七、切向位置控制：沿着表面"走得准"
-
- [1. 什么是切向位置控制？](#1. 什么是切向位置控制？)
- [2. 为什么切向方向一般控位置？](#2. 为什么切向方向一般控位置？)
- [3. 例子：焊缝跟踪](#3. 例子：焊缝跟踪)
- [八、为什么"法向力控制 + 切向位置控制"特别常见？](#八、为什么“法向力控制 + 切向位置控制”特别常见？)
-
- [1. 垂直表面方向](#1. 垂直表面方向)
- [2. 平行表面方向](#2. 平行表面方向)
- 九、一个完整案例：机器人擦玻璃
-
- 任务要求
- 如何用混合位置/力控制？
-
- [1. 任务空间分解](#1. 任务空间分解)
- [2. 选择矩阵分配任务](#2. 选择矩阵分配任务)
- [3. 法向力控制](#3. 法向力控制)
- [4. 切向位置控制](#4. 切向位置控制)
- 最终效果
- 十、应用方向说明
-
- [1. 装配工业](#1. 装配工业)
- [2. 打磨、抛光、去毛刺](#2. 打磨、抛光、去毛刺)
- [3. 清洁与表面处理](#3. 清洁与表面处理)
- [4. 医疗机器人](#4. 医疗机器人)
- [5. 服务机器人与人机协作](#5. 服务机器人与人机协作)
- [6. 特种作业机器人](#6. 特种作业机器人)
- 十一、混合位置/力控制的优势
-
- [1. 更适合接触任务](#1. 更适合接触任务)
- [2. 兼顾精度与柔顺性](#2. 兼顾精度与柔顺性)
- [3. 适应环境变化](#3. 适应环境变化)
- [4. 提高作业质量](#4. 提高作业质量)
- [5. 提升安全性](#5. 提升安全性)
- 十二、也要看到它的挑战
-
- [1. 需要准确感知接触力](#1. 需要准确感知接触力)
- [2. 接触模型复杂](#2. 接触模型复杂)
- [3. 任务分解要合理](#3. 任务分解要合理)
- [4. 参数调节不容易](#4. 参数调节不容易)
- 十三、总结
在机器人控制里，有一个非常实用、也非常重要的概念，叫做 混合位置/力控制 。
它主要解决这样一类问题：
机器人不仅要到达某个位置，还要在接触环境时控制好施加的力。
听起来有点抽象，我们先举个生活中的例子。
一、先从一个简单例子说起
想象你用手拿着一块抹布擦桌子。
这个动作其实同时包含两类控制：
- 沿着桌面移动 ：你希望手按照一定轨迹前后左右擦，这属于位置控制
- 压在桌面上的力度 ：你不能太轻，不然擦不干净；也不能太重，不然费力甚至弄坏桌面，这属于力控制
也就是说：
- 在桌面平行方向 ，你更关心"擦到哪里"，这是位置
- 在桌面垂直方向 ，你更关心"压多大力"，这是力
这就是混合位置/力控制最核心的思想：
在不同方向上，分别采用不同的控制目标：有的方向控位置，有的方向控力。
二、为什么不能只用位置控制，或者只用力控制？
1. 只用位置控制不够
如果机器人只会"走到某个位置"，一旦接触到环境，问题就来了。
比如机器人把零件往孔里插，如果孔的位置有一点偏差，而机器人还死板地按照固定轨迹往里推，就可能：
- 卡住
- 挤坏零件
- 产生很大冲击力
因为它只知道"我该到哪里"，却不知道"我碰到了什么、力有多大"。
2. 只用力控制也不够
反过来，如果机器人只知道控制接触力，而不管位置，也不行。
比如擦桌子时，如果只要求"保持 10N 的压力"，但不规定它沿桌面怎么移动，那它可能根本擦不到目标区域。
所以现实中很多接触任务都需要：
- 一部分方向上精准运动
- 另一部分方向上柔顺接触
这就需要混合位置/力控制。
三、什么是混合位置/力控制？
混合位置/力控制，简单理解就是：
把机器人末端在任务空间中的运动方向拆开，有些方向控制位置，有些方向控制力。
这里的"任务空间"，通常指机器人末端执行器（比如机械臂的夹爪、打磨头、焊枪、抛光盘）所在的空间，包括：
- x、y、z 三个平移方向
- 以及姿态方向（转动）
在实际任务中，不同方向的要求不同，所以要"分工处理"。
四、任务空间分解：先把任务拆开来看
1. 什么叫任务空间分解？
所谓任务空间分解，就是把机器人末端的运动/受力方向按照任务要求进行划分：
- 哪些方向应该进行位置控制
- 哪些方向应该进行力控制
这一步非常关键，因为它决定了机器人"哪里该硬，哪里该软"。
2. 还是用擦桌子的例子
假设桌面是水平的：
- 沿桌面的两个方向（比如 x 和 y），机器人需要按照规划轨迹移动
→ 这是位置控制 - 垂直桌面的方向（z 方向），机器人需要保持一个合适的按压力
→ 这是力控制
于是任务就被分解成：
- 切向方向：控位置
- 法向方向：控力
这里要注意两个词：
- 法向：垂直于接触面的方向
- 切向：沿着接触面的方向
所以在很多接触任务里，最经典的思路就是：
法向力控制，切向位置控制
这也是你提纲里的重点。
五、选择矩阵：告诉系统"哪些方向控力，哪些方向控位置"
1. 选择矩阵是什么？
在混合位置/力控制里，有一个很重要的工具，叫做选择矩阵。
它的作用可以通俗地理解成：
给每个方向贴标签，告诉控制器这个方向该控位置，还是控力。
它本质上是一个"筛选器"或者"开关表"。
比如对于某个任务：
- x、y 方向控位置
- z 方向控力
那么选择矩阵就负责把这三个方向区分开。
2. 为什么需要选择矩阵？
因为机器人末端通常是多维的，不是只有一个方向。控制器必须明确知道：
- 哪些自由度服从位置误差
- 哪些自由度服从力误差
如果没有这个"分配规则"，控制系统就会混乱。
3. 用一个直观比喻理解
可以把选择矩阵想象成一个公司里的工作分配表：
- 小王负责"移动到目标点"
- 小李负责"控制接触压力"
每个人只管自己那部分任务，不互相抢活。
在机器人里，选择矩阵就是这个"工作分配表"。
它让位置控制器和力控制器各司其职。
六、法向力控制：接触时"压多少"要合适
1. 什么是法向力控制？
法向力控制就是在垂直接触面的方向上，控制机器人施加的力。
比如：
- 擦桌子时，控制向下按压的力
- 打磨工件时，控制砂轮压在表面的力
- 装配时，控制零件接触面的顶压力
2. 为什么法向力控制重要？
因为很多接触任务，质量好不好，很大程度上取决于接触力是否合适。
力太小会怎样？
- 擦不干净
- 打磨不充分
- 装配不到位
力太大会怎样？
- 工件损伤
- 机械臂振动
- 零件变形
- 能耗增加，甚至安全风险上升
所以机器人不能只是"碰到就行"，而要学会"轻重适中"。
3. 一个典型例子：机器人打磨
机器人拿着打磨工具处理金属表面。
如果只按预定轨迹走，而工件表面略有起伏，那么：
- 表面凸起处，压力会过大
- 表面凹下去时，压力又会过小
这样打磨质量很不稳定。
如果加入法向力控制，机器人就能实时调节：
- 高一点的地方，稍微抬一抬，避免压力过大
- 低一点的地方，稍微压一压，保持打磨力度
这样就能获得更均匀的加工效果。
七、切向位置控制：沿着表面"走得准"
1. 什么是切向位置控制？
切向位置控制，是指在沿接触面方向上，控制机器人按照指定轨迹运动。
简单说就是：
接触着表面移动，但移动路线要准。
2. 为什么切向方向一般控位置？
因为在很多任务中，沿表面运动的轨迹决定了工作效果。
比如：
- 擦桌子要覆盖整块区域
- 焊接要沿焊缝移动
- 涂胶要沿着边缘匀速走
- 抛光要沿指定路径重复扫描
这些都要求机器人在切向方向上"知道自己该去哪"。
3. 例子：焊缝跟踪
在自动焊接中，焊枪要沿着焊缝前进。
- 如果焊枪在切向方向跑偏，焊缝就会歪
- 如果在法向方向压力或距离不合适，又会影响焊接质量
所以这时通常需要：
- 切向位置控制：确保沿焊缝准确前进
- 法向力/接触控制：保持合适接触或距离
这就是混合控制在工业中的典型体现。
八、为什么"法向力控制 + 切向位置控制"特别常见？
这是因为大量接触任务天然满足这种结构。
只要机器人与某个表面接触，就很容易分成两类方向：
1. 垂直表面方向
这个方向最敏感的是"压得多不多"，所以适合控力。
2. 平行表面方向
这个方向最关键的是"走得准不准"，所以适合控位置。
因此，很多任务都会采用这种经典策略：
法向方向控制接触力，切向方向控制运动轨迹。
这种方法兼顾了：
- 稳定接触
- 精确运动
- 避免刚性碰撞
- 适应环境变化
九、一个完整案例：机器人擦玻璃
我们用"机器人擦玻璃"把前面的内容串起来。
假设机器人拿着清洁工具，在玻璃幕墙表面移动。
任务要求
- 清洁头要贴住玻璃，但不能压太重
- 清洁头要按规划路线移动，覆盖目标区域
- 玻璃表面可能有轻微不平整
如何用混合位置/力控制？
1. 任务空间分解
- 垂直玻璃表面的方向：法向
- 沿玻璃表面的方向：切向
2. 选择矩阵分配任务
- 法向方向分配给力控制器
- 切向方向分配给位置控制器
3. 法向力控制
保持一个恒定按压力，比如 15N，确保刷头既贴紧玻璃，又不会损伤表面。
4. 切向位置控制
让机器人按照"从左到右、从上到下"的轨迹移动，保证清洁全面。
最终效果
- 压力合适，清洁效果稳定
- 轨迹准确，不漏擦
- 面对轻微表面起伏也能自动调整
这就是混合位置/力控制的价值所在。
十、应用方向说明
混合位置/力控制的应用非常广，尤其适合机器人与环境直接接触的场景。
1. 装配工业
比如插销、插孔、卡扣安装、零件压装等。
这类任务中，机器人既要把零件送到正确位置，又要控制插入力，避免卡死或损坏零件。
典型应用：
- 轴孔装配
- 电子元件插装
- 汽车零部件装配
2. 打磨、抛光、去毛刺
这类任务对接触力非常敏感。
- 力太小，加工不充分
- 力太大，表面可能过磨
同时工具还要沿着工件表面精确移动，所以特别适合混合控制。
典型应用：
- 金属表面抛光
- 模具打磨
- 零件边缘去毛刺
3. 清洁与表面处理
例如擦玻璃、擦地、喷涂前表面处理、船体清洁等。
这类任务通常要求：
- 保持持续接触
- 沿表面平稳移动
- 压力均匀
4. 医疗机器人
在一些医疗场景中，机器人会与人体或器械接触，对力的控制要求很高。
例如：
- 康复训练机器人
- 手术辅助设备
- 超声探头扫描
这时机器人不能"太硬"，否则不安全；但也不能"太软"，否则操作不稳定。
5. 服务机器人与人机协作
未来服务机器人进入家庭、医院、商场后，接触任务会越来越多，比如：
- 开门
- 推车
- 扶助老人起身
- 端物品放置
这些场景都要求机器人既能完成运动目标，又能控制好接触力，提升安全性与舒适性。
6. 特种作业机器人
例如：
- 核电站检修
- 水下清洗与维护
- 航空航天表面处理
- 危险环境远程操作
这些环境中，人工直接操作困难，机器人必须具备更强的接触适应能力，混合位置/力控制就是关键技术之一。
十一、混合位置/力控制的优势
通俗来说，它的优势主要体现在以下几点：
1. 更适合接触任务
只控位置的机器人像"硬推"；混合控制的机器人更像"会摸着做事"。
2. 兼顾精度与柔顺性
既能保证路径准确，又能避免过大冲击。
3. 适应环境变化
即使表面有轻微误差、起伏或位置偏差，也能通过力控制进行调整。
4. 提高作业质量
在打磨、装配、抛光、清洁等任务中，能显著提高稳定性和一致性。
5. 提升安全性
特别是在与人接触或处理精密零件时，合理控制力非常重要。
十二、也要看到它的挑战
虽然混合位置/力控制很实用，但它并不简单，实际应用中也有难点：
1. 需要准确感知接触力
通常要依赖力传感器或估计算法。
2. 接触模型复杂
现实中的接触面并不总是理想平面，摩擦、变形、振动都会影响控制效果。
3. 任务分解要合理
如果方向分错了，控制效果会很差。
4. 参数调节不容易
位置环和力环之间要协调好，否则可能出现抖动或不稳定。
不过随着传感器、控制算法和智能机器人技术的发展，这些问题正在逐步改善。
十三、总结
混合位置/力控制的本质，可以用一句话概括：
机器人在与环境接触时，不是所有方向都只追求"到位"，而是要根据任务特点，在某些方向控制位置，在另一些方向控制力。
其中最经典、最常见的方式就是：
- 法向力控制
- 切向位置控制
为了实现这一点，需要先进行：
- 任务空间分解：明确哪些方向控力，哪些方向控位置
- 选择矩阵：把不同方向分配给对应控制器
这种方法特别适用于：
- 装配
- 打磨抛光
- 清洁
- 医疗机器人
- 人机协作
- 特种作业机器人
可以说，混合位置/力控制让机器人不再只是"机械地运动"，而是开始具备一种更像人类的能力：
既会走位，又懂轻重。