📡 传感器专题:IMU / 力矩 / 触觉
关节要「知道自己转了多少、受了多大力、指尖摸到了什么」,靠的是一整套传感器。本页从本体感知(角度/力矩/姿态)讲到外部感知(触觉),再落到选型清单与集成避坑,读完能独立为关节模组拉出一张传感器 BOM。
IMU / 姿态解算
关节力矩传感器
触觉 / 灵巧手
编码器选型
传感器融合与同步
🎯 本页学习目标
1. 能画出人形机器人的
传感器全景图 :分清「本体感知」(角度/力矩/姿态)与「外部感知」(视觉/触觉),说出每类传感器的位置、作用与典型接口。
2. 能解释
MEMS 加速度计 / 陀螺仪 / 磁力计的原理 (质量块电容检测、科里奥利效应、地磁参考),并读懂
零偏、噪声密度、量程、温漂 四大指标及其对姿态漂移的影响。
3. 能对比
应变片 / 磁弹式 / 电容式 三种力矩传感器原理,说出惠斯通电桥、温补、仪表放大器 + Σ-Δ ADC 的信号调理链,以及
关节力矩传感器 vs 电流估计力矩 的取舍。
4. 能区分
压阻 / 电容 / 压电 / 光学(GelSight) 四类触觉传感器,并说出它们在灵巧手(Dex3-1、Shadow Hand、Optimus 等)中的角色与滑动检测思路。
5. 能按
量程 → 精度 → 带宽 → 成本 → 可靠性 的顺序,用决策树为关节模组选出一套传感器组合,并写出 1 段 I2C 读取与 1 段姿态融合伪代码。
建议用时: 约 45 分钟(含完成 7 道自测题)
1 传感器全景:人形机器人需要哪些感知
人形机器人的感知可以一刀切成两大类:本体感知(Proprioception) 回答「我自己现在是什么状态」,外部感知(Exteroception) 回答「外面的世界是什么样、我摸到了什么」。关节模组主要吃的是本体感知,而灵巧手和头部则是外部感知的重灾区。理解这张全景图,是后面每一节选型讨论的地基。
1.1 本体感知 vs 外部感知
类别 感知内容 典型传感器 典型安装位置 典型接口
本体感知
关节角度 / 转速
磁编码器(AMR/TMR)、光编码器、旋变
电机转子端 / 减速器输出端
SPI / ABI / I2C / 旋变信号
关节力矩 / 六维力
应变片式力矩传感器、六维力传感器
减速器输出法兰、踝关节、腕部
模拟桥 / SPI(Σ-Δ ADC 后)
躯干姿态 / 角速度 / 加速度
IMU(加速度计 + 陀螺仪 + 磁力计)
躯干质心、头部、脚掌
SPI / I2C
外部感知
视觉 / 深度
RGB 相机、深度相机、事件相机
头部、胸前
MIPI / USB / Ethernet
触觉 / 压力 / 滑觉
压阻 / 电容 / 压电 / 光学触觉阵列
指尖、指腹、脚掌
SPI / I2C / 模拟多路
听觉 / 距离 / 温度
麦克风阵列、ToF、热敏(NTC)
头部、壳体、功率器件旁
I2S / I2C / ADC
📐 一个有用的心智模型: 把每类传感器看成「被测量 → 物理换能 → 电信号 → 数字化 → 融合 」的一条链。选型时先问「我要测什么物理量、量程和带宽是多少」,再问「它输出什么接口、噪声和漂移能否接受」,最后问「它装在哪、怎么标定、怎么和别的传感器对齐时间」。整页内容都围绕这条链展开。
2 IMU 深入:加速度计、陀螺仪、磁力计与姿态解算
IMU(Inertial Measurement Unit,惯性测量单元)是「姿态感知」的基石,通常把三轴加速度计、三轴陀螺仪集成在一块芯片上,部分还内置三轴磁力计(那时称 9 轴)。它回答的问题是:躯干在空间中的朝向、角速度、加速度是多少 ——这是全身平衡、步态控制、摔倒检测、头部稳定的输入源头。
2.1 三大器件原理:都是 MEMS 微机械结构
① 加速度计(Accelerometer) :核心是一个挂在弹簧上的质量块(proof mass) ,两侧是梳齿电容极板。发生加速度时质量块相对极板位移,电容变化 → 电压变化 → 加速度 。它测的是比力(specific force) ,静止时输出的是重力分量(约 1 g 朝下),所以能反推「哪边是下」,用于俯仰/横滚的长期参考。MEMS 加速度计内部常做「质量块 + 电容检测 + 闭环力平衡」以提高线性度。
② 陀螺仪(Gyroscope) :靠科里奥利效应(Coriolis effect) 。芯片内有一块持续振动的质量块(驱动轴),当载体绕敏感轴旋转时,振动质量块受到垂直于「振动方向 × 旋转轴」的科里奥利力,激发次级振动,再用电容检测这个次级振动幅度,正比于角速度 。它测的是「转得多快」,积分后得到角度——高频准、长期漂。
③ 磁力计(Magnetometer) :测量地磁场 (通常用 AMR / 霍尔 / 磁通门原理)得到「哪边是北」,为航向角 yaw 提供长期绝对参考(陀螺仪无法从零恢复 yaw,只能靠磁力计或视觉给绝对方向)。缺点是极易受电机、铁磁结构、电流干扰,必须做软铁/硬铁校准 。
⚠ 一句话记住三者分工: 加速度计「长期准、高频抖」,陀螺仪「高频准、长期漂」,磁力计「给绝对航向、但怕磁干扰」。姿态解算的本质就是把它们的长处缝合起来——这正是第 2.4 节互补滤波 / Mahony / 卡尔曼要做的事。
2.2 IMU 关键指标:零偏、噪声密度、量程、温漂
指标 含义 典型单位 对系统的影响
零偏 / 零位(Bias) 零输入时的输出,不随时间积分会被放大 dps(陀螺)、mg(加计) 陀螺零偏直接造成角度随时间线性漂移
噪声密度(Noise Density) 单位带宽内的随机噪声 dps/√Hz、µg/√Hz 乘 √带宽 得 RMS 噪声;决定短时分辨率
量程(Range) 可测的最大输入 ±125~±2000 dps、±2~±24 g 量程太大会牺牲分辨率,太小会饱和削顶
温漂(温漂系数) 零偏/灵敏度随温度的变化 dps/°C、%/°C 关节发热导致零偏慢漂,需温度补偿
偏置不稳定性(Bias Instability) 艾伦方差曲线谷底,长期零偏的「最稳点」 dps、mg 决定长时间积分的姿态精度下限
📐 噪声密度 → RMS 噪声换算: RMS 噪声 ≈ 噪声密度 × √(带宽)。例如陀螺噪声密度 0.01 dps/√Hz 、带宽 100 Hz ,则 RMS 噪声 ≈ 0.01 × 10 = 0.1 dps 。带宽越窄,噪声越低但响应越慢——「带宽」和「噪声」是同一枚硬币的两面。
2.3 常用型号:从无人机 IMU 到机器人 IMU
型号 厂商 轴数 亮点(典型值,以手册为准) 常见接口 典型场景
BMI088 Bosch(博世) 6 轴 陀螺噪声密度约 0.014 dps/√Hz、量程 ±125~±2000 dps;加速度计噪声约 175 µg/√Hz、量程 ±3~±24 g,抗振好 SPI 无人机 / 机器人飞控与姿态
ICM-42688-P TDK InvenSense 6 轴 低噪声变体,陀螺噪声密度约 0.0018 dps/√Hz、加速度计噪声约 70 µg/√Hz(约) SPI / I2C 高精度姿态、机器人/可穿戴
MPU-6050 TDK InvenSense 6 轴 经典入门款,资料极多,精度一般 I2C 教学、原型验证
LSM6DSO ST(意法) 6 轴 低功耗 + 内嵌机器学习核(MLC),陀螺噪声约 0.004 dps/√Hz(约) SPI / I2C 低功耗、端侧事件检测
⚠ 选型提醒: 以上指标为典型值或约值 ,量产务必以官方数据手册为准。人形机器人对抗振性、零偏稳定性、量程(奔跑/跳跃时角速度可达数百 dps) 要求高,推荐优先看 BMI088、ICM-42688-P 这类面向高动态应用的低噪声型号,而不是只看价格最低的消费级型号。
2.4 安装位置与减振:IMU 的「位置学」
装在躯干质心附近 :躯干是全身姿态的代表点,装得越靠近质心,线加速度耦合越小,姿态解算越干净。头部、脚掌也可各放一颗做「头部稳定」与「触地/步态检测」。
减振是硬需求 :电机振动、关节冲击会以高频噪声形式灌进加速度计。常用硅胶垫、泡棉、弹性柱 做隔振,并把 IMU 的固有频率与结构共振错开;减振过度反而会引入低频摆动,需实测权衡。
远离磁源与电流 :磁力计要避开电机永磁体、铁磁外壳和大电流走线;实在躲不开就做软铁/硬铁校准 并接受 yaw 在电机工作时不可靠,必要时用视觉/编码器融合补 yaw。
标定就地做 :IMU 焊上 PCB 后零偏会变化,量产要做六面法标定 (见下),把零偏和比例因子写回固件。
2.5 数据融合与姿态解算:互补滤波 / Mahony / 卡尔曼
/* ── 互补滤波(最简单):高通陀螺 + 低通加速度计 ── */
// 陀螺积分提供高频动态;加速度计提供低频重力参考(俯仰/横滚)
alpha = dt / (RC + dt); // RC 为互补时间常数,约 0.5~2 s
pitch = alpha * (pitch + gy * dt) + (1 - alpha) * pitch_accel;
roll = alpha * (roll + gx * dt) + (1 - alpha) * roll_accel;
// yaw 无法由重力恢复,需另接磁力计/视觉参考,否则长期漂移
/* ── Mahony 滤波(四元数 + PI 反馈,非线性互补) ── */
// 1) 用当前姿态估计重力方向 v_est,与加速度计测量 v_meas 做叉乘得误差 e
// 2) 积分误差修正陀螺偏置: bias += Ki * e * dt
// 3) 修正角速度: omega = gyro + Kp * e + bias
// 4) 四元数更新: q += 0.5 * q ⊗ omega * dt,再归一化
// Kp/Ki 决定收敛速度与抗噪;磁力计参与时额外修正 yaw 误差
/* ── 扩展卡尔曼(EKF):最优估计 ── */
// 状态 x = [q0 q1 q2 q3 | bias_gx bias_gy bias_gz]
// 预测:由陀螺积分推进四元数(含噪声协方差 Q)
// 更新:用加速度计(重力方向)+ 磁力计(北向)观测修正(量测协方差 R)
💡 选型建议: 初学者/资源紧张用互补滤波或 Mahony (计算量小、易调);对精度和鲁棒性要求高、且有磁干扰与多 IMU 融合需求的,用EKF 。无论哪种,陀螺零偏估计都必须在滤波器中一并估计,否则角度会持续漂移。
2.6 IMU 校准:六面法 + 艾伦方差
六面法(加速度计/磁力计标定) :把 IMU 分别沿 ±X、±Y、±Z 六个方向静止摆放,采集多组数据,拟合出加速度计的零偏(offset) 与比例因子(scale) ;磁力计同理,再加硬铁(球心偏移)/软铁(椭球畸变) 校准。
艾伦方差(Allan Variance) :把长时间静止数据按不同平均时间 τ 分组求方差,画出艾伦方差曲线。曲线不同斜率段分别对应角度随机游走(ARW,τ 负斜率段) 、偏置不稳定性(谷底) 、速率随机游走(τ 正斜率段) ——谷底值就是「这颗 IMU 长期零偏到底能稳到什么程度」的天花板。
陀螺零偏标定 :静止采集一段时间求均值即可得到当前零偏;更精细的要标温漂(在温箱里扫温度记录零偏变化,做一阶补偿)。
3 力矩传感器:从应变片电桥到关节力控
「力控」是人形机器人安全交互、柔顺落地、精细操作的前提——而力控最直接的输入就是关节力矩传感器 。它不像编码器测「转了多少」,而是测「输出端真正传递了多大力/力矩」。这一节讲原理、信号链、标定,以及它和「电流估计力矩」的经典对决。
3.1 三种原理:应变片 / 磁弹式 / 电容式
原理 物理机制 精度 带宽 成本/体积 典型应用
应变片(惠斯通电桥) 弹性体受力变形 → 贴片电阻变化 → 全桥/半桥失衡输出电压 高 高(受弹性体谐振限制) 中 / 需弹性体 关节力矩、六维力传感器(主流)
磁弹式(逆磁致伸缩) 轴受力后磁导率变化(Villari 效应)→ 线圈测磁通变化 中 高 中 / 非接触、耐脏 传动轴/驱动轴非接触扭矩
电容式 受力位移 → 极板间距/面积变化 → 电容变化 中高 中 较低 / 结构简单 小型压力/力测量
📐 惠斯通电桥为什么是「全桥」: 单个应变片电阻变化极其微弱(微应变级),且受温度影响大。工程上用四片应变片组成全桥(Wheatstone bridge) ,两片受拉、两片受压,不仅把信号放大到 mV 级,还能抵消温度引起的共模变化 ——这是力矩传感器信噪比和温漂表现的关键。
3.2 应变片粘贴与温度补偿
粘贴是手艺活 :应变片要贴在弹性体应变最大、应力均匀 的位置(通常由有限元仿真确定),粘贴层要薄而均匀,气泡、胶层过厚都会引入非线性与漂移。贴完要固化、老化、再标定 。
温补三板斧 :① 用自温度补偿应变片 (匹配弹性体热膨胀系数);② 用全桥/半桥 让温度共模变化相互抵消;③ 外接零漂/温漂补偿网络 或固件里做温度查表补偿。
过载保护 :弹性体要设计过载止挡 ,防止超量程冲击把贴片撕坏或弹性体屈服。
3.3 信号调理:仪表放大器 + Σ-Δ ADC
/* ── 力矩传感器信号链(典型) ── */
应变片全桥(1~2 mV/V 量级)
→ 仪表放大器(INA118 / AD8221 等):高共模抑制、低噪声、增益 100~1000×
→ 低通滤波(RC,滤除电机 PWM 与机械振动高频)
→ Σ-Δ ADC(ADS1232 / ADS1262 等):24 bit,高分辨率、内置 PGA 与滤波
→ MCU(SPI 读取)→ 标定矩阵 → 力/力矩输出
选择 仪表放大器(instrumentation amplifier) 而不是普通运放,是因为它共模抑制比(CMRR)高、输入阻抗大、增益稳定 ,正好匹配电桥的差分小信号。Σ-Δ ADC 则用「过采样 + 噪声整形」换取 24 bit 级分辨率,代价是输出速率较低 (几十到几千 SPS),所以力矩环带宽通常被 ADC 输出速率限制。
3.4 标定:加载台 + 串扰补偿
加载台标定 :用标定机/砝码在多轴方向施加已知力与力矩 ,记录传感器各通道输出,拟合出灵敏度矩阵 。六维力传感器要做 6 个自由度(x/y/z 力、x/y/z 力矩)的加载与解耦。
串扰补偿(解耦矩阵) :传感器某一轴受力时,其他轴往往也有微弱输出(串扰)。标定出一个 6×6 解耦矩阵 ,把原始电压乘矩阵得到真实六维力:F_real = C × (V_measured − V_zero)。这是六维力传感器「准不准」的核心。
零点与温漂标定 :记录不同温度下的零漂,写入补偿表。
3.5 关节力矩传感器 vs 电流估计力矩:一场经典取舍
对比维度 电流估计力矩(τ ≈ Kt × Iq) 关节力矩传感器
原理 由相电流 × 转矩常数推算,不额外加硬件 直接测输出端应变/变形
成本/体积 几乎为零(已有电流采样) 高(传感器 + 弹性体 + 调理 + 标定)
精度 受摩擦、减速比、齿隙、温度影响,误差大 直接反映输出端真实力矩,精度高
带宽 高(电流环很快) 受 ADC 输出速率/弹性体谐振限制
测量位置 电机端(不含减速器损耗) 输出端(含全部传动链,更真实)
典型应用 低成本关节、QDD 直驱(减速比小) 踝/髋关节力控、腕部六维力、精细操作
⚠ 关键结论: 减速比越大、摩擦和齿隙越大,电流估计力矩就越不可信(比如谐波减速器大减速比 + 大摩擦时,电流算出的力矩与输出端真实值差距巨大)。MIT Mini Cheetah 之所以能用电流估计力矩,正是因为它是准直驱(QDD)、减速比极小(约 6:1),摩擦小、反驱好 ;而需要高精度力控的踝/髋关节、腕部,通常会加关节力矩传感器或六维力传感器。这是「结构决定传感器方案」的典型例子。
3.6 人形机器人应用与代表产品
应用位置 :踝关节(落地缓冲、ZMP 力控)、髋关节(支撑与摆动相控制)、腕部六维力(装配、拖动示教)、手指力控(抓取力闭环)。
代表产品(据公开资料,具体参数多未公布) :坤维(KUNWEI) 主攻人形机器人六维力传感器 ,已完成 B+/B++ 轮融资;鑫精诚(深圳市鑫精诚传感) 提供六维力传感器与力控系统方案,获深圳国资领投;宇树(Unitree) 自研关节力控(机械臂/灵巧手),但具体传感器参数官方未公布 。选型时以各家官方规格书为准。
4 触觉传感器:让指尖「摸得到」
触觉是灵巧手从「能抓」到「抓得巧」的分水岭:抓鸡蛋要控制压力、捏起一张纸要检测滑动、旋螺丝要感知接触位置与法向力。触觉传感器按原理分四类,各有擅长。
4.1 四类触觉原理:压阻 / 电容 / 压电 / 光学
类型 原理 静态力 动态/滑动 阵列化 代表
压阻式 压力 → 电阻变化(FSR / 压阻弹性体) ✔ 好 一般 易 FSR 力敏电阻、压阻阵列
电容式 压力 → 极板间距变化 → 电容变化 ✔ 好 一般 易 电容阵列(高密度、低功耗)
压电式 形变 → 压电材料(PVDF)产生电荷 ✘(只测变化) ✔ 极好(高频) 中 PVDF 薄膜、滑觉检测
光学式(视触觉) 相机拍弹性体形变 + 反光涂层,重建三维接触 ✔ 好 ✔ 好 高(像素级) GelSight / GelSlim / DIGIT
💡 GelSight 视触觉原理(约): 一块软弹性体(凝胶)表面涂反光涂层,内部相机从下方拍摄。物体压上去时弹性体表面凹陷,相机拍到高分辨率形变图像,通过光度立体/几何重建得到接触面的三维形状、法向力、纹理甚至切向滑动 ——分辨率可达亚毫米级(相当于一个「会拍照的指尖」)。MIT 于 2009 年前后提出 GelSight,GelSlim、DIGIT 是其后续/开源变体。
4.2 阵列化与动态触觉(滑动检测)
阵列化 :把触觉单元排成矩阵(如指尖 16×16 等规模,视产品而异),每个单元独立测压力,得到「压力热力图」,用于定位接触点、判断抓取是否居中、检测边缘/纹理。
动态触觉 / 滑动检测 :物体要滑走时,接触面产生高频微振动 。压电式天然擅长(只响应变化、带宽高);压阻/电容式则靠对压力信号求导、检测高频分量 。检测到滑动就瞬时加大抓力 ——这是防滑抓取的标准动作。
与抓取控制闭环 :触觉数据 → 力/位置/滑动估计 → 实时调整手指力与位姿 → 稳定抓取。触觉采样率通常要 数百 Hz 以上 才能跟上滑觉检测。
4.3 灵巧手上的应用(据公开资料,参数多标「约/官方未公布」)
宇树 Dex3-1 :宇树(Unitree)推出的三指力控灵巧手 ,主打「力控 + 触觉」操作;其同门产品线 Dex5 宣传「单手 20 自由度、94 个灵敏触点」(约,以官方发布为准)。Dex3-1 的具体触觉单元数量与指标官方未系统公布 。
Shadow Hand(Shadow Dexterous Hand) :英国 Shadow Robot 的经典仿人多指灵巧手,指尖可选配 BioTac 触觉传感器 (基于流体 + 电极测量压力/振动/温度),是触觉研究的标杆平台。
特斯拉 Optimus :马斯克公开了 Optimus 灵巧手相关专利(媒体称「上帝之手」专利),涉及指尖触觉传感 方向;但官方未公布具体触觉传感器型号与参数 ,以官方发布为准。
5 编码器补充:磁编码器 vs 光编码器与关节集成要点
编码器是关节里「使用频率最高、却最容易在集成时翻车」的传感器——转子和定子差 0.1 mm 气隙或一点偏心,角度就可能跳变、产生速度毛刺,进而毁掉整个 FOC 闭环。这一节补上磁/光编码器的选型与集成要点(与 避坑指南 的编码器接口部分互补)。
5.1 磁编码器(AMR/TMR)vs 光编码器
维度 磁编码器(AMR/TMR) 光编码器
原理 磁铁旋转 → 磁阻元件(AMR/TMR)感测磁场角度 LED/激光 + 码盘 + 光电检测
绝对式单圈 天然支持(直接测磁场角度) 需绝对码道(成本更高)
分辨率 TMR 可达 12~15 bit(AS5047P 14 bit、TLE5012B 15 bit) 增量可达很高(线数 × 倍频),绝对值也高
抗污/抗油 ✔ 好(非接触、不怕油污) ✘ 差(怕灰尘/油污遮光)
体积/成本 小、便宜,关节主流 较大、较贵
温度/磁场干扰 受强外磁场、温漂影响 基本不受磁干扰
💡 AMR vs TMR: 都是磁阻效应,AMR(各向异性磁阻) 灵敏度较低、常用于低成本; TMR(隧穿磁阻) 灵敏度高、温度稳定性更好、可做更高分辨率,是当前高精度关节磁编码器的主流(如 TLE5012B、MT6701 等)。
5.2 绝对式单圈与多圈方案
绝对式单圈 :上电即知当前角度(0~360°),无需回零。关节模组强烈建议选绝对式,省去每次上电找零的麻烦。
多圈方案 :① 电池保持计数 (断电后靠电池继续计数,最常用);② 齿轮减速 + 磁编码器 (机械多圈,纯机械、无电池);③ 游标/双编码器 (两个不同极对数组合解算多圈);④ 软件记录 + 绝对单圈(配合断电不动的关节)。人形关节通常单圈绝对式 + 上电回零/限位 即可满足,多圈需求看应用。
5.3 编码器在关节里的集成要点(偏心、气隙)
气隙(Air Gap) :磁编码器要求磁铁与芯片保持手册规定的气隙(常见 0.5~2 mm 量级)。气隙过大信号弱、噪声大;过小可能撞磁/非线性。安装公差要按手册留。
偏心(Eccentricity) :磁铁轴心、芯片中心、旋转轴三者必须尽量同心 。偏心会引入角度误差的一次谐波 ,表现为速度周期性波动。高精度场合要做偏心标定/谐波补偿 。
磁铁与芯片对准 :径向磁化磁铁要让磁场穿过芯片敏感方向;芯片下方避免铁磁体/大电流走线干扰。
信号完整性 :SPI 走线短、串阻尼电阻、远离三相线与 PWM 节点(避坑指南已详述)。
6 传感器融合与同步:时间、外参、总线与噪声
单颗传感器再准,也只是「孤证」。真正的问题在于:力矩、角度、IMU、触觉、视觉这些数据必须在同一个时间基准上对齐 ,否则融合算法拿到的是「不同时刻的切片」,会引入致命误差。
6.1 多传感器时间同步
时间戳(Time-stamping) :每个传感器采样打上统一时钟的时间戳(如 MCU 定时器计数 / PTP 时间),融合时按时间戳插值对齐。
同步触发 :用一根硬件同步线(或 PPS 脉冲)让多传感器同时采样 ,避免逐传感器轮询造成的相位差。
网络时钟同步 :分布式(EtherCAT/CAN/以太网)系统用 PTP/gPTP 把各节点时钟同步到亚微秒级,视觉与关节数据才能对齐。
6.2 外参标定
手眼标定(Hand-Eye) :标定相机与机械臂末端/关节之间的刚体变换(旋转 + 平移),用 AX = XB 或 Tsai 等方法。
IMU-相机外参 :标定 IMU 与相机的时间偏置与空间位姿,是视觉惯性里程计(VIO)的前提。
关节零位/力矩零点 :编码器零位与力矩传感器零点要在整机装配后重新标定。
6.3 CAN / SPI / I2C 总线布局
总线 特点 典型用途 布局要点
CAN / CAN-FD 差分、抗干扰强、多主、带仲裁 关节间、整机骨干通信 两端 120 Ω 终端电阻,双绞/屏蔽,分支要短
SPI 高速、点对点为主 磁编码器、IMU、Σ-Δ ADC 走线短、等长、串阻尼电阻、远离功率区
I2C 两线、多从机、速度低 低速率传感器(温湿度、低端编码器) 上拉电阻匹配、注意总线电容与地址冲突
6.4 供电与噪声:ADC 参考与滤波
ADC 参考要干净 :力矩/触觉这类微弱模拟信号,ADC 的参考电压(Vref) 必须低噪声、低漂移,并与数字电源隔离(磁珠/独立 LDO);否则 ADC 读数随负载抖动。
差分 + 屏蔽 :小信号用差分走线、包地,远离 PWM/开关节点;必要时用屏蔽线。
滤波分层 :模拟端 RC 低通滤高频,数字端再做平均/陷波(如陷掉 PWM 频率及其谐波);滤波器截止频率要与控制环带宽匹配,避免把有用信号也滤掉。
I2C 读取示例(读磁编码器原始角度) :
/* ── I2C 读取 AS5600 磁编码器原始角度(12 bit,地址 0x36) ── */
// 寄存器 0x0C(高字节)/ 0x0D(低字节)存 RAW ANGLE
uint8_t reg = 0x0C;
uint8_t buf[2] = {0};
// 1) 写寄存器指针
Wire.beginTransmission(0x36);
Wire.write(reg);
Wire.endTransmission(false); // 不产生 STOP,继续读
// 2) 读 2 字节
Wire.requestFrom(0x36, (uint8_t)2);
buf[0] = Wire.read();
buf[1] = Wire.read();
uint16_t raw = (buf[0] << 8) | buf[1]; // 0~4095
float angle_deg = raw * 360.0f / 4096.0f; // 换算成角度
7 选型指南:如何为关节模组选传感器
选型的坑不在「不知道该选什么」,而在「跳过量程和带宽,直接看价格和精度 」。下面这套决策树按「量程 → 精度 → 带宽 → 成本 → 可靠性」的顺序,给出一张可执行的清单。
① 量程够不够? 关节角度 0~360°(绝对式);力矩按峰值负载 × 1.5~2 留余量;IMU 角速度要覆盖奔跑/跳跃(数百 dps);触觉压力覆盖轻触~硬捏。
→
② 精度/分辨率? 角度 12 bit(0.088°)以上,高精度力控上 14 bit;力矩看力控环需求;姿态看零偏与噪声密度。
→
③ 带宽? 电流/姿态采样 kHz 级;力矩环受 ADC 输出速率限制(几十~几百 Hz);触觉滑觉需数百 Hz 以上。
④ 成本/体积? 磁编码器 < 光编码器;电流估计力矩「免费」但精度低;力矩传感器贵但换力控精度。
→
⑤ 可靠性/环境? 抗振、抗油污(选磁)、温度漂移、电磁干扰、寿命;标定与装配公差要可量产。
→
⑥ 集成与同步? 接口(CAN/SPI/I2C)、时间同步、外参标定、供电与 ADC 参考——都对齐才算选完。
7.1 关节模组传感器选型清单(示例)
需求 推荐方案 关键参数(约) 接口
转子角度(绝对式单圈) 磁编码器 TMR(AS5047P / MT6701 / TLE5012B) 12~15 bit,气隙 0.5~2 mm SPI / ABI / I2C
躯干姿态 BMI088 / ICM-42688-P 六轴 IMU 陀螺噪声 ≤0.01 dps/√Hz、量程 ±2000 dps SPI
关节力矩(力控) 应变片关节力矩传感器 / 六维力传感器 量程按峰值 ×1.5~2,24 bit Σ-Δ ADC 模拟桥 → SPI
低成本力矩(可接受误差) 电流估计力矩(QDD / 小减速比) 依赖 Kt 与摩擦模型标定 已有电流采样
指尖触觉 压阻/电容阵列 或 GelSight 视触觉 阵列 16×16(约)、采样 ≥数百 Hz SPI / I2C
滑觉检测 压电(PVDF)或视触觉动态通道 高频响应、对变化敏感 模拟/数字
⚠ 常见翻车点: ① 选了增量式编码器又不想每次上电回零 → 换绝对式;② 大减速比却指望电流估计力矩做力控 → 加力矩传感器;③ IMU 直接硬装在电机旁不隔振 → 姿态噪声爆表;④ 力矩/触觉的 ADC 参考接在数字电源上 → 读数随 PWM 抖动;⑤ 多传感器时间戳没对齐 → 融合算法输出「错位」结果。
8 小结与思考
📌 本节小结: 人形机器人的感知分为本体感知(角度/力矩/姿态) 与外部感知(视觉/触觉) ,关节模组主要靠编码器 + 力矩传感器 + IMU。IMU 的加速度计(重力长期参考)、陀螺仪(科里奥利效应、高频准)与磁力计(绝对航向)各司其职,靠互补滤波/Mahony/卡尔曼 融合;选型看零偏、噪声密度、量程、温漂 ,校准靠六面法与艾伦方差。力矩传感器主流是应变片惠斯通电桥 ,经仪表放大器 + Σ-Δ ADC 调理、加载台标定 + 串扰解耦;它比电流估计力矩更准但更贵,减速比越大越值得上。触觉四类(压阻/电容/压电/光学 GelSight)各有分工,滑觉检测靠动态信号。最后,时间同步、外参标定、总线布局与干净供电 是把「一堆传感器」变成「一套感知系统」的最后一步。
🤔 思考题:
1. 一颗陀螺仪零偏 0.05 dps,只靠它积分 10 分钟,角度会漂多少度?为什么必须引入加速度计/磁力计参考?
2. 同一个关节,用「1:6 准直驱 + 电流估计力矩」和「1:100 谐波减速器 + 电流估计力矩」,哪个力控误差更大?为什么?
3. 为什么压电式触觉「测不出静态压力」却非常适合滑觉检测?如果要同时测静态压力和滑动,你会怎么组合传感器?
9 本节自测
1. 【陀螺仪原理】MEMS 陀螺仪测量角速度的核心物理效应是?
A. 压电效应
B. 科里奥利效应
C. 霍尔效应
D. 逆磁致伸缩效应
💡 解析:MEMS 陀螺仪内部质量块持续振动,载体旋转时振动质量块受到垂直于振动方向与旋转轴的科里奥利力,激发次级振动,其幅度正比于角速度。压电效应常用于压电触觉,霍尔效应用于磁力计/电流检测,逆磁致伸缩是磁弹式力矩传感器原理。
2. 【指标理解】陀螺仪「零偏」直接导致的后果是?
A. 角度随时间线性漂移
B. 只能测加速度不能测角速度
C. 量程变小
D. 采样率下降
💡 解析:零偏是零输入时的非零输出,对陀螺仪而言,把零偏当角速度积分,角度会随时间线性漂移。这正是姿态解算必须同时估计并补偿陀螺零偏的原因。
3. 【力矩传感器】应变片式力矩传感器为什么常采用「四片全桥(惠斯通电桥)」?
A. 为了把传感器做得更小
B. 为了测量角度
C. 放大差分信号并抵消温度共模变化
D. 为了直接输出数字信号
💡 解析:全桥用两片受拉、两片受压,既把微弱的电阻变化放大为 mV 级差分电压,又能抵消温度引起的共模变化,显著改善信噪比与温漂表现。
4. 【姿态融合】互补滤波中,加速度计与陀螺仪分别承担什么角色?
A. 都是低通滤波
B. 都是高通滤波
C. 加速度计高通、陀螺仪低通
D. 加速度计低通、陀螺仪高通
💡 解析:陀螺仪积分高频准但长期漂,取「高通」部分;加速度计长期准但高频抖,取「低通」部分。两者互补叠加,得到既跟得上动态又长期不漂的姿态。
5. 【触觉原理】GelSight 这类「视触觉传感器」的本质是?
A. 用电容阵列测压力
B. 用相机拍摄弹性体形变,重建三维接触
C. 用压电薄膜测振动
D. 用霍尔元件测磁场
💡 解析:视触觉 = 相机 + 软弹性体(表面反光涂层)。物体压上时弹性体形变,相机拍到高分辨率形变图像,重建接触面三维形状、法向力甚至纹理滑动,分辨率可达亚毫米级。
6. 【编码器】关于磁编码器 AMR 与 TMR,下列说法正确的是?
A. AMR 灵敏度高于 TMR
TMR 无法用于绝对式角度测量
TMR 灵敏度更高、温度稳定性更好,是高精度磁编码器主流
光编码器比磁编码器更抗油污
💡 解析:TMR(隧穿磁阻)比 AMR(各向异性磁阻)灵敏度高、温度稳定性好、可做更高分辨率,是高精度关节磁编码器主流(如 TLE5012B、MT6701)。磁编码器非接触、抗油污,而光编码器怕灰尘/油污遮光。
7. 【力控取舍】大减速比(如 1:100 谐波)关节若只用「电流估计力矩」做力控,主要问题是?
A. 摩擦/齿隙/减速比被忽略,误差大
B. 电流环带宽过高
C. 无法测量角度
D. 无法测量温度
💡 解析:电流估计力矩 τ ≈ Kt × Iq 只反映电机端电磁转矩,不含减速器的摩擦、齿隙与减速比,大减速比下输出端真实力矩与估计值差距巨大。需要高精度力控时应加关节力矩传感器或六维力传感器。
8. 【噪声换算】某陀螺仪噪声密度为 0.01 dps/√Hz,系统带宽取 100 Hz,其 RMS 噪声约为?
A. 0.001 dps
B. 0.1 dps
C. 1 dps
D. 10 dps
💡 解析:由 2.2 节公式 RMS 噪声 ≈ 噪声密度 × √带宽,代入 0.01 × √100 = 0.01 × 10 = 0.1 dps。带宽越窄噪声越低但响应越慢,「带宽」和「噪声」是同一枚硬币的两面。
9. 【触觉误区】关于压电式触觉传感器,下列说法正确的是?
A. 它能长期稳定测量静态压力
B. 它只在形变(变化)时产生电荷,测不出静态压力,但高频动态响应极好
C. 它靠相机拍摄弹性体形变来测压力
D. 它靠极板间距变化引起的电容变化来测压力
💡 解析:很多人以为「压力传感器」都能测静态压力,但压电式只响应变化——压电材料(PVDF)在形变时才产生电荷,对恒定压力无持续输出,所以测不了静态力;正因为带宽高、只对变化敏感,它反而天生适合检测滑动时的高频微振动(见 4.1、4.2 节)。
10. 【编码器误区】关于关节角度编码器的绝对式/增量式选择,下列说法正确的是?
A. 增量式编码器上电即可直接读到绝对角度,无需回零
B. 磁编码器天然支持绝对式单圈,上电即知 0~360° 角度,关节建议优先选绝对式
C. 绝对式编码器无法用于单圈 0~360° 测量
D. 多圈方案只能靠电池保持计数实现
💡 解析:增量式编码器上电不知道绝对位置、需要回零,而磁编码器直接测磁场角度、天然支持绝对式单圈(0~360°),关节强烈建议选绝对式省去每次上电找零(见 5.1、5.2 节)。多圈方案不止电池保持一种,还有齿轮减速+磁编码器、游标/双编码器、软件记录等。
📌 本节要点速查: ① 感知分本体感知 (角度/力矩/姿态)与外部感知 (视觉/触觉),关节模组主要靠「编码器 + 力矩传感器 + IMU」;② IMU 三件套分工:加速度计「长期准、高频抖」、陀螺仪「高频准、长期漂」、磁力计「给绝对航向、但怕磁干扰」,靠互补滤波/Mahony/卡尔曼缝合,选型看零偏/噪声密度/量程/温漂,RMS 噪声≈噪声密度×√带宽;③ 力矩传感器主流是应变片惠斯通全桥 ,信号链为「仪表放大器 + Σ-Δ ADC」,加载台标定 + 串扰解耦,减速比越大,电流估计力矩越不可信 ;④ 触觉四类:压阻/电容(静态好)、压电(只测变化、适合滑觉)、光学 GelSight(亚毫米重建),滑觉采样需数百 Hz 以上;⑤ 磁编码器 TMR 主流、抗油污、建议选绝对式;最后靠时间同步 + 外参标定 + 干净供电 把一堆传感器变成一套感知系统。
10 参考资料
本页关键事实经 web_search 核实;型号指标多为典型值/约值,量产以官方数据手册为准。资料整理更新至 2026-08 。