Arduino UNO 与 Adafruit PWM 扩展板实现舵机精准校准

项目概述

廉价 9g 舵机批次间、个体间存在显著差异：相同 PWM 信号下，零位、行程、线性度均不一致。本项目设计一款专用校准装置，结合电位器、量角器与 Adafruit 16 路 PWM 舵机驱动扩展板，测得单个舵机的 PWM-角度对应曲线，通过查表或线性回归公式实现高精度角度控制，为步行机器人等应用提供可预测的舵机行为。

核心组件与物料清单

• Arduino UNO ×1
• Adafruit PWM 舵机驱动扩展板 ×1
• 9g 舵机 ×1（待校准对象）
• 旋转电位器 ×1（模拟输入，控制 PWM 占空比）
• 180° 透明量角器 ×1（读取舵机实时角度）
• LM2596 DC-DC 降压模块 ×1（供电）
• M3 螺栓/垫圈 ×8、红/白 PLA 耗材 ×1（3D 打印支架）

工具： 3D 打印机
软件： Arduino IDE、Autodesk Fusion 360（结构设计）

校准原理与装置设计

为什么不直接用 Arduino 自带 Servo 库？

• Adafruit 扩展板仅占用 I2C 两根引脚即可驱动 16 路舵机，节省 GPIO。
• 原生 Servo 库在 attach() 瞬间常冲发全幅度脉冲，导致廉价舵机撞击齿轮限位、产生齿轮磨损噪音。

校准装置核心思路

1. 舵机输出轴对准量角器中心，摇臂指针指示角度。
2. 电位器中间抽头接 Arduino A0，两端接 5V/GND，旋转电位器改变模拟量读值。
3. Arduino 读取电位器值，映射为 PWM 脉宽（100~612），经 Adafruit 板输出驱动舵机。
4. 人工转动电位器使指针对准量角器刻度（0°、10°…180°），串口监视器记录对应 PWM 值。

装置采用 3D 打印一体化支架，固定 Arduino、扩展板、电源、电位器、量角器与舵机，结构紧凑。

实测数据与建模

数据采集

以 10° 步进记录 0°~180° 对应 PWM 值，绘制散点图，呈现强线性相关。示例数据拟合得线性回归公式：
PWM = 2.35 × Angle + 159.4

两种应用策略

• 查表法： 将 19 组键值对存入数组，运行时直接索引。仅支持 10° 倍数角度。
• 公式法： 在代码中实现线性函数，任意角度可计算对应 PWM，实现连续高精度控制。

校准后舵机摇臂不可拆卸，否则标定失效。

改进方向（下一版本）

• 舵机快拆机构（磁吸/卡扣替代螺栓）
• 重排布局缩小体积
• 增加电源开关
• 减少 3D 打印零件数量
• 引入角度传感器（编码器/霍尔）消除视差误差，实现自动采集
• 加装 LCD 显示屏，脱机读取结果

代码示例

#include <Adafruit_PWMServoDriver.h>
#define analogIn A0
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
int inputValue = 0, tmpPwmValue = 0;

void setup() {
  Serial.begin(9600);
  pwm.begin();
  pwm.setPWMFreq(60);  // 标准舵机 50~60Hz
}

void loop() {
  inputValue = analogRead(analogIn);           // 0~1023
  int pwmValue = 100 + (inputValue / 2);       // 映射至 100~612
  pwm.setPWM(0, 0, pwmValue);                  // 通道 0 输出
  if (pwmValue != tmpPwmValue) {               // 去重打印
    Serial.print("Potentiometer Input = ");
    Serial.print(inputValue);
    Serial.print(", PWM = ");
    Serial.println(pwmValue);
    tmpPwmValue = pwmValue;
  }
  delay(15);
}

资源链接

• 3D 打印模型仓库：ServoCalibrator
• Adafruit_PWMServoDriver 库