【花雕学编程】Arduino PID 之偏航补偿的四旋翼控制

最新推荐文章于 2025-04-24 17:46:29 发布

驴友花雕

最新推荐文章于 2025-04-24 17:46:29 发布

阅读量648

点赞数 27

分类专栏：开源硬件文章标签：嵌入式硬件单片机 c++ Arduino PID 偏航补偿的四旋翼控制

本文链接：https://blog.csdn.net/weixin_41659040/article/details/145490011

版权

开源硬件专栏收录该内容

1642 篇文章

订阅专栏

在这里插入图片描述

Arduino是一个开放源码的电子原型平台，它可以让你用简单的硬件和软件来创建各种互动的项目。Arduino的核心是一个微控制器板，它可以通过一系列的引脚来连接各种传感器、执行器、显示器等外部设备。Arduino的编程是基于C/C++语言的，你可以使用Arduino IDE（集成开发环境）来编写、编译和上传代码到Arduino板上。Arduino还有一个丰富的库和社区，你可以利用它们来扩展Arduino的功能和学习Arduino的知识。

Arduino的特点是：
1、开放源码：Arduino的硬件和软件都是开放源码的，你可以自由地修改、复制和分享它们。
2、易用：Arduino的硬件和软件都是为初学者和非专业人士设计的，你可以轻松地上手和使用它们。
3、便宜：Arduino的硬件和软件都是非常经济的，你可以用很低的成本来实现你的想法。
4、多样：Arduino有多种型号和版本，你可以根据你的需要和喜好来选择合适的Arduino板。
5、创新：Arduino可以让你用电子的方式来表达你的创意和想象，你可以用Arduino来制作各种有趣和有用的项目，如机器人、智能家居、艺术装置等。

在这里插入图片描述
在 Arduino 系统中，PID 算法主要用于对各种物理量（如温度、速度、位置等）进行精确控制。例如，通过连接温度传感器到 Arduino，利用 PID 算法可以精准控制加热或制冷设备，使温度稳定在设定值；在电机控制中，PID 可以根据目标速度和实际速度的偏差来调整电机的驱动信号，实现稳定的转速控制。

主要特点
1、实时反馈控制：PID控制器能够实时处理系统误差，通过比例、积分和微分三部分的调节，快速响应外部扰动，保持系统的稳定性。
2、简单易用：PID控制算法相对简单，易于实现和调试，适合大多数嵌入式系统和实时控制应用。
3、适应性强：PID控制器可以根据系统的动态特性进行调整，适应不同的负载和工作条件，保持良好的控制效果。
4、高精度控制：PID控制能够快速且准确地调整电机速度，确保电机在各种工况下都能稳定地达到设定速度，减少稳态误差。
5、良好的动态响应：通过调整比例、积分和微分参数，控制系统能够快速响应速度变化，适应负载变化和外部扰动，保持系统的稳定性。

应用场景
1、机器人运动控制：在机器人技术中，基于速度闭环的PID控制可以用于电机的速度调节，实现精确的运动控制，提高机器人的灵活性和稳定性。
2、自动化生产线：在自动化设备中，如传送带和机械手臂，PID控制能够确保各个设备的速度稳定，提高生产效率和产品质量。
3、电动工具：在电动工具（如电钻、切割机等）中，PID控制可以实现对电机转速的精确调节，满足不同工作条件的需要。
4、风扇和泵控制：在风扇和水泵等设备中，PID控制能够根据需求自动调节转速，提供适合的流量和风速，提高系统的能效。
5、电动车辆：在电动交通工具中，速度闭环PID控制可以用于电机的速度调节，提升驾驶的平顺性和安全性。

需要注意的事项
1、参数调试：PID控制器的效果高度依赖于参数设置，开发者需要进行细致的调试，以防止系统震荡或响应不及时。
2、传感器校准：使用PID控制时，需要定期校准传感器，以确保数据准确性，特别是在不同的环境条件下使用时。
3、数据融合：在控制中，可以考虑使用数据融合算法（如互补滤波或卡尔曼滤波）来提高姿态估计的稳定性和准确性。
4、电源管理：确保电源供应稳定且符合电机的工作要求，以避免电压波动对电机驱动性能造成影响。
5、热管理：设计合适的散热方案，以防止电机和驱动器过热，影响系统性能和寿命。

在这里插入图片描述
主要特点

精准偏航控制
在四旋翼飞行器中，偏航指的是绕垂直轴的旋转运动。Arduino 结合 PID（比例 - 积分 - 微分）算法能够对四旋翼的偏航进行精准控制。PID 控制器根据陀螺仪等传感器反馈的实际偏航角度与设定的目标偏航角度之间的误差，实时计算并输出控制信号。通过精确调整四个电机的转速，实现对偏航角度的精确补偿，使四旋翼能够稳定地保持在期望的偏航姿态。
动态响应迅速
PID 控制器具有快速的动态响应能力。当四旋翼受到外界干扰（如气流扰动、碰撞等）导致偏航角度发生变化时，PID 控制器能够迅速感知误差，并快速调整电机的转速，以尽快恢复到目标偏航角度。这种快速响应特性确保了四旋翼在复杂环境中能够保持稳定的飞行姿态，避免因偏航失控而导致飞行事故。
自适应调节
四旋翼的飞行环境和负载情况可能会发生变化，例如搭载不同重量的设备、在不同的气流条件下飞行等。Arduino PID 偏航补偿控制具有一定的自适应调节能力。它可以根据系统的实时运行情况，自动调整 PID 参数，以适应不同的飞行工况。例如，当负载增加时，PID 控制器会适当增大控制增益，以保证偏航控制的精度和稳定性。
系统稳定性增强
积分项在 PID 控制器中能够消除系统的稳态误差，确保四旋翼在长时间飞行过程中，偏航角度能够准确地跟踪目标值，不会出现累积偏差。微分环节则可以预测偏航角度的变化趋势，提前进行调整，防止偏航角度出现过大的波动和超调。通过比例、积分、微分三个环节的协同作用，有效地增强了四旋翼偏航控制的稳定性。
易于实现与定制
Arduino 是一个开源的电子原型平台，具有丰富的接口和简单易用的编程环境。开发者可以方便地将 PID 算法应用于四旋翼的偏航控制中，并根据自己的需求对 PID 参数进行定制和调整。同时，还可以结合其他传感器和功能模块，如加速度计、磁力计等，进一步优化偏航控制效果。

应用场景

航拍与测绘
在航拍和测绘任务中，四旋翼需要保持稳定的偏航姿态，以确保相机或测绘设备能够准确地拍摄和记录目标区域。通过 Arduino PID 偏航补偿控制，四旋翼可以精确地调整偏航角度，使相机始终对准拍摄目标，提高航拍和测绘的质量和精度。
物流配送
随着物流行业的发展，四旋翼无人机在货物配送方面具有广阔的应用前景。在配送过程中，四旋翼需要按照预定的航线飞行，并且保持稳定的偏航姿态，以确保货物的安全运输。PID 偏航补偿控制可以使四旋翼在飞行过程中自动调整偏航角度，适应不同的风向和气流条件，提高配送效率和可靠性。
农业植保
农业植保四旋翼需要在农田上方进行均匀的农药喷洒或施肥作业。为了保证作业的均匀性和准确性，四旋翼需要保持稳定的偏航姿态。Arduino PID 偏航补偿控制可以使四旋翼在飞行过程中精确地控制偏航角度，确保农药或肥料能够均匀地覆盖农田，提高农业生产效率和质量。
科研与教学
在科研和教学领域，四旋翼常被用作研究和实验的平台。通过 Arduino PID 偏航补偿控制，学生和研究人员可以深入了解飞行控制原理、PID 算法的应用等知识，开展相关的实验和研究工作，培养创新能力和实践能力。

需要注意的事项

PID 参数整定
PID 参数的整定是实现良好偏航控制效果的关键。不合适的参数会导致四旋翼出现振荡、响应缓慢、偏航失控等问题。常用的参数整定方法有试凑法、Ziegler - Nichols 法等，但都需要进行多次试验和调整。在实际应用中，还需要考虑四旋翼的硬件特性、飞行环境等因素，以找到最佳的 PID 参数组合。
传感器精度与可靠性
偏航控制高度依赖陀螺仪等传感器提供的准确数据。传感器的精度和可靠性直接影响控制效果。在选择传感器时，要确保其具有足够的精度、分辨率和稳定性，并进行定期校准和维护。同时，要考虑传感器的安装位置和方式，避免因安装不当导致测量误差。
电机性能与一致性
电机是四旋翼偏航控制的执行机构，其性能和一致性对控制效果有重要影响。不同电机的转速、扭矩等参数可能存在差异，如果电机性能不一致，会导致偏航控制出现偏差。因此，在选择电机时，要确保其性能符合要求，并进行配对和调试，保证电机之间的一致性。
抗干扰能力
四旋翼在飞行过程中会受到各种外界干扰，如电磁干扰、气流干扰等。这些干扰可能会影响传感器的测量数据和电机的运行。为了提高系统的抗干扰能力，可以采取一些措施，如对传感器和控制电路进行屏蔽、采用滤波算法对传感器数据进行处理、优化电机驱动电路等。
安全机制
在使用 Arduino PID 进行四旋翼偏航控制时，要建立完善的安全机制。例如，设置偏航角度异常保护、电机故障保护、低电量保护等功能，当四旋翼出现异常情况时，能够及时采取措施，避免发生危险。同时，要遵守相关的飞行法规和安全规定，确保飞行安全。

在这里插入图片描述
1、基本四旋翼控制与偏航补偿

#include <PID_v1.h>
#include <Wire.h>
#include <MPU6050.h>

MPU6050 mpu;
double rollSetpoint, pitchSetpoint, yawSetpoint;
double rollInput, pitchInput, yawInput;
double rollOutput, pitchOutput, yawOutput;

PID rollPID(&rollInput, &rollOutput, &rollSetpoint, 2.0, 5.0, 1.0, DIRECT);
PID pitchPID(&pitchInput, &pitchOutput, &pitchSetpoint, 2.0, 5.0, 1.0, DIRECT);
PID yawPID(&yawInput, &yawOutput, &yawSetpoint, 2.0, 5.0, 1.0, DIRECT);

void setup() {
  Serial.begin(9600);
  mpu.initialize();
  rollSetpoint = 0; // 目标滚转角度
  pitchSetpoint = 0; // 目标俯仰角度
  yawSetpoint = 0; // 目标偏航角度
  rollPID.SetMode(AUTOMATIC);
  pitchPID.SetMode(AUTOMATIC);
  yawPID.SetMode(AUTOMATIC);
}

void loop() {
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz); // 获取传感器数据
  rollInput = calculateRoll(ax, ay, az, gx, gy, gz); // 计算滚转角度
  pitchInput = calculatePitch(ax, ay, az, gx, gy, gz); // 计算俯仰角度
  yawInput = calculateYaw(gx, gy, gz); // 计算偏航角度

  rollPID.Compute();
  pitchPID.Compute();
  yawPID.Compute();

  controlMotors(rollOutput, pitchOutput, yawOutput); // 控制电机
  delay(100);
}

void controlMotors(double rollOut, double pitchOut, double yawOut) {
  // 根据PID输出调整电机转速
}

2、偏航补偿与目标调整

#include <PID_v1.h>
#include <Wire.h>
#include <MPU6050.h>

MPU6050 mpu;
double rollSetpoint, pitchSetpoint, yawSetpoint;
double rollInput, pitchInput, yawInput;
double rollOutput, pitchOutput, yawOutput;

PID rollPID(&rollInput, &rollOutput, &rollSetpoint, 1.5, 4.0, 0.5, DIRECT);
PID pitchPID(&pitchInput, &pitchOutput, &pitchSetpoint, 1.5, 4.0, 0.5, DIRECT);
PID yawPID(&yawInput, &yawOutput, &yawSetpoint, 1.5, 4.0, 0.5, DIRECT);

void setup() {
  Serial.begin(9600);
  mpu.initialize();
  rollSetpoint = 0;
  pitchSetpoint = 0;
  yawSetpoint = 0;
  rollPID.SetMode(AUTOMATIC);
  pitchPID.SetMode(AUTOMATIC);
  yawPID.SetMode(AUTOMATIC);
}

void loop() {
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  rollInput = calculateRoll(ax, ay, az, gx, gy, gz);
  pitchInput = calculatePitch(ax, ay, az, gx, gy, gz);
  yawInput = calculateYaw(gx, gy, gz);

  rollPID.Compute();
  pitchPID.Compute();
  yawPID.Compute();

  // 动态调整目标偏航角度
  if (millis() % 10000 < 5000) {
    yawSetpoint = 30; // 目标偏航角度1
  } else {
    yawSetpoint = -30; // 目标偏航角度2
  }

  controlMotors(rollOutput, pitchOutput, yawOutput);
  delay(100);
}

void controlMotors(double rollOut, double pitchOut, double yawOut) {
  // 根据PID输出调整电机转速
}

3、综合偏航补偿与飞行模式切换

#include <PID_v1.h>
#include <Wire.h>
#include <MPU6050.h>

MPU6050 mpu;
double rollSetpoint, pitchSetpoint, yawSetpoint;
double rollInput, pitchInput, yawInput;
double rollOutput, pitchOutput, yawOutput;

PID rollPID(&rollInput, &rollOutput, &rollSetpoint, 2.0, 5.0, 1.0, DIRECT);
PID pitchPID(&pitchInput, &pitchOutput, &pitchSetpoint, 2.0, 5.0, 1.0, DIRECT);
PID yawPID(&yawInput, &yawOutput, &yawSetpoint, 2.0, 5.0, 1.0, DIRECT);

void setup() {
  Serial.begin(9600);
  mpu.initialize();
  rollSetpoint = 0;
  pitchSetpoint = 0;
  yawSetpoint = 0;
  rollPID.SetMode(AUTOMATIC);
  pitchPID.SetMode(AUTOMATIC);
  yawPID.SetMode(AUTOMATIC);
}

void loop() {
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  rollInput = calculateRoll(ax, ay, az, gx, gy, gz);
  pitchInput = calculatePitch(ax, ay, az, gx, gy, gz);
  yawInput = calculateYaw(gx, gy, gz);

  rollPID.Compute();
  pitchPID.Compute();
  yawPID.Compute();

  // 切换飞行模式
  static int mode = 0;
  if (millis() % 15000 < 7500) {
    mode = 0; // 模式1
    yawSetpoint = 0; // 目标偏航角度
  } else {
    mode = 1; // 模式2
    yawSetpoint = 45; // 目标偏航角度
  }

  controlMotors(rollOutput, pitchOutput, yawOutput);
  delay(100);
}

void controlMotors(double rollOut, double pitchOut, double yawOut) {
  // 根据PID输出调整电机转速
}

要点解读
PID控制算法：
所有示例均使用PID控制算法来实现四旋翼的姿态控制。通过调整比例（Kp）、积分（Ki）和微分（Kd）参数，PID控制器能够快速响应姿态变化，保持飞行稳定。
传感器数据读取：
示例中使用MPU6050传感器获取四旋翼的姿态信息，包括滚转、俯仰和偏航角度。通过读取传感器数据，程序能够实时监测四旋翼的状态。
偏航补偿：
每个示例都实现了偏航补偿，通过PID控制器调整偏航角度，以确保四旋翼在飞行过程中保持稳定的方向。
动态目标调整：
第二个和第三个案例展示了如何动态调整目标偏航角度。通过定时器（millis()函数），可以实现周期性改变目标偏航角度的功能，适用于需要动态调整的飞行场景。
飞行模式切换：
第三个案例展示了如何根据时间切换飞行模式。不同的模式可以对应不同的目标偏航角度，适应不同的飞行需求。
电机控制：
controlMotors函数用于根据PID输出调整电机的转速和方向。具体实现可以根据实际应用进行调整，以实现所需的控制效果。

在这里插入图片描述

4、基本四旋翼偏航控制

#include <PID_v1.h>

double yawSetpoint, yawInput, yawOutput;
double Kp = 1.0, Ki = 0.5, Kd = 0.1; // PID参数

PID yawPID(&yawInput, &yawOutput, &yawSetpoint, Kp, Ki, Kd, DIRECT);

void setup() {
    Serial.begin(115200);
    yawSetpoint = 0; // 目标偏航角度
    yawPID.SetMode(AUTOMATIC); // 启动PID控制
}

void loop() {
    yawInput = readYaw(); // 读取当前偏航角度
    yawPID.Compute(); // 计算PID输出
    controlMotors(yawOutput); // 控制电机

    Serial.print("Current Yaw: ");
    Serial.print(yawInput);
    Serial.print(" Target Yaw: ");
    Serial.print(yawSetpoint);
    Serial.print(" Yaw Output: ");
    Serial.println(yawOutput);

    delay(100); // 延时
}

// 模拟读取偏航角度的函数
double readYaw() {
    // 实际应用中应从陀螺仪或IMU读取数据
    return random(-30, 30); // 模拟返回一个范围内的偏航角度
}

// 控制电机的函数
void controlMotors(double output) {
    // 根据PID输出调整四旋翼电机的转速
}

要点解读：
PID控制器：使用PID_v1库实现PID控制，简化了算法的实现过程。
目标设定：设定初始目标偏航角度为0，希望四旋翼保持水平。
数据读取：readYaw函数模拟偏航角度读取，实际应用中应替换为真实的传感器读取。
控制执行：controlMotors函数负责根据PID输出控制电机，实际应用中应实现具体的控制逻辑。
实时反馈：通过串口输出当前偏航角度、目标偏航角度及PID输出，便于监控和调试。

5、多轴四旋翼偏航控制

#include <PID_v1.h>

double rollInput, pitchInput, yawInput;
double rollSetpoint, pitchSetpoint, yawSetpoint;
double rollOutput, pitchOutput, yawOutput;
double Kp = 1.0, Ki = 0.5, Kd = 0.1; // PID参数

PID rollPID(&rollInput, &rollOutput, &rollSetpoint, Kp, Ki, Kd, DIRECT);
PID pitchPID(&pitchInput, &pitchOutput, &pitchSetpoint, Kp, Ki, Kd, DIRECT);
PID yawPID(&yawInput, &yawOutput, &yawSetpoint, Kp, Ki, Kd, DIRECT);

void setup() {
    Serial.begin(115200);
    rollSetpoint = 0; // 目标滚转角度
    pitchSetpoint = 0; // 目标俯仰角度
    yawSetpoint = 0; // 目标偏航角度
    rollPID.SetMode(AUTOMATIC);
    pitchPID.SetMode(AUTOMATIC);
    yawPID.SetMode(AUTOMATIC);
}

void loop() {
    rollInput = readRoll(); // 读取当前滚转角度
    pitchInput = readPitch(); // 读取当前俯仰角度
    yawInput = readYaw(); // 读取当前偏航角度

    rollPID.Compute(); // 计算滚转PID输出
    pitchPID.Compute(); // 计算俯仰PID输出
    yawPID.Compute(); // 计算偏航PID输出

    controlMotors(rollOutput, pitchOutput, yawOutput); // 控制电机

    Serial.print("Roll: "); Serial.print(rollInput);
    Serial.print(" Pitch: "); Serial.print(pitchInput);
    Serial.print(" Yaw: "); Serial.print(yawInput);
    Serial.print(" Roll Output: "); Serial.print(rollOutput);
    Serial.print(" Pitch Output: "); Serial.print(pitchOutput);
    Serial.print(" Yaw Output: "); Serial.println(yawOutput);

    delay(100); // 延时
}

// 模拟读取传感器角度的函数
double readRoll() {
    return random(-30, 30); // 模拟返回一个范围内的滚转角度
}
double readPitch() {
    return random(-30, 30); // 模拟返回一个范围内的俯仰角度
}
double readYaw() {
    return random(-30, 30); // 模拟返回一个范围内的偏航角度
}

// 控制电机的函数
void controlMotors(double rollOutput, double pitchOutput, double yawOutput) {
    // 根据PID输出调整四旋翼电机的转速
}

要点解读：
多轴控制：使用三个PID控制器分别控制滚转、俯仰和偏航角度，确保四旋翼的稳定飞行。
参数设置：设置Kp, Ki, Kd来优化每个轴的控制效果。
实时反馈：通过串口输出当前姿态和PID输出，便于监控和调试。
数据读取：readRoll, readPitch, readYaw函数模拟传感器数据读取，实际应用中应替换为真实的传感器数据读取。
控制执行：controlMotors函数根据PID输出控制电机，实际应用中应实现具体的控制逻辑。

6、自适应偏航控制的四旋翼

#include <PID_v1.h>

double yawSetpoint, yawInput, yawOutput;
double Kp = 1.0, Ki = 0.5, Kd = 0.1; // 初始PID参数

PID yawPID(&yawInput, &yawOutput, &yawSetpoint, Kp, Ki, Kd, DIRECT);

void setup() {
    Serial.begin(115200);
    yawSetpoint = 0; // 目标偏航角度
    yawPID.SetMode(AUTOMATIC); // 启动PID控制
}

void loop() {
    yawInput = readYaw(); // 读取当前偏航角度
    yawPID.Compute(); // 计算PID输出

    // 自适应调整PID参数
    double error = yawSetpoint - yawInput;
    if (abs(error) > 10) { // 当误差大于10度时增加Kp
        Kp += 0.1;
    } else if (abs(error) < 5) { // 当误差小于5度时减少Kp
        Kp -= 0.1;
    }
    yawPID.SetTunings(Kp, Ki, Kd); // 更新PID参数

    controlMotors(yawOutput); // 控制电机

    Serial.print("Current Yaw: ");
    Serial.print(yawInput);
    Serial.print(" Target Yaw: ");
    Serial.print(yawSetpoint);
    Serial.print(" Yaw Output: ");
    Serial.print(yawOutput);
    Serial.print(" Kp: ");
    Serial.println(Kp);

    delay(100); // 延时
}

// 模拟读取偏航角度的函数
double readYaw() {
    return random(-30, 30); // 模拟返回一个范围内的偏航角度
}

// 控制电机的函数
void controlMotors(double output) {
    // 根据PID输出调整四旋翼电机的转速
}

要点解读：
自适应PID调整：根据当前偏航角度与目标偏航角度之间的误差动态调整Kp参数，提升控制系统的适应性。
实时反馈：通过串口输出当前状态、目标偏航角度和PID参数，便于监控和调试。
灵活性：自适应PID控制能够在不同的工作状态下调整控制策略，适应飞行环境的变化。
数据读取：readYaw函数模拟传感器数据读取，实际应用中应替换为真实的传感器数据读取。
控制执行：controlMotors函数负责根据PID输出控制电机，实际应用中应实现具体的控制逻辑。

总结
通过以上几个示例，可以看到如何使用Arduino实现四旋翼的偏航补偿控制。关键要点包括：
PID控制器的应用：通过PID_v1库实现PID控制，简化了算法的实现过程。
多轴控制：适应四旋翼的多方向飞行姿态，确保稳定性。
动态与自适应控制：根据传感器输入动态调整目标位置或PID参数，提高了控制的灵活性和稳定性。
实时数据处理：通过模拟函数读取传感器数据，实际应用中应替换为真实的传感器数据读取。
调试与监控：通过串口输出状态信息，便于调试和优化控制参数。

注意，以上案例只是为了拓展思路，仅供参考。它们可能有错误、不适用或者无法编译。您的硬件平台、使用场景和Arduino版本可能影响使用方法的选择。实际编程时，您要根据自己的硬件配置、使用场景和具体需求进行调整，并多次实际测试。您还要正确连接硬件，了解所用传感器和设备的规范和特性。涉及硬件操作的代码，您要在使用前确认引脚和电平等参数的正确性和安全性。

在这里插入图片描述