做桌面机械臂调试那会儿最让我头疼的不是机械结构而是 ESP32-IDF 下用 PCA9685 驱动舵机时的程序 bug。6 路舵机上电就开始乱抖角度输出和指令值差出去几十度偶尔还整个系统重启。这周把整个链路翻了个底朝天从 I2C 读写到 PWM 参数再到 FreeRTOS 任务调度最后发现问题的根源比想象中更隐蔽。先说结论不是舵机坏了也不是 PCA9685 模块坏了而是三个软件层面的问题叠在了一起分别对应寄存器写时序、通道初值和多任务并发访问。这篇笔记就把完整排查链路记下来给同样在 IDF 环境下用 PCA9685 调舵机的朋友做个参考。1. 为什么要上 PCA9685机械臂控制方案选型与硬件拓扑1.1 多路 PWM 的需求没有想象中简单桌面机械臂六个关节每个关节都是一个标准 PWM 舵机比如 SG90、MG996R 或者更常见的 DS3218。它们的控制原理很简单舵机内部有控制电路和电位器反馈外部给一个 20ms 周期的脉冲信号高电平持续时间决定舵机输出轴的角度0.5ms 对应 0 度1.5ms 对应 90 度2.5ms 对应 180 度。所以控制舵机本质就是精确控制脉宽。问题在于六路舵机需要六路独立 PWM而且每一路都要随时可以修改脉宽。用 ESP32 的 LEDC 硬件定时器确实能做最多 16 路通道听起来完全够用。但在实际项目里LEDC 通道要分配给电机驱动、RGB 灯效、蜂鸣器或者其他外设通道数和定时器资源很快就会打架。更麻烦的是如果哪一路 PWM 需要在后台高频更新又要保证机械臂多个关节同步动作时互不干扰代码会越写越绕。所以我在这个项目里选了 PCA9685。这是一个 16 通道、12 位分辨率的 I2C PWM 驱动芯片内部自带 25MHz 晶振所有 PWM 波形由芯片硬件产生。ESP32 只需要通过 I2C 总线告诉它“这一路输出多少脉宽”剩下的时序完全不用管。这样不仅释放了 ESP32 的硬件定时器资源还让 PWM 信号非常稳定不受 CPU 任务调度影响。当时选它还有一个很实际的考虑模块几块钱一片坏了直接换不用重新画板。1.2 硬件接线与供电拓扑我的实际接线是这样的ESP32 的 GPIO21 接 PCA9685 的 SDAGPIO22 接 SCLPCA9685 模块的逻辑电源 VCC 接 3.3VGND 和 ESP32 共地舵机电源单独接 5V 或 6V 稳压源接到模块的 V 端子模块的 OUT0 到 OUT5 分别接六个舵机的信号线这里最容易忽略的就是共地。 PCA9685 的 I2C 信号和舵机 PWM 输出必须有一个统一的参考地否则逻辑电平乱跳舵机会出现随机抖动、角度漂移甚至完全不动。我最初调试时用的是面包板地线飞线接触不良导致舵机总是无缘无故抽风后来重新压了一遍杜邦线才稳定下来。后面所有根因排查都是建立在“接线确认无误”这个前提下的这一点必须放在最前面。1.3 和总线舵机方案的差异有些做机械臂的同行会问为什么不用带反馈的总线舵机比如飞特 STS 系列走串口半双工协议直接 UART 就能控制还能读取角度、温度、电压确实更高级。但这类舵机成本高对协议栈和时序要求也更高。PCA9685 加普通 PWM 舵机仍然是最通用、最便宜、最容易被新人接受的方案。树莓派 Pico、STM32、Arduino 控制舵机的思路也是一样的寄存器操作逻辑完全互通只是 I2C 库接口不同。这篇笔记里讲的东西换一个平台同样能参考。2. Bug 现象记录乱抖、偏角和随机死机2.1 现象 A上电瞬间舵机猛转最初上电时有两路舵机会“咔”一声直接打到机械限位发出很响的撞击声然后才慢慢回到程序里设置的初始角度。这个现象非常吓人第一反应是舵机坏了或者舵机扫齿。把舵机拆开检查齿轮一切正常手动转动也很顺畅说明不是硬件损坏。我怀疑是 PCA9685 上电后输出状态不确定导致的PCA9685 的每个通道都有一组 ON/OFF 寄存器决定 PWM 什么时候开始、什么时候结束而这些寄存器在上电后的默认值并不一定等于“舵机安全角度”。如果此时舵机电源比 PCA9685 初始化更早就绪舵机就会按照寄存器里的随机脉宽先动一下。所以从软件角度必须保证 PCA9685 在舵机得电之前就完成初始化并且把所有输出通道设成一个安全的默认脉宽。后面代码实现里我会给出具体做法。2.2 现象 B角度指令偏差而且每个通道不一样正常初始化之后接着测试角度控制。给舵机发 90 度指令理论上应该停在正中位置但用角度尺实测只有 38 度、55 度、61 度三次结果还不一样。换一个通道偏差又变成另一个样子。发 180 度时有的舵机冲过头有的停在 160 度。这个现象最让人抓狂因为偏差没有规律。一开始我以为是机械装配问题把舵机臂拆下来重新装再校准零位结果没用。后来又怀疑是不是舵机电压不足换了一路独立电源问题依然存在。直到我意识到所有通道用的都是同一批舵机同一个程序如果只是个别舵机有偏差那还能用个体差异解释但现在每个通道的偏差都不一样这已经不是机械问题了一定是 PWM 信号本身不对。2.3 现象 C连续运行几分钟后偶发死机第三个现象更诡异。程序运行一两分钟后某个舵机会先轻微抖动然后系统日志开始刷报错最后整个 ESP32 被看门狗重启。日志里出现典型的两行E (37521) task_wdt: Task was killed! E (37521) abort() was called at PC 0x400d...每次死机时的调用栈还不一样有时在按键扫描任务里有时在舵机刷新任务里。一开始我怀疑是内存越界或者堆栈溢出把各任务堆栈加了很多问题依旧。后来才想到可能是多个任务同时在访问同一个 I2C 总线导致总线状态被搞乱了。这个怀疑在后面的排查中得到了验证。这三个现象看起来毫无关联最花时间的部分就在这里我总是想找一个“万能根因”一次性解释所有问题结果每个问题背后其实是不同的原因。3. 逐层排查链路从 I2C 通信到 PWM 参数的定位过程3.1 第一层I2C 扫描与寄存器回读排错第一步先确认 I2C 物理链路到底通不通。ESP32-IDF 5.x 里可以很方便地扫描总线上的设备#include driver/i2c_master.h i2c_master_bus_handle_t bus_handle; i2c_master_dev_handle_t pca9685_handle; // 创建 I2C 主机总线 i2c_master_bus_config_t bus_config { .clk_source I2C_CLK_SRC_DEFAULT, .i2c_port I2C_NUM_0, .scl_io_num 22, .sda_io_num 21, .glitch_ignore_cnt 7, .flags.enable_internal_pullup true, }; ESP_ERROR_CHECK(i2c_new_master_bus(bus_config, bus_handle)); // 扫描从机地址 for (uint8_t addr 0x08; addr 0x78; addr) { if (i2c_master_probe(bus_handle, addr, 100) ESP_OK) { ESP_LOGI(I2C_SCAN, Found device at 0x%02X, addr); } }模块默认地址是 0x40扫描结果自然能看到它。如果这一步就卡住那大多是接线、供电或者地址跳线的问题和程序逻辑关系不大先解决硬件再往下走。扫描通过后接着读几个关键寄存器。读 PCA9685 寄存器的方法是先发一个字节的寄存器地址再读取数据。关键看 MODE10x00、MODE20x01和 PRE_SCALE0xFE。读 MODE1 和 MODE2 是为了确认芯片是不是处于正常模式读 PRE_SCALE 是为了验证 PWM 频率设置有没有真正写进去。结果问题立刻暴露了程序里明明把 PRE_SCALE 写成 0x79也就是十进制的 121对应 50Hz但回读出来却是另一个值。I2C 通信正常可寄存器内容不对这就说明频率设置根本没生效或者生效的时机不对。3.2 第二层逻辑分析仪抓 PWM 波形寄存器回读只能说明“芯片认为自己在输出什么频率”真正判断舵机问题还得看“引脚上到底输出了什么波形”。我找了一台几十块钱的逻辑分析仪把通道接在 PCA9685 的 OUT0 上连续抓了几秒钟波形。抓到的结果有两个明显异常波形周期不是 20ms而是 16ms 到 18ms 之间跳动在程序里写同一个角度值每次抓到的脉宽都会跳这说明 PCA9685 实际上跑在一个错误的 PWM 频率上而不是舵机期望的 50Hz。舵机内部的信号处理电路对脉宽非常敏感周期不对时同样的高电平时间会被解释成完全不同的角度所以舵机才乱抖、乱转。这个发现基本把问题方向锁定到了 PCA9685 的寄存器配置上。3.3 第三层检查驱动代码里的寄存器写函数到了这一步我重新把初始化代码从头到尾读了一遍找到了第一个直接原因。我的频率设置代码原本是这样写的uint8_t prescale 121; uint8_t mode1 0x20; // 想开 AI 位 i2c_master_transmit(pca9685_handle, (uint8_t[]){0x00, mode1}, 2, 100); i2c_master_transmit(pca9685_handle, (uint8_t[]){0xFE, prescale}, 2, 100); i2c_master_transmit(pca9685_handle, (uint8_t[]){0x00, mode1 ~0x10}, 2, 100);问题很明显写入 PRE_SCALE 之前我根本没有让芯片进入 SLEEP 模式。PCA9685 的数据手册写得非常清楚修改 PRE_SCALE 之前必须先把 MODE1 寄存器的 bit4SLEEP置 1写入新的分频值后再清除 SLEEP 位并且等待至少 500us 让内部振荡器稳定。跳过这一步芯片可能会忽略新分频值或者在不稳定的状态下应用结果就是 PWM 频率完全不是想要的值。为什么 Arduino 那些库很少出这个问题因为 Adafruit 的 PWM Servo Driver Library 内部已经处理了这套时序先写 0x10 进入 SLEEP再写 PRE_SCALE再写 0x00 唤醒。直接用 IDF 重写时如果只看寄存器列表而不看时序要求很容易踩这个坑。3.4 第四层检查任务调度与 I2C 并发访问频率问题定位之后死机问题还需要单独查。打开崩溃日志里的调用栈发现每次出错都在 I2C 传输相关的函数附近而且不同任务的调用栈里都有 I2C 操作的影子。我再检查代码发现项目里有按键扫描任务里面为了读取一个 I2C 传感器直接用了 bus 句柄发起传输而舵机刷新任务也在用同一个 bus 句柄写 PCA9685。两个任务没有做任何互斥保护。IDF 的 i2c_master 驱动毕竟不是为无锁并发访问设计的两个任务同时发起传输时总线的内部状态会被踩乱轻则 NACK重则卡死等待最终触发任务看门狗。所以死机根本不是 ESP32 的锅也不是内存踩踏而是并发访问同一个 I2C 外设导致的状态错乱。4. 根因确认三个问题叠加4.1 根因一PRE_SCALE 写时序不符合数据手册要求PCA9685 的频率由 PRE_SCALE 寄存器决定计算公式是PRE_SCALE round(25MHz / (4096 × 需要的频率)) - 1我需要 50Hz 的舵机控制频率代入计算25MHz / (4096 × 50) 122.07 round(122.07) 122 PRE_SCALE 122 - 1 121 0x79但光算对还不够写入时序才是关键。正确流程是读 MODE1 当前值把 MODE1 的 bit4 置 1进入 SLEEP 模式写入 PRE_SCALE清除 MODE1 的 bit4唤醒芯片等待至少 500us 让振荡器稳定很多从 Arduino 转过来的开发者会忽略第二步因为 Arduino 库把封装做得太顺手了根本感知不到这层时序。但在裸寄存器操作时这一步省不得。当时我只写了一个看似合理的“频率配置函数”没有按这个顺序来PRE_SCALE 回读异常、PWM 周期漂移就全来了。4.2 根因二通道 ON/OFF 寄存器初始化不完整频率修对之后角度偏差还是存在只是幅度小了一些。继续查通道寄存器。PCA9685 每个通道有 4 个寄存器地址从 0x06 开始按通道递增通道ON 低字节ON 高字节OFF 低字节OFF 高字节CH00x060x070x080x09CH10x0A0x0B0x0C0x0DCH20x0E0x0F0x100x11...............ON 和 OFF 都是 12 位数据低 8 位放在 L 寄存器高 4 位放在 H 寄存器。比如我要让某个通道在 0 计数时打开、在 300 计数时关闭那么应该写入ON_L 0x00ON_H 0x00OFF_L 300 0xFF 0x2COFF_H (300 8) 0x0F 0x01问题出在我之前的通道初始化代码里。当时为了减少 I2C 传输次数只写了 OFF_H没有写 OFF_L。OFF_L 残留上电时的旧值每个通道残留的旧值不同所以每个通道的实际 OFF 计数都多了一截角度自然是又偏又不一致。这个 bug 非常隐蔽因为只看高字节好像是对的低字节的残留值不读回根本发现不了。后来我把四个字节全部显式写入偏差立刻消失了。4.3 根因三I2C 多任务并发访问没有加锁死机问题最终归因到并发访问。ESP32-IDF 的 i2c_master 驱动虽然提供了 bus handle 和 device handle但它并不会为调用者自动加锁。多个任务同时调用同一 bus 上的传输函数时可能出现不可预期的错误。尤其是两个任务一个在写传感器寄存器一个在写 PCA9685如果它们都使用同一个总线且没有锁底层很容易互相干扰。修复方式有两种一是给每次 I2C 事务加互斥锁二是把 I2C 操作集中到一个专门的任务里其他任务通过队列向它发请求。我选择的是前者因为改动最小也足够当前项目使用。5. 修复方案与关键代码按正确时序重新实现5.1 正确的频率设置函数重新实现的设置频率函数如下重点就是读改写、SLEEP 切换、唤醒等待void pca9685_set_freq(uint8_t freq_hz) { uint8_t reg 0x00; uint8_t mode1 0; // 读取 MODE1 i2c_master_transmit(pca9685_handle, reg, 1, 100); i2c_master_receive(pca9685_handle, mode1, 1, 100); // 进入 SLEEP uint8_t sleep_cmd[] {0x00, (uint8_t)(mode1 | 0x10)}; i2c_master_transmit(pca9685_handle, sleep_cmd, 2, 100); // 计算并写入 PRE_SCALE uint8_t prescale (uint8_t)((25000000.0 / (4096.0 * freq_hz)) 0.5) - 1; uint8_t ps_cmd[] {0xFE, prescale}; i2c_master_transmit(pca9685_handle, ps_cmd, 2, 100); // 退出 SLEEP uint8_t wake_cmd[] {0x00, (uint8_t)(mode1 ~0x10)}; i2c_master_transmit(pca9685_handle, wake_cmd, 2, 100); // 等待振荡器稳定 vTaskDelay(pdMS_TO_TICKS(10)); }这段代码里有几个细节读 MODE1 必须先生成读地址然后单独 receive不能省写入 PRE_SCALE 前要让芯片睡过去写完后要唤醒等待时间我给到 10ms比手册要求的 500us 更宽裕稳定性更好。5.2 通道初始化时写满四个字节通道写入函数必须把 ON_L、ON_H、OFF_L、OFF_H 全部写进去不能偷懒。以 50Hz 频率为例一个微秒对应 0.2048 个计数所以脉宽换算可以直接用下面这种方式void pca9685_set_pulse(uint8_t ch, uint16_t pulse_us) { // 50Hz 下20ms 周期对应 4096 计数 // pulse_us 换算成计数pulse_us / 20000 * 4096 uint16_t off (uint16_t)(((uint32_t)pulse_us * 4096UL) / 20000UL); uint8_t base 0x06 ch * 4; uint8_t buf[5] { base, 0x00, // ON_L 0x00, // ON_H off 0xFF, // OFF_L (off 8) 0x0F // OFF_H }; i2c_master_transmit(pca9685_handle, buf, 5, 100); }角度换算就简单了。舵机 0 度对应 500us180 度对应 2500us线性映射void pca9685_set_angle(uint8_t ch, float angle_deg) { if (angle_deg 0.0f) angle_deg 0.0f; if (angle_deg 180.0f) angle_deg 180.0f; float pulse_us 500.0f (angle_deg / 180.0f) * 2000.0f; pca9685_set_pulse(ch, (uint16_t)pulse_us); }这里加上角度限位非常关键。机械臂关节一般都有物理限位如果程序意外发了超范围角度舵机会一直顶在限位上轻则舵机发烫重则扫齿。限位看起来只是两行 if但能避免很多事故。初始化时我会先把所有通道设到 90 度对应的脉宽也就是 1500us。这样舵机上电后不会猛冲而是平稳停在中间位置之后再按业务逻辑慢慢动。5.3 给 I2C 事务加互斥锁针对死机问题用一个全局互斥锁保护所有 I2C 操作。创建锁和封装写入函数static SemaphoreHandle_t i2c_mutex; void pca9685_init_lock(void) { i2c_mutex xSemaphoreCreateMutex(); } void pca9685_write_regs(uint8_t reg, uint8_t *data, uint8_t len) { xSemaphoreTake(i2c_mutex, portMAX_DELAY); uint8_t buf[6]; buf[0] reg; memcpy(buf[1], data, len); esp_err_t ret i2c_master_transmit(pca9685_handle, buf, len 1, 100); if (ret ! ESP_OK) { ESP_LOGE(PCA9685, write failed: %s, esp_err_to_name(ret)); } xSemaphoreGive(i2c_mutex); }之前所有直接调用i2c_master_transmit的地方统一改成调用这层封装。这样按键扫描任务和舵机刷新任务同时访问 I2C 时就不会再互相踩踏了。更重要的是原来代码里对传输返回值完全没检查这是很危险的习惯。I2C 设备在运行中可能因为总线干扰或设备掉线返回错误如果上层继续用旧数据开环控制机械臂会按照错误状态继续动作。加锁加日志之后至少能第一时间发现问题。5.4 修复后的验证结果跑了一整天之后三个现象全部消失。用逻辑分析仪复测 OUT0周期稳定在 20ms误差小于 0.1ms写 1500us 脉宽实测脉冲宽度 1499us精度完全够用上电不再猛转所有舵机停在预设的 90 度位置连续运行 24 小时没有出现看门狗重启多个通道发同样角度角度尺实测误差在正负 1 度以内我还顺手测了 SG90 和 MG996R 两种舵机混合驱动也没有问题。只要电源功率够这套驱动代码的稳定性是可信的。6. 这轮调试的经验沉淀6.1 先看数据手册的时序再撸代码这次最大的教训就是外设芯片的寄存器不是“填进去就行”很多都要求特定的操作顺序。PCA9685 修改 PRE_SCALE 要进 SLEEPAT24C 系列 EEPROM 写页要有页缓冲时序MPU6050 唤醒要写电源管理寄存器传感器上电后要等稳定时间。Arduino 这类封装好的库把这些细节全部隐藏了换个平台重写时不要凭印象抄寄存地址先翻数据手册确认时序能省下大量排错时间。6.2 逻辑分析仪是嵌入式调试的第二双眼睛这次如果有逻辑分析仪早点上场至少省半天。寄存器回读能判断“芯片认为自己在输出什么”但只有物理波形能告诉你“引脚上实际输出了什么”。排查 PWM、I2C、SPI 这类时序敏感问题时别凭感觉猜直接抓波形一眼就能看出周期、脉宽、时序是否符合预期。几十块钱的工具回报远大于投入。6.3 多任务访问外设必须有一个清晰的并发策略不要在多个任务里裸调同一个 I2C 或 SPI 总线。要么加锁要么把设备访问集中到一个独占任务里。很多人第一次在 ESP32 上跑多任务时都会踩这个坑表面上看是随机死机实际上是并发访问的问题。加锁也要注意粒度锁住整个事务而不是只锁一半否则会有更多离奇问题。6.4 这套排错流程可以复用“I2C 扫描 → 寄存器回读 → 逻辑分析仪抓波形 → 检查写时序 → 检查并发访问”这个排查链路不只是 PCA9685 专用。换到 STM32、树莓派 Pico、Arduino只要遇到 I2C 外设行为异常都可以按这个顺序走一遍。先把硬件链路和通信链路洗干净再查参数和时序最后看并发和资源冲突基本能覆盖大多数“诡异 bug”。后面我把这套初始化代码抽成了公共组件参数只留频率和默认脉宽新项目直接复用。回过头看这几个 bug 都不算高级难的是当时三个现象堆在一起既不能确定是硬件还是软件也不能用一个原因解释全部。写这篇笔记也是想提醒自己遇到复杂问题先分层拆解而不是指望一个万能根因。希望你调试 PCA9685 和舵机时能少走几个小时弯路。