4、数据采集与传感器：运动系统常用传感器类型、数据采集协议与同步技术
大家好，我是老张。今天咱们聊聊运动系统里最接地气、也最容易踩坑的部分——数据采集与传感器。
说实话，我见过太多项目，算法模型建得漂漂亮亮，结果一上现场，数据采回来全是噪声。为什么？传感器选型不对，协议没配好，同步没做。嗯，今天咱们就把这些坑一个个填上。
4.1 运动系统常用传感器类型
传感器是数字孪生的「眼睛」和「耳朵」。没有它们，你的模型就是瞎子和聋子。我个人习惯把运动系统的传感器分成三大类：
4.1.1 位置与位移传感器
- 编码器：增量式和绝对式。增量式便宜，但断电丢位置；绝对式贵，但一上电就知道自己在哪。我有个项目，客户非要省几百块用增量式，结果每次断电重启都要回零，调试时差点没把我逼疯。
- 光栅尺：精度高，纳米级。适合直线电机、精密平台。但要注意，光栅尺怕油污，车间环境不好时，我建议加个气帘保护。
- 磁栅尺：抗污染能力强，精度比光栅低一点。适合做长行程、环境恶劣的场合。
4.1.2 力与力矩传感器
- 六维力传感器：能测三个方向的力和三个方向的力矩。机器人打磨、装配必用。价格嘛，一台顶一台伺服驱动器。
- 扭矩传感器：装在电机输出轴或关节处。我调试协作机器人时，发现扭矩传感器零点漂移是个大问题，后来加了温度补偿才搞定。
4.1.3 速度与加速度传感器
- 加速度计：MEMS的便宜，压电的精度高。做振动监测时，采样率至少要设到2kHz以上，否则高频振动你根本看不到。
- 陀螺仪：配合加速度计做IMU，用在移动机器人、AGV上。注意，陀螺仪有温漂，长时间运行需要融合算法。
4.2 数据采集协议
传感器选好了，怎么把数据拿回来？这就涉及到协议了。运动系统里，Modbus、CANopen、EtherCAT是三个绕不开的名字。我一个个说。
4.2.1 Modbus
Modbus是老大哥，简单、可靠、便宜。RS485物理层，一主多从，最多247个节点。但速度慢，典型波特率115200bps，一个周期轮询下来，几十毫秒就过去了。
适合场景：温度、压力、液位等慢变信号。做状态监测可以，做实时控制？别想了。
// Modbus RTU 读取保持寄存器示例（C语言伪代码）
uint16_t read_holding_register(uint8_t slave_id, uint16_t reg_addr) {
uint8_t tx_buf[8] = {0};
uint8_t rx_buf[8] = {0};
tx_buf[0] = slave_id; // 从站地址
tx_buf[1] = 0x03; // 功能码：读保持寄存器
tx_buf[2] = (reg_addr >> 8) & 0xFF; // 寄存器高字节
tx_buf[3] = reg_addr & 0xFF; // 寄存器低字节
tx_buf[4] = 0x00; // 读取数量高字节
tx_buf[5] = 0x01; // 读取数量低字节（读1个）
// 计算CRC16
uint16_t crc = calc_crc16(tx_buf, 6);
tx_buf[6] = crc & 0xFF;
tx_buf[7] = (crc >> 8) & 0xFF;
// 发送并接收
uart_send(tx_buf, 8);
uart_receive(rx_buf, 8);
return (rx_buf[3] << 8) | rx_buf[4];
}4.2.2 CANopen
CANopen在运动控制里用得很多。为什么？因为它有PDO（过程数据对象）和SDO（服务数据对象）两种通信机制。PDO是广播式的，速度快，适合实时数据；SDO是一问一答，适合配置参数。
避坑指南：我曾经在一个多轴同步项目里，用CANopen的PDO传位置指令。结果发现总线负载一高，PDO会丢帧。后来把PDO的传输类型从「异步」改成「同步」，配合SYNC报文，问题解决了。嗯，细节决定成败。
// CANopen PDO 映射示例（EDS文件片段）
[0x1600]
SubIndex 001 = 0x60400010 // 控制字，16位
SubIndex 002 = 0x607A0020 // 目标位置，32位
SubIndex 003 = 0x60FF0020 // 目标速度，32位
// 发送PDO（伪代码）
void send_pdo(uint16_t control_word, int32_t target_pos, int32_t target_vel) {
uint8_t pdo_data[8] = {0};
memcpy(pdo_data, &control_word, 2);
memcpy(pdo_data + 2, &target_pos, 4);
memcpy(pdo_data + 6, &target_vel, 2); // 只传低16位
can_send(0x200 + node_id, pdo_data, 8);
}4.2.3 EtherCAT
EtherCAT是目前运动控制领域的天花板。它用「飞读飞写」技术，数据帧经过每个从站时，只花纳秒级时间读写数据，然后继续往下传。100个轴，1kHz的刷新率，抖动小于1微秒。你想想看，这什么概念？
我的经验：EtherCAT的从站配置很关键。ESC（EtherCAT从站控制器）芯片选型、EEPROM配置、PDO映射，一步错步步错。我建议新手先用倍福的TwinCAT或者欧姆龙的Sysmac Studio做原型验证，别一上来就手写从站代码。
// EtherCAT 从站配置（XML片段）
<EtherCATInfo>
<Vendor>
<Id>0x00000002</Id>
<Name>MyCompany</Name>
</Vendor>
<Descriptions>
<Devices>
<Device PhysicsAddr="1000">
<Type ProductCode="0x12345678" RevisionNo="0x00010001"/>
<RxPdo Fixed="true" Sm="2">
<Index>0x1600</Index>
<Entry Index="0x6040" SubIndex="0" BitLen="16"/>
<Entry Index="0x607A" SubIndex="0" BitLen="32"/>
</RxPdo>
<TxPdo Fixed="true" Sm="3">
<Index>0x1A00</Index>
<Entry Index="0x6041" SubIndex="0" BitLen="16"/>
<Entry Index="0x6064" SubIndex="0" BitLen="32"/>
</TxPdo>
</Device>
</Devices>
</Descriptions>
</EtherCATInfo>4.3 同步技术
数据采回来了，但时间戳对不上，等于白采。同步技术，说白了就是让所有传感器用同一个「时钟」说话。
4.3.1 硬件同步
最可靠的方式。用一根同步线（比如差分信号）连接所有设备，主设备发一个脉冲，从设备收到后同时采样。抖动可以做到纳秒级。
我踩过的坑：有一次用硬件同步，线长了，信号反射导致误触发。后来加了终端电阻，波形才干净。记住，高速同步信号，布线要按传输线理论来。
4.3.2 软件同步
通过协议自带的同步机制。比如EtherCAT的分布式时钟（DC），所有从站自动同步到参考时钟，精度可达100纳秒以内。CANopen的SYNC报文也能做，但精度差一些，微秒级。
4.3.3 时间戳同步
每个数据包打上时间戳，上位机收到后按时间戳对齐。适合异构系统，比如视觉和运动控制分开的情况。但要注意，时间戳的精度取决于本地时钟的稳定性。我建议用IEEE 1588（PTP）协议做网络时钟同步。
4.4 知识体系总览
下面这张图，是我自己总结的。数据采集与传感器这块，核心就三个圈：传感器选型、协议选择、同步策略。三者缺一不可。
4.5 实战建议
最后，给各位几个实在的建议：
- 先定同步策略，再选传感器和协议。同步精度决定了整个系统的天花板。
- 传感器和控制器之间，加隔离。光电隔离或磁隔离都行。我有个项目没加隔离，电机一启动，编码器信号就跳变，查了整整两天。
- 数据采集的带宽要留余量。理论计算是1kHz，实际至少按2kHz设计。为什么？因为滤波、平均、异常处理都会吃掉带宽。
- 做数字孪生，数据质量比数据量重要。1000个噪声数据不如10个干净数据。先把传感器标定好，再把同步做好，最后才谈得上建模。
好了，这一章就到这里。数据采集是数字孪生的地基，地基不稳，上面盖的楼再漂亮也是危房。各位在实际项目中，多留个心眼，少走弯路。
公众号:蓝海资料掘金营，微信deep3321