树莓派Pico电机驱动方案：PCA9685与TB6612FNG硬件设计与MicroPython控制-平芜编程栈

1. 项目概述：Pico-Motor-Driver，一个为树莓派Pico量身定制的电机驱动方案

如果你手头有一块树莓派Pico，想用它来控制机器人、小车或者任何需要精确运动控制的装置，那么“Pico-Motor-Driver”这个项目就是你一直在找的答案。它不是一个单一的硬件，而是一个围绕Pico构建的、集成了PCA9685 PWM控制器和TB6612FNG电机驱动芯片的完整解决方案。简单来说，它解决了Pico原生GPIO引脚数量有限、驱动能力弱，难以同时控制多个电机并实现速度调节的痛点。这个项目非常适合那些对嵌入式开发、机器人学感兴趣的创客、学生和工程师，无论你是想做一个简单的循线小车，还是一个需要多关节协同的机械臂，这套方案都能提供一个稳定、高效且易于上手的起点。它的核心价值在于，将复杂的电机控制逻辑（如PWM生成、H桥控制）通过成熟的芯片硬件化，让开发者能更专注于上层应用逻辑，比如路径规划、传感器融合，而不是纠结于如何让电机转起来、转多快、正转还是反转这些底层细节。

2. 核心硬件选型与设计思路拆解

2.1 为什么是PCA9685 + TB6612FNG的组合？

选择PCA9685和TB6612FNG这对“黄金搭档”，背后有非常清晰的工程考量。首先，树莓派Pico的RP2040微控制器虽然性能不俗，但其PWM资源（8个独立通道）和GPIO数量（26个）在面对需要控制多个舵机（Servo）和直流电机（DC Motor）的复杂项目时，会显得捉襟见肘。PCA9685是一块I2C接口的16通道、12位精度PWM控制器。它的出现，完美解决了Pico PWM通道不足的问题。你只需要占用Pico的两个GPIO（SDA, SCL）用于I2C通信，就能扩展出16个独立的PWM输出通道，每个通道的占空比和频率都可以通过I2C指令精确设置。这16个通道，可以用来控制多达16个舵机，或者为多个TB6612FNG提供PWM调速信号。

而TB6612FNG，则是一个双通道的H桥电机驱动芯片。一个H桥可以控制一个直流电机的正转、反转、刹车和停止。TB6612FNG集成了两个完整的H桥，意味着一颗芯片就能独立驱动两个直流电机。相比传统的L298N模块，TB6612FNG效率更高（功耗更低，发热更小），支持更大的峰值电流（1.2A连续，3.2A峰值），并且内置了待机与过热保护电路，可靠性大大提升。它的控制逻辑也非常简洁：每个电机通道需要三个信号——两个方向控制引脚（AIN1/AIN2或BIN1/BIN2）和一个PWM速度控制引脚（PWMA/PWMB）。

那么，组合起来的工作流程就是：Pico作为主控大脑，通过I2C总线向PCA9685发送指令，设定其16个输出通道中某几个的PWM波形。这些PWM波形输出连接到TB6612FNG的PWMA/PWMB引脚，用于控制电机速度。同时，Pico的普通GPIO引脚直接连接到TB6612FNG的AIN1/AIN2/BIN1/BIN2，用于控制电机的方向（正转/反转/刹车/停止）。这样，Pico只需很少的引脚，就能构建一个可以同时控制多个舵机和直流电机的强大系统。

2.2 电路设计与布局要点

在设计Pico-Motor-Driver的硬件时，有几个关键点必须注意，否则极易导致芯片损坏或系统不稳定。

首先是电源设计。这是整个系统稳定运行的基石。TB6612FNG的电机驱动部分（VM引脚）和逻辑控制部分（VCC引脚）需要分开供电。VM接电机电源，电压范围在2.5V到13.5V之间，具体取决于你的电机额定电压（常用的是3V、6V或12V）。VCC接逻辑电源，必须与Pico和PCA9685的逻辑电平一致，通常是3.3V。绝对禁止将电机电源（VM）直接接到VCC或Pico的3.3V引脚上，电机启动和堵转时产生的大电流和电压波动会直接摧毁脆弱的逻辑芯片。一个稳妥的方案是使用两路独立的电源，或者一个电源通过大功率DCDC降压模块得到VM，再通过一个低压差线性稳压器（LDO）如AMS1117-3.3得到纯净的3.3V逻辑电。

其次是信号电平匹配。Pico的GPIO输出是3.3V电平。TB6612FNG的逻辑输入高电平阈值最小为2.0V（VCC=3.0V时），因此3.3V驱动它完全没有问题。PCA9685的工作电压范围是2.3V到5.5V，直接与Pico的3.3V I2C总线连接也是兼容的。但务必确保所有设备共地，即Pico的GND、PCA9685的GND、TB6612FNG的GND以及电机电源的负极必须连接在一起，形成一个统一的参考地。

最后是PCB布局与去耦。电机是巨大的噪声源。在画板子时，电机驱动部分（TB6612FNG及其外围功率回路）应尽量远离模拟和数字信号部分（Pico, PCA9685）。在每个芯片的电源引脚（VCC, VM）附近，必须紧贴芯片放置一个0.1uF的陶瓷电容用于高频去耦，同时并联一个10uF或更大的电解/钽电容用于储能和低频滤波。电机的两根电源线在进入PCB时，最好先经过一个大的电解电容（如100uF）缓冲，再并联一个0.1uF陶瓷电容，以吸收电机换向产生的尖峰电压。

注意：TB6612FNG的STBY（待机）引脚必须拉高（接VCC）芯片才能工作。如果发现电机不转，第一个要检查的就是STBY引脚的电平状态。

3. 软件驱动与核心代码实现解析

3.1 开发环境搭建与库选择

对于树莓派Pico，最主流的开发方式是使用MicroPython，因为它上手快，交互性强，非常适合快速原型开发。你可以使用Thonny IDE或者VS Code with Pico-Go插件来编写和上传代码。首先需要给Pico刷入最新的MicroPython固件。

针对PCA9685和TB6612FNG，我们不需要从零开始写驱动。MicroPython社区已经有非常成熟的库。对于PCA9685，我们可以使用pca9685.py库；对于电机控制逻辑，我们可以自己封装一个简洁的类，或者使用一些现成的机器人库中的电机驱动模块。这里我们以自己封装为例，这样理解更深刻。

首先，确保你的Pico已经连接好I2C设备。通常PCA9685的I2C地址是0x40（可通过地址选择引脚改变）。接线示例：Pico GP0 (I2C0 SDA) -> PCA9685 SDA; Pico GP1 (I2C0 SCL) -> PCA9685 SCL; 连接3.3V和GND。

3.2 PCA9685驱动初始化与PWM配置

下面是一个基础的PCA9685驱动类实现和初始化过程：

from machine import Pin, I2C import time class PCA9685: def __init__(self, i2c, address=0x40): self.i2c = i2c self.address = address self.reset() # 设置PWM频率，例如50Hz用于舵机，1000Hz用于电机调速 self.set_pwm_freq(50) def reset(self): self.i2c.writeto_mem(self.address, 0x00, b'\x00') # MODE1寄存器，正常模式 def set_pwm_freq(self, freq_hz): """设置PWM频率，范围约24Hz到1526Hz""" prescaleval = 25000000.0 # 25MHz 内部时钟 prescaleval /= 4096.0 # 12-bit 分辨率 prescaleval /= float(freq_hz) prescaleval -= 1.0 prescale = int(prescaleval + 0.5) old_mode = self.i2c.readfrom_mem(self.address, 0x00, 1)[0] new_mode = (old_mode & 0x7F) | 0x10 # 进入睡眠模式以设置预分频器 self.i2c.writeto_mem(self.address, 0x00, bytes([new_mode])) self.i2c.writeto_mem(self.address, 0xFE, bytes([prescale])) self.i2c.writeto_mem(self.address, 0x00, bytes([old_mode])) time.sleep_us(5) self.i2c.writeto_mem(self.address, 0x00, bytes([old_mode | 0x80])) def set_pwm(self, channel, on, off): """设置单个通道的PWM脉冲，on和off为0-4095的值""" data = bytes([on & 0xFF, on >> 8, off & 0xFF, off >> 8]) self.i2c.writeto_mem(self.address, 0x06 + 4*channel, data) def set_pwm_duty(self, channel, duty): """简化接口：设置占空比，duty为0到4095（或0-100%的浮点数）""" if duty < 0: duty = 0 if duty > 4095: duty = 4095 # 固定起始点（on=0），通过调整结束点（off）来改变占空比 self.set_pwm(channel, 0, duty) # 初始化I2C和PCA9685 i2c = I2C(0, sda=Pin(0), scl=Pin(1), freq=400000) pca = PCA9685(i2c)

这段代码的关键在于set_pwm_freq函数。PCA9685有一个约25MHz的内部振荡器，通过一个预分频器（PRE_SCALE寄存器）来产生基础时钟，然后由12位计数器产生PWM波形。公式预分频值 = round(25MHz / (4096 * 期望频率)) - 1是核心。设置频率时，必须先将芯片置于睡眠模式（MODE1寄存器的SLEEP位设为1），写入预分频器后，再唤醒芯片。50Hz是舵机的标准频率，而对于直流电机调速，通常使用更高的频率（如1kHz以上）以减少电机的啸叫声和电流纹波。

3.3 TB6612FNG电机驱动类封装

接下来，我们封装一个电机驱动类，它利用PCA9685的某个通道进行PWM调速，并直接控制Pico的GPIO来管理方向。

class DCMotor: def __init__(self, pca9685, pwm_channel, in1_pin, in2_pin, stby_pin=None): """ pca9685: 初始化好的PCA9685对象 pwm_channel: PCA9685的通道号 (0-15) in1_pin: Pico上连接AIN1/BIN1的GPIO引脚号 in2_pin: Pico上连接AIN2/BIN2的GPIO引脚号 stby_pin: (可选) Pico上连接STBY的GPIO引脚号，如果为None则需硬件拉高 """ self.pca = pca9685 self.channel = pwm_channel self.in1 = Pin(in1_pin, Pin.OUT) self.in2 = Pin(in2_pin, Pin.OUT) if stby_pin is not None: self.stby = Pin(stby_pin, Pin.OUT) self.stby.value(1) # 退出待机模式 else: self.stby = None self.speed = 0 # 当前速度，-4095 到 4095 def _set_pins(self, in1, in2): self.in1.value(in1) self.in2.value(in2) def set_speed(self, speed): """设置速度，范围-4095到4095。负数为反转。""" self.speed = speed abs_speed = abs(speed) if abs_speed > 4095: abs_speed = 4095 if speed > 0: # 正转 self._set_pins(1, 0) self.pca.set_pwm_duty(self.channel, abs_speed) elif speed < 0: # 反转 self._set_pins(0, 1) self.pca.set_pwm_duty(self.channel, abs_speed) else: # 停止（短路刹车） self._set_pins(1, 1) self.pca.set_pwm_duty(self.channel, 0) def brake(self): """快速刹车（短路刹车）""" self._set_pins(1, 1) self.pca.set_pwm_duty(self.channel, 4095) # 输出持续高电平，实现快速制动 self.speed = 0 def coast(self): """滑行停止（高阻态）""" self._set_pins(0, 0) self.pca.set_pwm_duty(self.channel, 0) self.speed = 0 # 使用示例：假设PCA9685通道0接PWMA，Pico GP2接AIN1，GP3接AIN2 motorA = DCMotor(pca, pwm_channel=0, in1_pin=2, in2_pin=3, stby_pin=4) # 电机以50%速度正转 motorA.set_speed(2048) # 2048 / 4095 ≈ 50% time.sleep(2) # 电机刹车停止 motorA.brake() time.sleep(1) # 电机以30%速度反转 motorA.set_speed(-1229) # 1229 / 4095 ≈ 30% time.sleep(2) # 电机滑行停止 motorA.coast()

这个DCMotor类封装了TB6612FNG的所有控制模式。set_speed方法根据速度的正负设置方向引脚，并将速度绝对值映射为PWM占空比。brake方法将两个方向引脚都设为高，同时PWM输出全高，使电机两端短路，产生强烈的制动效果。coast方法则将方向引脚和PWM都置零，电机两端相当于断开，靠惯性滑行停止。在实际机器人控制中，急停常用brake，平稳停止常用coast。

4. 系统集成与高级控制应用

4.1 多电机与舵机协同控制

Pico-Motor-Driver的强大之处在于其可扩展性。我们可以轻松创建一个控制多个电机和舵机的机器人平台。例如，一个典型的四轮差速驱动机器人需要两个电机（左右各一），一个机械臂可能需要3-4个舵机。下面是一个集成示例：

# 初始化硬件 i2c = I2C(0, sda=Pin(0), scl=Pin(1), freq=400000) pca = PCA9685(i2c) pca.set_pwm_freq(1000) # 电机PWM频率设为1kHz # 为舵机单独设置频率（如果需要，可以初始化另一个PCA9685，或者所有舵机共用50Hz） # pca_servo.set_pwm_freq(50) # 定义两个电机（差速驱动） motor_left = DCMotor(pca, pwm_channel=0, in1_pin=2, in2_pin=3, stby_pin=4) motor_right = DCMotor(pca, pwm_channel=1, in1_pin=5, in2_pin=6) # 假设STBY已硬件拉高 # 定义一个舵机控制函数（假设舵机接PCA9685通道8） def set_servo_angle(channel, angle): """角度范围通常为0-180度，对应脉冲宽度0.5ms到2.5ms（在50Hz下对应占空比2.5%到12.5%）""" pulse_min = 102 # 0.5ms / (1/50Hz) * 4096 ≈ 102 pulse_max = 512 # 2.5ms / (1/50Hz) * 4096 ≈ 512 pulse_width = int(pulse_min + (pulse_max - pulse_min) * angle / 180) pca.set_pwm_duty(channel, pulse_width) # 差速驱动函数：控制机器人移动 def robot_move(linear_speed, angular_speed): """ linear_speed: 线速度，-100到100 angular_speed: 角速度，-100到100（左转为负，右转为正） """ base_speed = int(linear_speed * 40.95) # 映射到-4095~4095 diff_speed = int(angular_speed * 40.95) left_speed = base_speed - diff_speed right_speed = base_speed + diff_speed # 限幅 left_speed = max(-4095, min(4095, left_speed)) right_speed = max(-4095, min(4095, right_speed)) motor_left.set_speed(left_speed) motor_right.set_speed(right_speed) # 示例：机器人向前直行，同时抬起机械臂 robot_move(50, 0) # 50%速度向前 set_servo_angle(8, 90) # 舵机转到90度位置 time.sleep(2) robot_move(0, 0) # 停止

在这个例子中，我们通过一个robot_move函数实现了差速运动模型，这是轮式机器人最基础也是最核心的运动控制方式。通过调节左右轮的速度差，可以实现前进、后退、原地旋转和任意弧线运动。

4.2 加入PID速度闭环控制

开环控制（直接给PWM值）受电池电压、负载变化影响很大，速度不稳定。要实现精确控制（如让小车以恒定速度行驶），需要引入速度闭环。这通常需要给电机加上编码器。Pico的PIO（可编程IO）功能非常适合用来读取正交编码器信号。下面是一个简化的PID速度控制思路：

硬件连接：将电机编码器的A、B相分别接到Pico的两个GPIO引脚。
速度测量：使用Pico的PIO状态机或外部中断，在固定时间间隔（如10ms）内统计编码器脉冲数，换算成转速（RPM或脉冲数/周期）。
PID控制器：设定目标速度，计算当前速度与目标速度的误差，然后通过比例（P）、积分（I）、微分（D）三个环节计算出控制量（即PWM占空比的调整值）。
输出调整：将PID输出叠加到基础PWM值上，驱动电机。

# 伪代码示例：PID速度控制类框架 class PIDController: def __init__(self, kp, ki, kd): self.kp = kp self.ki = ki self.kd = kd self.integral = 0 self.prev_error = 0 def compute(self, setpoint, measurement, dt): error = setpoint - measurement self.integral += error * dt derivative = (error - self.prev_error) / dt output = self.kp * error + self.ki * self.integral + self.kd * derivative self.prev_error = error return output class EncoderMotor(DCMotor): def __init__(self, pca9685, pwm_ch, in1_pin, in2_pin, encoder_a_pin, encoder_b_pin): super().__init__(pca9685, pwm_ch, in1_pin, in2_pin) self.encoder_pos = 0 self.speed_rpm = 0 # 初始化编码器引脚和中断（此处简化，实际需用PIO或定时中断） self.a_pin = Pin(encoder_a_pin, Pin.IN, Pin.PULL_UP) self.b_pin = Pin(encoder_b_pin, Pin.IN, Pin.PULL_UP) self.a_pin.irq(trigger=Pin.IRQ_RISING | Pin.IRQ_FALLING, handler=self._encoder_isr) self.pid = PIDController(kp=1.0, ki=0.1, kd=0.05) self.target_rpm = 0 def _encoder_isr(self, pin): # 根据A、B相状态判断正反转，更新self.encoder_pos pass def update_speed(self, dt): """定期调用，例如每10ms，计算速度并更新PID""" pulses = self.encoder_pos # 获取脉冲计数 self.encoder_pos = 0 # 重置 # 根据脉冲数和时间dt计算转速 (RPM) # self.speed_rpm = (pulses / PPR / dt) * 60 # PPR: 编码器每转脉冲数 error = self.target_rpm - self.speed_rpm pid_output = self.pid.compute(self.target_rpm, self.speed_rpm, dt) # 将PID输出转换为PWM值，并限幅 new_pwm = int(self.speed + pid_output) new_pwm = max(-4095, min(4095, new_pwm)) self.set_speed(new_pwm) # 在主循环中 motor_with_encoder = EncoderMotor(pca, 0, 2, 3, 10, 11) motor_with_encoder.target_rpm = 100 # 设定目标转速100RPM while True: current_time = time.ticks_ms() # 每10ms更新一次PID控制 if time.ticks_diff(current_time, last_update_time) >= 10: dt = 0.01 # 10ms motor_with_encoder.update_speed(dt) last_update_time = current_time

引入PID闭环后，即使负载发生变化（如上坡），系统也能自动调整PWM输出以维持设定速度，控制精度和鲁棒性得到质的提升。PID参数的整定（调整Kp， Ki， Kd）是一个经验过程，可以从较小的比例系数开始，逐步增加积分和微分项，观察系统响应直到达到快速、稳定且超调小的效果。

5. 常见问题排查与实战经验分享

在实际搭建和调试Pico-Motor-Driver系统的过程中，你几乎一定会遇到下面这些问题。我把它们和解决方法整理出来，希望能帮你节省大量排查时间。

5.1 电机完全不转或抖动

这是最常见的问题，请按以下顺序排查：

电源与接线：
- 首要检查：用万用表测量TB6612FNG的VM（电机电源）和VCC（逻辑电源）引脚电压是否正确。VM电压必须符合电机要求，VCC必须是稳定的3.3V。
- 共地检查：确保Pico、PCA9685、TB6612FNG、电机电源的“地”（GND）全部连接在一起。这是许多诡异问题的根源。
- STBY引脚：确认TB6612FNG的STBY引脚是否为高电平（3.3V）。如果悬空，芯片处于待机模式，电机不会工作。最好通过一个GPIO控制，或者在代码里确保将其拉高。
控制信号：
- 逻辑电平：用逻辑分析仪或示波器检查Pico输出到TB6612FNG方向引脚（IN1， IN2）和PCA9685输出到PWMA/B引脚的信号。方向引脚的电平组合是否正确？（01正转，10反转，11刹车，00停止）。PWM引脚是否有波形输出？频率和占空比是否符合预期？
- I2C通信：确认PCA9685是否初始化成功。可以在MicroPython REPL里运行i2c.scan()，看是否能扫描到地址0x40（或其他你设置的地址）。如果扫描不到，检查I2C接线（SDA， SCL）、上拉电阻（通常需要4.7kΩ上拉到3.3V）和电源。
电机与负载：
- 电机本身：直接将电机短暂接到电池上，看是否能转动，排除电机损坏的可能。
- 负载过重：TB6612FNG的连续输出电流是1.2A。如果电机堵转或负载过大，电流可能超过此值，触发芯片的过流保护导致停止输出。尝试空载运行电机。

5.2 电机转动方向异常或速度不可控

方向相反：如果电机转向与预期相反，最简单的方法是交换连接电机两根线的位置，或者交换代码中IN1和IN2引脚的控制逻辑。
PWM频率不当：
- 电机啸叫：如果电机发出高频噪音，说明PWM频率可能在人耳可听范围（20Hz-20kHz）。将频率提高到1kHz以上（如5kHz， 10kHz）通常可以消除。
- 低速抖动：在极低占空比下（如<5%），如果PWM频率太高，每个有效脉冲的能量可能不足以启动电机，导致抖动。可以尝试适当降低频率（如500Hz-1kHz），或者使用“使能端+方向”模式（但TB6612FNG更推荐PWM+方向模式）。
占空比与速度非线性：电机存在一个“死区”，即PWM占空比低于某个阈值（比如10%）时，电机无法启动。在代码中，可以将速度映射函数从线性改为带死区补偿的。例如：effective_duty = deadzone + (1-deadzone) * commanded_duty。

5.3 PCA9685控制异常

所有通道无输出：检查I2C地址是否正确，初始化序列（特别是设置频率时的睡眠/唤醒操作）是否完整。用逻辑分析仪抓取I2C总线数据，看写入寄存器的值是否正确。
单个通道异常：检查该通道的接线。PCA9685输出是开漏的，需要接上拉电阻到VCC（通常板载已集成）。如果外接负载过重，也可能拉低电压。

5.4 系统不稳定或复位

电源干扰：电机启动瞬间电流极大，可能导致逻辑电源电压瞬间被拉低，引起Pico或PCA9685复位。务必为电机驱动电源（VM）和逻辑电源（VCC）使用大容量电解电容（如100uF-470uF）进行储能和滤波，并尽可能靠近TB6612FNG的电源引脚放置。
地线噪声：大电流地回路和小信号地回路混合，会引入噪声。在布局时，尽量让电机电流的地路径宽而短，最后在电源入口处一点接入系统地。
软件看门狗：在复杂的控制循环中，如果某个操作卡死，会导致整个系统无响应。可以考虑启用Pico的看门狗定时器（WDT），在超时时复位系统。

实操心得：在第一次上电测试时，强烈建议先不接电机，用万用表测量TB6612FNG的输出端（AO1/AO2， BO1/BO2）电压。通过代码控制电机正转、反转、刹车，观察输出电压是否按预期变化（如正转时AO1≈VM， AO2≈0V）。确认逻辑控制完全正确后，再接上电机，可以最大程度避免因接线或代码错误导致的“放烟花”风险。

调试是一个系统工程，从电源开始，到控制信号，再到负载，层层递进，保持耐心，用好你的万用表和示波器（如果有可能），大部分问题都能迎刃而解。Pico-Motor-Driver这个方案，把复杂的功率驱动和精密的PWM生成交给了专业的芯片，让我们能站在巨人的肩膀上，更轻松地实现创意。