【花雕学编程】Arduino PID 之带速度反馈的直流电机位置控制

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、热管理：设计合适的散热方案，以防止电机和驱动器过热，影响系统性能和寿命。

一、主要特点
（一）PID 控制特点
精确控制能力
PID（比例 - 积分 - 微分）控制是一种成熟且高效的控制策略。在直流电机位置控制中，比例项（P）根据电机当前位置与目标位置的偏差，快速产生一个控制信号，使电机朝着减小偏差的方向转动。例如，若电机位置偏差较大，比例项会输出较大的控制信号，让电机快速靠近目标位置。积分项（I）用于消除稳态误差，当电机由于摩擦、负载变化等因素无法精确到达目标位置时，积分项会逐渐积累控制作用，确保电机最终能稳定在目标位置。微分项（D）则根据位置偏差的变化率提前调整控制信号，增强系统的稳定性和响应速度，避免电机位置出现过冲或振荡。
参数可调性
PID 控制器的参数（比例系数、积分时间常数、微分时间常数）可以根据电机的特性、负载情况和控制要求进行调整。通过改变这些参数，可以优化控制性能。例如，对于惯性较大的负载，可能需要增大积分时间常数，以避免电机在启动和停止过程中出现较大的位置误差。
（二）速度反馈特点
速度测量精度
系统通过速度传感器（如编码器、测速发电机等）来获取直流电机的实时速度信息。这些传感器能够提供高精度的速度测量，将电机的旋转速度转换为电信号，进而反馈给控制系统。例如，编码器可以通过计数脉冲来精确计算电机的转速，每转产生的脉冲数越多，速度测量精度越高。
实时速度调整
基于速度反馈，控制系统能够实时调整电机的驱动信号。当电机速度由于负载变化、电源波动等因素发生变化时，控制系统可以根据速度偏差及时调整电机的电压或电流，使电机速度保持稳定。例如，当电机负载突然增加导致速度下降时，控制系统会根据速度反馈信号增加电机的驱动电压，使电机速度恢复到设定值。
（三）位置控制与速度反馈的结合
协同控制优势
将位置控制和速度反馈相结合，可以实现更精确、更稳定的直流电机位置控制。在电机向目标位置转动过程中，速度反馈可以确保电机以合适的速度运行，避免速度过快导致位置过冲或速度过慢影响控制效率。例如，当电机接近目标位置时，控制系统可以根据速度反馈逐渐降低电机速度，使电机平稳地停在目标位置。
动态性能提升
这种结合增强了系统的动态性能。在面对负载变化、外部干扰等情况时，系统能够同时从位置和速度两个方面进行调整，快速恢复到稳定的工作状态。例如，当电机在运行过程中受到外力干扰导致位置和速度发生变化时，控制系统可以综合考虑位置偏差和速度偏差，迅速输出合适的控制信号，使电机回到预定的位置和速度。

二、应用场景
（一）工业自动化
数控机床加工
在数控机床中，直流电机用于驱动刀具或工作台的运动。通过带速度反馈的 PID 位置控制，可以精确控制刀具的位置和工作台的移动，实现高精度的零件加工。例如，在铣削复杂形状的零件时，电机需要精确地按照预设的轨迹和位置进行移动，PID 控制结合速度反馈能够确保加工精度，满足工业生产的严格要求。
自动化生产线中的物料搬运
在自动化生产线中，用于控制物料搬运设备（如传送带、机械臂等）的直流电机位置。例如，机械臂通过精确的位置控制将零部件从一个位置搬运到另一个位置，速度反馈可以保证机械臂在移动过程中平稳、快速，提高生产效率。传送带电机的位置控制结合速度反馈可以确保物料在传送带上的准确输送和定位。
（二）机器人领域
机器人关节控制
对于机器人的关节电机，带速度反馈的 PID 位置控制至关重要。通过精确控制关节的位置和运动速度，可以实现机器人的精确动作，如抓取物体、行走等。例如，在工业机器人进行装配任务时，需要精确控制机械臂关节的位置和速度，以准确地将零部件装配在一起；在人形机器人行走过程中，腿部关节电机的位置和速度控制能够确保机器人的稳定行走。
移动机器人导航
在移动机器人（如 AGV 自动导引车）中，直流电机用于驱动车轮。通过位置控制和速度反馈，可以精确控制机器人的行驶方向和速度，实现准确的导航。例如，AGV 在仓库中按照预设的路径行驶，需要精确控制车轮电机的位置和速度，以确保能够准确地停靠在货架旁进行货物的装卸。
（三）智能设备与消费电子
智能窗帘与晾衣架控制
在智能窗帘和电动晾衣架中，直流电机用于控制窗帘的开合位置和晾衣架的升降位置。带速度反馈的 PID 位置控制可以使窗帘和晾衣架平稳地移动，用户可以通过手机 APP 或遥控器精确设定位置。例如，智能窗帘可以根据用户设定的开合程度，以合适的速度打开或关闭，提供舒适的家居体验。
相机云台稳定器
在相机云台稳定器中，直流电机用于调整云台的角度，以保持相机的稳定拍摄。通过 PID 位置控制和速度反馈，云台可以快速、精确地跟踪拍摄目标，抵消手持或外部环境带来的抖动。例如，在拍摄运动场景时，云台能够根据相机的位置变化和运动速度，及时调整角度，确保拍摄画面的清晰和平稳。

三、需要注意的事项
（一）PID 参数整定
参数调试的复杂性
PID 参数的整定是一个复杂的过程，受电机特性（如电机的型号、额定功率、转矩特性等）、负载特性（如负载的惯性、摩擦力等）和系统要求（如响应速度、精度要求等）的影响。找到合适的参数组合需要大量的实验和经验。例如，对于高惯性负载的电机，积分项和微分项的参数可能需要特殊调整，以避免系统出现过冲或振荡。
参数自适应与优化
随着系统运行环境和任务要求的变化，PID 参数可能需要自适应调整或优化。例如，在机器人携带不同重量的负载执行任务时，或者在电机在不同的工作温度下运行时，需要根据实际情况调整 PID 参数，以保证系统的性能。
（二）速度传感器的选择与安装
传感器精度与分辨率
要根据电机位置控制的精度要求选择合适精度和分辨率的速度传感器。传感器的精度和分辨率直接影响速度测量的准确性，进而影响位置控制效果。例如，在高精度的数控机床中，需要使用高分辨率的编码器来精确测量电机速度，以保证加工精度。
安装方式与机械连接
速度传感器的安装方式和机械连接的准确性会影响其测量结果。安装过程中要确保传感器的轴与电机轴同心，并且机械连接牢固，避免出现松动或打滑的现象。例如，在安装编码器时，如果轴不同心，可能会导致测量的速度误差增大，影响位置控制的效果。
（三）系统稳定性与抗干扰
电气干扰问题
系统可能会受到电气干扰，特别是在工业环境或电子设备密集的区域。电气干扰可能会影响速度反馈信号的准确性和电机驱动信号的稳定性。需要采取适当的抗干扰措施，如屏蔽信号线、使用滤波器等。例如，在一个有大量电机和电气设备的工厂车间，编码器的信号线可能会受到附近设备的电磁干扰，导致速度反馈信号出现误差。
机械振动和噪声影响
电机和机械传动系统的振动和噪声可能会对速度传感器的测量产生影响。长时间的振动可能会导致传感器的部件松动或损坏，噪声也可能会干扰传感器信号的采集。例如，在一个有强烈机械振动的设备中，如矿山机械，需要考虑采取减震措施来保护传感器，并确保速度测量的准确性。

1、基本位置控制

#include <Arduino.h>
#include <PID_v1.h>

const int motorPin = 9; // 电机控制引脚
const int encoderPin = 2; // 编码器引脚

volatile int encoderValue = 0; // 编码器读数
double setpoint = 100; // 目标位置
double input, output;
double Kp = 2, Ki = 5, Kd = 1; // PID 参数
PID myPID(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT);

void setup() {
    Serial.begin(9600);
    pinMode(motorPin, OUTPUT);
    pinMode(encoderPin, INPUT);
    attachInterrupt(digitalPinToInterrupt(encoderPin), updateEncoder, RISING);
    myPID.SetMode(AUTOMATIC);
}

void loop() {
    input = encoderValue; // 当前编码器位置
    myPID.Compute(); // 计算 PID 输出

    // 控制电机
    analogWrite(motorPin, output);

    // 输出调试信息
    Serial.print("Position: ");
    Serial.print(input);
    Serial.print(" Output: ");
    Serial.println(output);
    delay(100);
}

void updateEncoder() {
    encoderValue++; // 更新编码器计数
}

2、带速度反馈的电机位置控制

#include <Arduino.h>
#include <PID_v1.h>

const int motorPin = 9; // 电机控制引脚
const int encoderPin = 2; // 编码器引脚

volatile int encoderValue = 0; // 编码器读数
double setpoint = 100; // 目标位置
double input, output;
double Kp = 2, Ki = 5, Kd = 1; // PID 参数
PID myPID(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT);

// 速度反馈
double velocityInput, velocityOutput;
PID velocityPID(&velocityInput, &velocityOutput, &setpoint, Kp, Ki, Kd, DIRECT);
unsigned long lastTime;
int lastEncoderValue = 0;

void setup() {
    Serial.begin(9600);
    pinMode(motorPin, OUTPUT);
    pinMode(encoderPin, INPUT);
    attachInterrupt(digitalPinToInterrupt(encoderPin), updateEncoder, RISING);
    myPID.SetMode(AUTOMATIC);
    velocityPID.SetMode(AUTOMATIC);
}

void loop() {
    input = encoderValue; // 当前编码器位置
    myPID.Compute(); // 计算位置 PID 输出

    // 计算速度反馈
    unsigned long currentTime = millis();
    double elapsedTime = (currentTime - lastTime) / 1000.0; // 转换为秒
    velocityInput = (encoderValue - lastEncoderValue) / elapsedTime; // 计算速度
    velocityPID.Compute(); // 计算速度 PID 输出

    // 控制电机
    analogWrite(motorPin, output + velocityOutput); // 将速度反馈添加到位置控制中

    // 更新历史数据
    lastTime = currentTime;
    lastEncoderValue = encoderValue;

    // 输出调试信息
    Serial.print("Position: ");
    Serial.print(input);
    Serial.print(" Velocity: ");
    Serial.print(velocityInput);
    Serial.print(" Output: ");
    Serial.println(output + velocityOutput);
    delay(100);
}

void updateEncoder() {
    encoderValue++; // 更新编码器计数
}

3、更复杂的控制系统

#include <Arduino.h>
#include <PID_v1.h>

const int motorPin = 9; // 电机控制引脚
const int encoderPin = 2; // 编码器引脚

volatile int encoderValue = 0; // 编码器读数
double setpoint = 100; // 目标位置
double input, output;
double Kp = 2, Ki = 5, Kd = 1; // PID 参数
PID myPID(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT);

// 速度反馈
double velocityInput, velocityOutput;
PID velocityPID(&velocityInput, &velocityOutput, &setpoint, Kp, Ki, Kd, DIRECT);
unsigned long lastTime;
int lastEncoderValue = 0;

void setup() {
    Serial.begin(9600);
    pinMode(motorPin, OUTPUT);
    pinMode(encoderPin, INPUT);
    attachInterrupt(digitalPinToInterrupt(encoderPin), updateEncoder, RISING);
    myPID.SetMode(AUTOMATIC);
    velocityPID.SetMode(AUTOMATIC);
}

void loop() {
    // 位置控制
    input = encoderValue; // 当前编码器位置
    myPID.Compute(); // 计算位置 PID 输出

    // 速度反馈
    unsigned long currentTime = millis();
    double elapsedTime = (currentTime - lastTime) / 1000.0; // 转换为秒
    velocityInput = (encoderValue - lastEncoderValue) / elapsedTime; // 计算速度
    velocityPID.Compute(); // 计算速度 PID 输出

    // 控制电机
    int motorOutput = output + velocityOutput; // 将速度反馈添加到位置控制中
    motorOutput = constrain(motorOutput, 0, 255); // 限制输出范围
    analogWrite(motorPin, motorOutput);

    // 更新历史数据
    lastTime = currentTime;
    lastEncoderValue = encoderValue;

    // 输出调试信息
    Serial.print("Position: ");
    Serial.print(input);
    Serial.print(" Velocity: ");
    Serial.print(velocityInput);
    Serial.print(" Output: ");
    Serial.println(motorOutput);
    delay(100);
}

void updateEncoder() {
    encoderValue++; // 更新编码器计数
}

要点解读
PID 控制器的基本使用：
所有示例中都使用了 Arduino PID 库来实现 PID 控制。PID 控制器根据编码器的读数（位置反馈）计算输出，从而调节电机的速度，以达到目标位置。
速度反馈的引入：
第二个示例中，引入了速度反馈，通过另一个 PID 控制器来计算电机的速度。这一机制使得系统能够更平稳地响应位置变化，并减少超调现象。
编码器的使用：
使用编码器来获取电机的位置反馈。在示例中，updateEncoder() 函数通过中断处理来更新编码器的计数，实现高精度的位置检测。
控制输出的限制：
第三个示例中，通过 constrain() 函数限制电机控制输出的范围，确保 PWM 信号在有效范围内（0-255），避免输出不合理的值导致电机异常工作。
调试信息输出：
通过 Serial 输出当前编码器的位置、速度和 PID 输出，有助于监控系统状态并调试 PID 参数。这一信息可以帮助开发者优化控制性能。

4、位置控制

#include <Arduino.h>
#include <PID_v1.h>

// PID 控制参数
double setpoint, input, output;
double Kp = 2, Ki = 5, Kd = 1;

// PID 控制器
PID myPID(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT);

// 电机控制引脚
const int motorPin = 9;
const int encoderPin = 2;

// 变量
volatile int encoderValue = 0;

void setup() {
    Serial.begin(115200);
    pinMode(motorPin, OUTPUT);
    attachInterrupt(digitalPinToInterrupt(encoderPin), updateEncoder, RISING);
    
    setpoint = 100; // 目标位置（单位：脉冲）
    myPID.SetMode(AUTOMATIC);
}

void loop() {
    input = encoderValue; // 从编码器读取位置
    myPID.Compute(); // 计算 PID 输出
    analogWrite(motorPin, output); // 控制电机
    delay(20);
}

void updateEncoder() {
    encoderValue++; // 编码器脉冲计数
}

要点解读
基本 PID 控制：使用 PID_v1 库创建 PID 控制器，控制目标位置为 100 脉冲，适用于简单的直流电机位置控制。
编码器反馈：通过编码器读取电机位置，确保反馈准确，允许 PID 控制器根据当前位置调整输出。
中断处理：使用外部中断 (attachInterrupt) 捕捉编码器脉冲，以提高位置读取的实时性。
电机控制：使用 analogWrite() 控制电机速度，确保电机根据 PID 输出调整。
循环延迟：通过 delay(20) 控制循环频率，以便于 PID 计算和电机控制的实时性。

5、带速度反馈的电机控制

#include <Arduino.h>
#include <PID_v1.h>

// PID 控制参数
double positionSetpoint, positionInput, positionOutput;
double speedSetpoint, speedInput, speedOutput;
double Kp_position = 2, Ki_position = 5, Kd_position = 1;
double Kp_speed = 1, Ki_speed = 0.1, Kd_speed = 0.5;

// PID 控制器
PID positionPID(&positionInput, &positionOutput, &positionSetpoint, Kp_position, Ki_position, Kd_position, DIRECT);
PID speedPID(&speedInput, &speedOutput, &speedSetpoint, Kp_speed, Ki_speed, Kd_speed, DIRECT);

// 电机控制引脚
const int motorPin = 9;
const int encoderPin = 2;

// 变量
volatile int encoderValue = 0;
unsigned long lastTime = 0;

void setup() {
    Serial.begin(115200);
    pinMode(motorPin, OUTPUT);
    attachInterrupt(digitalPinToInterrupt(encoderPin), updateEncoder, RISING);
    
    positionSetpoint = 100; // 目标位置（单位：脉冲）
    speedSetpoint = 0; // 目标速度
    positionPID.SetMode(AUTOMATIC);
    speedPID.SetMode(AUTOMATIC);
}

void loop() {
    positionInput = encoderValue; // 从编码器读取位置
    speedInput = calculateSpeed(); // 计算速度反馈
    positionPID.Compute(); // 计算位置 PID 输出
    speedPID.Compute(); // 计算速度 PID 输出
    analogWrite(motorPin, positionOutput + speedOutput); // 控制电机
    delay(20);
}

void updateEncoder() {
    encoderValue++; // 编码器脉冲计数
}

double calculateSpeed() {
    static unsigned long lastTime = 0;
    unsigned long currentTime = millis();
    double speed = (encoderValue - encoderValue) / (currentTime - lastTime) * 1000.0; // 计算速度
    lastTime = currentTime;
    return speed;
}

要点解读
双 PID 控制：同时使用位置 PID 和速度 PID 控制器，分别计算位置和速度的输出，增强控制精度。
速度反馈：通过 calculateSpeed() 函数计算速度反馈，确保 PID 控制器能够适应电机速度变化。
中断处理：使用外部中断读取编码器脉冲，确保位置数据的实时性和准确性。
电机控制逻辑：结合位置和速度的 PID 输出，控制电机的速度和位置，提升动态响应能力。
循环延迟：使用短延迟确保控制循环的频率适中，以便实时调节电机状态。

6、改进的电机位置控制系统

#include <Arduino.h>
#include <PID_v1.h>

// PID 控制参数
double positionSetpoint, positionInput, positionOutput;
double speedSetpoint, speedInput, speedOutput;
double Kp_position = 2, Ki_position = 5, Kd_position = 1;
double Kp_speed = 1, Ki_speed = 0.1, Kd_speed = 0.5;

// PID 控制器
PID positionPID(&positionInput, &positionOutput, &positionSetpoint, Kp_position, Ki_position, Kd_position, DIRECT);
PID speedPID(&speedInput, &speedOutput, &speedSetpoint, Kp_speed, Ki_speed, Kd_speed, DIRECT);

// 电机参数
const int motorPin = 9;
const int encoderPin = 2;

// 变量
volatile int encoderValue = 0;
unsigned long lastTime = 0;

void setup() {
    Serial.begin(115200);
    pinMode(motorPin, OUTPUT);
    attachInterrupt(digitalPinToInterrupt(encoderPin), updateEncoder, RISING);
    
    positionSetpoint = 100; // 目标位置（单位：脉冲）
    speedSetpoint = 0; // 目标速度
    positionPID.SetMode(AUTOMATIC);
    speedPID.SetMode(AUTOMATIC);
}

void loop() {
    positionInput = encoderValue; // 从编码器读取位置
    speedInput = calculateSpeed(); // 计算速度反馈
    positionPID.Compute(); // 计算位置 PID 输出
    speedPID.Compute(); // 计算速度 PID 输出
    controlMotor(); // 控制电机
    delay(20);
}

void updateEncoder() {
    encoderValue++; // 编码器脉冲计数
}

double calculateSpeed() {
    static int lastEncoderValue = 0;
    unsigned long currentTime = millis();
    double speed = (encoderValue - lastEncoderValue) / (currentTime - lastTime) * 1000.0; // 计算速度
    lastEncoderValue = encoderValue;
    lastTime = currentTime;
    return speed;
}

void controlMotor() {
    int motorSpeed = positionOutput + speedOutput; // 综合位置和速度输出
    motorSpeed = constrain(motorSpeed, 0, 255); // 限制输出范围
    analogWrite(motorPin, motorSpeed); // 控制电机
}

要点解读
综合控制策略：结合位置和速度的 PID 输出，通过 controlMotor() 函数综合控制电机，提升位置控制的精度和稳定性。
改进的速度计算：使用 calculateSpeed() 函数计算当前速度，通过较为精确的差值计算确保速度反馈的准确性。
限制电机输出：使用 constrain() 函数限制电机速度在合理范围内，避免过载或损坏电机。
中断与反馈：通过中断机制确保编码器反馈的实时性，提升控制系统的响应速度。
模块化设计：代码结构清晰，功能模块化，便于后续扩展和维护。

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