3. 传感器选型与布局：位置传感器、加速度计、力传感器
各位同事，今天我们来聊聊传感器。说实话，在晶圆传输系统里，传感器就是我们的「眼睛」和「耳朵」。选对了，系统稳如老狗；选错了，抖动问题能让你怀疑人生。
我个人习惯把传感器分成三类：位置传感器（告诉你「在哪」）、加速度计（告诉你「抖不抖」）、力传感器（告诉你「夹没夹坏」）。下面一个一个说。
3.1 位置传感器选型原则
位置传感器是防抖动的第一道防线。我见过太多项目，抖动问题根源就是位置反馈精度不够。
3.1.1 编码器 vs 光栅尺
| 类型 | 精度范围 | 适用场景 | 我踩过的坑 |
|---|---|---|---|
| 增量式编码器 | 1000~5000线/转 | 旋转关节、低成本方案 | 断电丢位置，每次上电要回零 |
| 绝对式编码器 | 17~23位 | 多轴协同、高可靠性 | 贵，但值得 |
| 光栅尺 | 0.1~1μm | 直线运动、晶圆对位 | 怕油污，安装要小心 |
选型原则：
- 旋转轴：优先用绝对式编码器。为什么？你想想看，晶圆传输过程中如果突然断电，增量式编码器不知道自己在哪，重新回零可能撞坏晶圆。我吃过这个亏。
- 直线轴：光栅尺是首选。精度0.5μm以下才能保证晶圆对位不抖。
- 分辨率：至少是系统定位精度的5~10倍。比如你要±1μm的定位精度，光栅尺分辨率至少0.1μm。
核心指标： 编码器/光栅尺的更新速率必须高于控制环路的采样率。我一般要求传感器更新速率是控制频率的2倍以上。
3.1.2 布局策略
布局这事，说白了就是「传感器离执行器越近越好」。我在项目中遇到过，有人把编码器装在电机尾部，结果联轴器有间隙，反馈回来的位置和实际位置差了0.2mm。这0.2mm在晶圆传输里就是灾难。
- 直接驱动方案： 编码器装在电机轴上，光栅尺装在运动平台上。直接测量负载位置，不要经过传动机构。
- 间接驱动方案： 如果必须经过丝杠或皮带，在负载端再加一个位置传感器做补偿。这叫「双反馈」，我常用的手法。
- 安装注意事项： 光栅尺的读数头要远离振动源。我曾经把读数头装在电机旁边，结果读数一直跳，查了三天才发现是电机磁场干扰。
3.2 加速度计选型与布局
加速度计是防抖动的「侦察兵」。位置传感器告诉你「已经抖了」，加速度计告诉你「马上要抖」。
3.2.1 选型原则
| 参数 | 推荐值 | 为什么 |
|---|---|---|
| 量程 | ±2g ~ ±16g | 晶圆传输加速度一般不超过1g，留余量 |
| 带宽 | ≥200Hz | 抖动频率通常在50~150Hz，带宽要够 |
| 噪声密度 | ＜100μg/√Hz | 噪声太大，小抖动检测不出来 |
| 输出接口 | SPI或I2C | 模拟输出容易受干扰 |
我的经验： 选MEMS加速度计就行，别迷信压电式的。MEMS便宜、体积小、功耗低，精度足够。我最近几个项目全用的MEMS，效果很好。
3.2.2 布局策略
加速度计的布局，核心就一句话：放在振动源和晶圆之间。
- 机械臂末端： 靠近晶圆抓取位置。这里测到的加速度最直接反映晶圆受到的振动。
- 基座/平台： 如果系统有主动减振，在基座上也放一个，用来做前馈控制。
- 方向对齐： 加速度计的敏感轴要和运动方向一致。我见过有人装反了，测了半天数据全是错的。
注意： 加速度计不要装在电机或减速器上。那里的振动是高频的，和晶圆端的低频抖动不是一回事。我曾经犯过这个错，数据完全没法用。
3.3 力传感器选型与布局
力传感器，说白了就是「手感」。晶圆很脆，夹太紧会碎，夹太松会滑。力传感器就是告诉你「这个力度刚刚好」。
3.3.1 选型原则
| 参数 | 推荐值 | 说明 |
|---|---|---|
| 量程 | 0~5N 或 0~10N | 晶圆夹持力一般0.5~2N，留余量 |
| 精度 | ±0.01N | 0.01N的误差就能感觉到晶圆是否夹稳 |
| 响应时间 | ＜5ms | 力控环路需要快速响应 |
| 温度漂移 | ＜0.1%/℃ | 晶圆传输环境温度变化不大，但也要注意 |
3.3.2 布局策略
力传感器的布局，我建议放在夹爪和执行器之间。这样测到的力最直接，不受机械结构变形的影响。
- 单点力传感器： 适合简单的夹爪，一个传感器就够了。
- 六维力传感器： 如果晶圆姿态要求高，用六维的。能同时测三个方向的力和三个方向的力矩。
- 安装刚度： 传感器和夹爪之间要刚性连接。柔性连接会引入额外振动，力控就没法做了。
避坑指南： 我曾经把力传感器直接装在电机轴上，结果电机发热导致传感器温漂，力控数据一直飘。后来加了隔热垫才解决。记住，力传感器怕热。
3.4 传感器布局总图
下面这张图是我常用的传感器布局方案。你可以看到，位置传感器、加速度计、力传感器各司其职，形成一个完整的感知网络。
3.5 传感器融合思路
单个传感器都有局限。位置传感器有延迟，加速度计有漂移，力传感器有温漂。所以，我习惯做传感器融合。
- 位置+加速度： 用加速度计做前馈补偿，弥补位置传感器的延迟。说白了就是「提前预判」。
- 位置+力： 力控模式下，位置环做粗调，力环做精调。晶圆夹持时，先快速移动到目标位置，再用力传感器微调夹持力。
- 三传感器融合： 用卡尔曼滤波把位置、加速度、力数据融合在一起。我最近一个项目就是这么做的，抖动幅度降低了60%。
一个小技巧： 加速度计的数据要加低通滤波，位置传感器的数据要加高通滤波。这样融合出来的信号既平滑又实时。滤波器截止频率我一般设在50Hz左右。
好了，传感器选型与布局就讲到这里。记住，传感器是系统的「感知层」，选对了、放对了，防抖动就成功了一半。下一章我们聊聊控制算法，到时候会用到今天讲的这些传感器数据。