DIY 双轴 FPV 摄像头云台：Arduino + 摇杆模块控制教程

硬件清单

项目背景

云台套件包含亚克力结构件、两颗 SG90 舵机（已预装）。本教程提供两种控制模式代码，分别对应“跟随模式”与“速率模式”，适合 FPV 穿越机、固定翼相机稳定或地面机器人视觉跟踪。

接线说明

• 舵机 1（底部偏航）信号线 → D8
• 舵机 2（顶部俯仰）信号线 → D9
• 摇杆 X 轴 → A0，Y 轴 → A1
• 舵机 VCC/GND 接外部 5V 电源（建议独立供电，避免 Arduino 稳压器过热）

注意： 图中上下舵机位置请勿搞反；摇杆 X/Y 定义可在代码中对调。

控制模式对比

代码 1：位置跟随模式

#include <Servo.h>
Servo yawServo, pitchServo;
const int X_AXIS = A0, Y_AXIS = A1;

void setup() {
  Serial.begin(9600);
  pinMode(X_AXIS, INPUT); pinMode(Y_AXIS, INPUT);
  yawServo.attach(8);   // 底部舵机
  pitchServo.attach(9); // 顶部舵机
}

void loop() {
  int x = analogRead(X_AXIS);        // 0-1023
  int y = analogRead(Y_AXIS);
  // 映射到舵机范围，根据实测微调系数
  x = map(x, 0, 1023, 0, 180);
  y = map(y, 0, 1023, 0, 150);       // 俯仰限幅 150°
  x = 180 - x;                       // 方向修正
  yawServo.write(x);
  pitchServo.write(y);
  delay(20); // 约 50Hz 刷新
}

代码 2：速率/积分模式

#include <Servo.h>
Servo yawServo, pitchServo;
const int X_AXIS = A0, Y_AXIS = A1;
int yawPos, pitchPos;

void setup() {
  Serial.begin(9600);
  pinMode(X_AXIS, INPUT); pinMode(Y_AXIS, INPUT);
  yawServo.attach(8); pitchServo.attach(9);
  yawPos = yawServo.read(); pitchPos = pitchServo.read();
}

void loop() {
  int x = analogRead(X_AXIS);
  int y = analogRead(Y_AXIS);
  // 死区 ±50，避免中位抖动
  if (x > 550) { yawPos--; yawServo.write(yawPos); delay(50); }
  if (x < 450) { yawPos++; yawServo.write(yawPos); delay(50); }
  if (y > 600) { pitchPos++; pitchServo.write(pitchPos); delay(50); }
  if (y < 450) { pitchPos--; pitchServo.write(pitchPos); delay(50); }
  // 可选：增加限位保护
  yawPos = constrain(yawPos, 0, 180);
  pitchPos = constrain(pitchPos, 0, 150);
}

调试与校准技巧

1. 舵机零位校准：上电前手动拨动舵机至机械中心，再通电
2. 摇杆中位校准：串口打印 analogRead 值，记录静止时的 X/Y 中心值，代码中做死区判断
3. 方向反转：若云台动作与预期相反，修改 map 目标范围或交换正负
4. 抖动抑制：加装 100μF 电解电容并联舵机电源；软件端增加滑动平均滤波

进阶扩展

• 替换为 MG996R 金属齿舵机，提升扭矩与耐用性
• 加装 MPU6050 实现姿态稳定（自动水平）
• 接入无线图传模块（如 5.8G VTX），实现真正 FPV
• 使用 PWM 驱动板（PCA9685）释放 Arduino 引脚，支持更多舵机