树莓派控制连续伺服电机的原理与实践

1. 树莓派控制连续伺服电机的基础原理

连续旋转伺服电机（Continuous Rotation Servo）与标准伺服电机在结构上有本质区别。标准伺服电机内部包含位置反馈电位器，通过PWM信号控制旋转角度（通常0-180度）。而连续旋转伺服电机移除了机械限位装置和位置反馈，将PWM信号转换为转速和方向控制。

关键参数解析：

• PWM信号范围：典型值为500-2500μs（0.5ms-2.5ms）
  • 1.5ms脉冲宽度对应停止状态
  • <1.5ms脉冲宽度对应逆时针旋转（值越小转速越快）

  • 1.5ms脉冲宽度对应顺时针旋转（值越大转速越快）

• 工作电压：常见规格为4.8V-6V，需注意树莓派GPIO只能输出3.3V逻辑电平
• 驱动电流：单个电机工作电流可达500mA-1A，建议使用外部电源供电

重要提示：切勿将伺服电机直接连接到树莓派电源引脚！必须使用独立电源并通过共地方式连接，否则可能烧毁树莓派。

2. 硬件连接方案

2.1 基础连接方式

code复制树莓派 GPIO ────┬─── PWM信号线（黄色/白色）
                 │
外部电源(5V) ────┼─── 电源正极（红色）
                 │
                 └─── 共地线（黑色/棕色）

2.2 推荐扩展方案

对于需要控制多个伺服电机的场景，建议使用PCA9685 PWM扩展板：

• 通过I2C接口与树莓派通信
• 提供16路独立PWM输出
• 内置电平转换，支持5V逻辑
• 可编程频率（通常设置为50Hz用于伺服电机）

典型接线示例：

code复制树莓派 I2C引脚 ──── PCA9685 SDA/SCL
外部电源(5V-6V) ── PCA9685 V+
伺服电机群 ────── PCA9685 PWM输出通道

3. 软件控制方法详解

3.1 GPIOZero库方案

python复制from gpiozero import Servo
from time import sleep
import RPi.GPIO as GPIO

# 初始化设置
servo_pin = 12  # 使用GPIO12（物理引脚32）
min_pulse = 0.0005  # 500μs（全速逆时针）
max_pulse = 0.0025  # 2500μs（全速顺时针）

# 创建伺服对象
servo = Servo(
    servo_pin,
    min_pulse_width=min_pulse,
    max_pulse_width=max_pulse,
    frame_width=0.02  # 20ms周期（50Hz）
)

def control_servo():
    try:
        # 加速到全速逆时针
        print("全速逆时针旋转")
        servo.min()  # 等价于value=-1
        sleep(2)
        
        # 减速停止
        print("减速停止")
        servo.mid()  # 等价于value=0
        sleep(1)
        
        # 加速到全速顺时针
        print("全速顺时针旋转")
        servo.max()  # 等价于value=1
        sleep(2)
        
    except KeyboardInterrupt:
        print("用户中断")
    finally:
        servo.detach()
        GPIO.cleanup()

if __name__ == "__main__":
    control_servo()

关键参数说明：

• frame_width：PWM周期，必须设置为20ms（50Hz）才能正确驱动伺服电机
• min()/max()：对应电机的两个旋转极限，实际方向取决于电机接线
• 通过value属性可以实现无极调速（-1到+1之间的任意值）

3.2 Adafruit PCA9685方案

python复制from adafruit_servokit import ServoKit
from time import sleep
import board
import busio

# I2C初始化
i2c = busio.I2C(board.SCL, board.SDA)
kit = ServoKit(channels=16, i2c=i2c)

# 连续伺服电机控制函数
def continuous_servo_demo():
    servo_channel = 0  # 使用第一个PWM通道
    
    try:
        # 加速到全速逆时针
        print("全速逆时针旋转")
        kit.continuous_servo[servo_channel].throttle = -1.0
        sleep(2)
        
        # 减速停止
        print("电机停止")
        kit.continuous_servo[servo_channel].throttle = 0
        sleep(1)
        
        # 加速到全速顺时针
        print("全速顺时针旋转")
        kit.continuous_servo[servo_channel].throttle = 1.0
        sleep(2)
        
    except KeyboardInterrupt:
        print("用户中断")
    finally:
        # 完全关闭PWM输出
        kit._pca.channels[servo_channel].duty_cycle = 0

if __name__ == "__main__":
    continuous_servo_demo()

高级功能说明：

• throttle参数范围：-1.0（全速逆时针）到+1.0（全速顺时针）
• 可通过修改PCA9685频率适配特殊规格伺服电机：

  python复制kit._pca.frequency = 60  # 修改为60Hz
  

• 多电机同步控制示例：

  python复制# 同时控制4个电机
  speeds = [-0.5, 0.2, 0.8, -0.3]
  for i in range(4):
      kit.continuous_servo[i].throttle = speeds[i]
  

4. 实战经验与问题排查

4.1 常见问题解决方案

4.2 高级调试技巧

1. 脉冲宽度测量：

python复制# 测量实际输出脉冲宽度（单位：秒）
actual_pulse = servo._device.pulse_width / 1e6
print(f"实际脉冲宽度：{actual_pulse*1000:.2f}ms")

2. 死区补偿：

python复制# 部分电机需要死区补偿才能完全停止
servo.value = 0.02  # 微小正向脉冲补偿

3. 运动曲线平滑处理：

python复制# 实现缓启动/缓停止
def smooth_control(target, duration=1.0, steps=50):
    current = servo.value
    step_size = (target - current) / steps
    for _ in range(steps):
        current += step_size
        servo.value = current
        sleep(duration/steps)

4.3 电源管理建议

1. 电容去耦：

   • 在电机电源引脚并联1000μF电解电容+0.1μF陶瓷电容
   • 可有效抑制电压波动导致的控制异常

2. 电流监测：

python复制# 使用INA219等电流传感器监测功耗
import adafruit_ina219
ina = adafruit_ina219.INA219(i2c)
print(f"电流：{ina.current:.2f}mA")

3. 过热保护：

python复制# 监测PCA9685芯片温度
import adafruit_pca9685
print(f"芯片温度：{kit._pca.temperature:.1f}°C")

5. 项目扩展应用

5.1 机器人底盘控制

python复制# 双轮差速驱动实现
def move_robot(left_speed, right_speed):
    kit.continuous_servo[0].throttle = left_speed
    kit.continuous_servo[1].throttle = right_speed

# 前进
move_robot(0.5, 0.5)
sleep(2)

# 原地右转
move_robot(0.3, -0.3)
sleep(1)

5.2 云台控制系统

python复制# 双轴云台控制（需两个标准伺服电机）
pan = kit.servo[0]  # 水平旋转
tilt = kit.servo[1] # 垂直旋转

pan.angle = 90  # 居中
tilt.angle = 30  # 仰角30度

5.3 自动化输送带

python复制# 定时控制输送带运行
import datetime

def conveyor_control(run_time=5, stop_time=2):
    while True:
        now = datetime.datetime.now().strftime("%H:%M")
        print(f"[{now}] 输送带启动")
        kit.continuous_servo[2].throttle = 0.7
        sleep(run_time)
        
        print(f"[{now}] 输送带停止")
        kit.continuous_servo[2].throttle = 0
        sleep(stop_time)

在实际项目中，我发现伺服电机的性能会随使用时间逐渐变化，建议每3个月进行一次校准。使用光学转速计测量实际转速，记录不同PWM值对应的转速曲线，可以建立更精确的控制模型。对于需要精确定位的场景，可以考虑增加光电开关或编码器实现闭环控制。