【雕爷学编程】Arduino BLDC 之自适应滤波

在这里插入图片描述
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 BLDC(无刷直流电机)是指使用Arduino平台来控制无刷直流电机(Brushless DC Motor)的一系列技术和应用。无刷直流电机是一种先进的电机技术,它利用电子换向来替代传统的碳刷和换向器,从而提供更高效、更可靠和更低维护成本的电机驱动解决方案。以下是对Arduino BLDC的全面详细科学解释:

1、主要特点:
无刷设计:BLDC电机没有碳刷和换向器,消除了电刷磨损和电磁干扰,提高了电机的寿命和效率。
电子换向:通过电子控制器实现换向,响应速度快,控制精度高。
高效率和高扭矩:BLDC电机具有高效率和高扭矩密度,适合需要快速响应和大扭矩的应用。
低维护:由于没有物理接触的电刷和换向器,维护需求低。
良好的控制性能:BLDC电机可以精确控制速度和位置,适合闭环控制系统。
Arduino平台兼容性:利用Arduino的灵活性和丰富的库支持,可以方便地实现对BLDC电机的控制。

2、应用场景:
机器人:在机器人技术中,BLDC电机用于精确控制机器人的关节和运动。
无人机:无人机(UAV)使用BLDC电机来实现稳定和高效的飞行。
电动车辆:电动汽车和电动自行车利用BLDC电机提供动力和扭矩。
工业自动化:在自动化设备中,BLDC电机用于精确控制机械臂和传送带。
家用电器:一些高性能家电,如洗衣机和空调,使用BLDC电机来提高能效和性能。
医疗设备:医疗设备中的电机驱动,如手术工具和诊断设备,也采用BLDC电机。

3、需要注意的事项:
控制算法:需要合适的控制算法,如FOC(Field Oriented Control),来实现BLDC电机的最佳性能。
驱动器选择:根据电机的电压和电流规格选择合适的驱动器。
编码器集成:为了实现精确的速度和位置控制,可能需要集成编码器。
软件工具:使用Arduino IDE或其他软件工具来编写和上传控制代码。
电源管理:确保电源供应稳定且符合电机的工作要求。
热管理:设计合适的散热方案,以防止电机和驱动器过热。
电磁兼容性:注意电磁兼容性设计,减少对其他设备的干扰。
安全考虑:设计时要考虑人员安全和设备安全的保护措施。

通过上述详细解释,我们可以看到Arduino BLDC电机控制系统是一种高效、灵活且应用广泛的技术解决方案。在设计和实施过程中,需要注意选择合适的控制算法、驱动器、编码器以及考虑电源管理、热管理和电磁兼容性等关键因素。

在这里插入图片描述
1、主要特点:
噪声抑制效果好:自适应滤波能够有效抑制测量信号中的噪声,提高信号质量。
适应性强:滤波算法能够根据系统动态特性自动调整滤波参数,适应性强。
实时性高:自适应滤波计算量小,能够在Arduino等低功耗单片机上实现实时滤波。
易于实现:Arduino平台有现成的自适应滤波库函数,集成和调试相对简单。
鲁棒性强:自适应滤波对系统参数变化具有一定的抗干扰能力。

2、应用场景:
需要抑制噪声干扰的BLDC电机传感器信号,如编码器、霍尔效应传感器等。
对控制精度和动态响应性能要求较高的BLDC电机伺服系统。
在复杂工业环境下运行的BLDC电机驱动设备,抗干扰能力要求较强。
作为教学实践,展示如何利用Arduino实现BLDC电机传感器信号的自适应滤波。

3、需要注意的事项:
滤波算法选择:根据实际噪声特性选择Kalman滤波、LMS自适应滤波等合适的算法。
滤波参数调整:滤波算法的参数需要根据系统动态特性进行调试和优化。
滤波时间延迟:自适应滤波会引入一定的时间延迟,需要权衡滤波效果和实时性。
计算资源占用:自适应滤波算法在单片机上的计算量较大,需要评估处理能力。
与控制算法配合:自适应滤波应与角度/速度控制算法配合使用,发挥协同效果。
故障保护:滤波算法可能会掩盖传感器故障,需要有完善的故障检测机制。

在具体应用中,需要根据BLDC电机系统的噪声特性、动态特性等因素,选择合适的自适应滤波算法,并通过调试优化滤波参数,实现对传感器信号的高效噪声抑制。同时还需要关注滤波时间延迟、计算资源占用,以及与闭环控制算法的配合,确保系统的实时性和控制精度。对于一些对抗干扰能力和信号质量要求较高的BLDC电机应用,自适应滤波是一个很好的选择。

在这里插入图片描述

当使用自适应滤波算法实现Arduino BLDC控制时,以下是几个实际运用程序案例的参考代码和要点解读:

1、使用卡尔曼滤波进行状态估计

#include <Encoder.h>
#include <Wire.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_BNO055.h>
#include <utility/imumaths.h>

// 定义引脚和编码器对象
int encoderPinA = 2;
int encoderPinB = 3;
Encoder myEncoder(encoderPinA, encoderPinB);

// 定义IMU对象
Adafruit_BNO055 bno = Adafruit_BNO055(55);

// 定义目标角度和当前角度
double targetAngle = 90.0;
double currentAngle = 0.0;

// 定义卡尔曼滤波器参数
double Q_angle = 0.001;
double Q_gyro = 0.003;
double R_angle = 0.03;
double dt = 0.01;

// 定义卡尔曼滤波器变量
double angle = 0.0;
double bias = 0.0;
double P[2][2] = {{0.0, 0.0}, {0.0, 0.0}};

void setup() {
  // 初始化串口通信
  Serial.begin(9600);

  // 设置编码器引脚为输入模式
  pinMode(encoderPinA, INPUT);
  pinMode(encoderPinB, INPUT);

  // 初始化IMU
  if (!bno.begin())
  {
    Serial.print("No BNO055 detected");
    while (1);
  }

  // 设置IMU工作模式
  bno.setMode(Adafruit_BNO055::OPERATION_MODE_IMUPLUS);
}

void loop() {
  // 读取编码器值并计算当前角度
  int encoderValue = myEncoder.read();
  currentAngle = encoderValue * 0.1; // 根据编码器分辨率和时间间隔计算角度

  // 读取IMU数据
  sensors_event_t event;
  bno.getEvent(&event);

  // 使用卡尔曼滤波进行状态估计
  double rate = event.gyro.z * (PI / 180.0);
  angle += dt * (rate - bias);
  P[0][0] += dt * (dt * P[1][1] - P[0][1] - P[1][0] + Q_angle);
  P[0][1] -= dt * P[1][1];
  P[1][0] -= dt * P[1][1];
  P[1][1] += Q_gyro * dt;
  double y = currentAngle - angle;
  double S = P[0][0] + R_angle;
  double K[2];
  K[0] = P[0][0] / S;
  K[1] = P[1][0] / S;
  angle += K[0] * y;
  bias += K[1] * y;
  P[0][0] -= K[0] * P[0][0];
  P[0][1] -= K[0] * P[0][1];
  P[1][0] -= K[1] * P[0][0];
  P[1][1] -= K[1] * P[0][1];

  // 控制电机角度
  // ...

  // 打印调试信息
  Serial.print("Target Angle: ");
  Serial.print(targetAngle);
  Serial.print("   Current Angle: ");
  Serial.print(currentAngle);
  Serial.print("   Estimated Angle: ");
  Serial.println(angle);

  delay(10);
}

要点解读:
使用Encoder库,将编码器引脚与Arduino连接。
使用Adafruit_BNO055库,连接并初始化IMU传感器。
在setup()函数中,初始化串口通信、引脚模式和IMU工作模式。
在loop()函数中,读取编码器值并计算当前角度。
读取IMU的陀螺仪数据。
使用卡尔曼滤波算法进行状态估计,估计角度并更新滤波器的状态和协方差矩阵。
控制电机角度(代码中未给出具体实现)。
打印调试信息,包括目标角度、当前角度和估计角度。
延迟一段时间后重复执行。

2、使用滑动窗口平均滤波平滑电机速度

#include <Encoder.h>

// 定义引脚和编码器对象
int encoderPinA = 2;
int encoderPinB = 3;
Encoder myEncoder(encoderPinA, encoderPinB);

// 定义滑动窗口大小和数组
int windowSize = 5;
int speedWindow[5];
int windowIndex = 0;

void setup() {
  // 初始化串口通信
  Serial.begin(9600);

  // 设置编码器引脚为输入模式
  pinMode(encoderPinA, INPUT);
  pinMode(encoderPinB, INPUT);
}

void loop() {
  // 读取编码器值并计算速度
  int encoderValue = myEncoder.read();
  int currentSpeed = (encoderValue - speedWindow[windowIndex]) / windowSize;

  // 更新滑动窗口
  speedWindow[windowIndex] = encoderValue;
  windowIndex = (windowIndex + 1) % windowSize;

  // 控制电机速度
  // ...

  // 打印调试信息
  Serial.print("Current Speed: ");
  Serial.println(currentSpeed);

  delay(10);
}

要点解读:
使用Encoder库,将编码器引脚与Arduino连接。
定义滑动窗口的大小和一个整型数组来存储窗口内的编码器值。
在setup()函数中,初始化串口通信和引脚模式。
在loop()函数中,读取编码器值并根据当前值和窗口中的前一个值计算速度。
更新滑动窗口,将当前编码器值存储到窗口数组中,并更新窗口索引。
控制电机速度(代码中未给出具体实现)。
打印调试信息,包括当前速度。
延迟一段时间后重复执行。

3、使用中值滤波器减少电机转速的噪声

#include <Encoder.h>

// 定义引脚和编码器对象
int encoderPinA = 2;
int encoderPinB = 3;
Encoder myEncoder(encoderPinA, encoderPinB);

// 定义中值滤波器参数
int windowSize = 5;
int speedWindow[5];
int windowIndex = 0;

void setup() {
  // 初始化串口通信
  Serial.begin(9600);

  // 设置编码器引脚为输入模式
  pinMode(encoderPinA, INPUT);
  pinMode(encoderPinB, INPUT);
}

void loop() {
  // 读取编码器值并存储到滑动窗口
  int encoderValue = myEncoder.read();
  speedWindow[windowIndex] = encoderValue;
  windowIndex = (windowIndex + 1) % windowSize;

  // 使用冒泡排序对滑动窗口数据进行排序
  for (int i = 0; i < windowSize - 1; i++) {
    for (int j = 0; j < windowSize - i - 1; j++) {
      if (speedWindow[j] > speedWindow[j + 1]) {
        int temp = speedWindow[j];
        speedWindow[j] = speedWindow[j + 1];
        speedWindow[j + 1] = temp;
      }
    }
  }

  // 选择排序后的中间值作为电机速度
  int medianSpeed = speedWindow[(windowSize - 1) / 2];

  // 控制电机速度
  // ...

  // 打印调试信息
  Serial.print("Median Speed: ");
  Serial.println(medianSpeed);

  delay(10);
}

要点解读:
使用Encoder库,将编码器引脚与Arduino连接。
定义滑动窗口的大小和一个整型数组来存储窗口内的编码器值。
在loop()函数中,读取编码器值并将其存储到滑动窗口数组中。
使用冒泡排序算法对滑动窗口数据进行排序,以找到中间值。
选择排序后的中间值作为电机的速度值。
控制电机速度(代码中未给出具体实现)。
打印调试信息,包括中值速度。
延迟一段时间后重复执行。
这些案例展示了在Arduino BLDC控制中使用自适应滤波的不同应用。第一个案例使用卡尔曼滤波进行状态估计,以估计电机角度。第二个案例使用滑动窗口平均滤波平滑电机速度。第三个案例使用中值滤波器减少电机转速的噪声。这些滤波算法都可以根据特定的应用需求进行调整和优化,以实现更好的性能。

在这里插入图片描述

4、基于 PID 控制的关节角度闭环控制:

#include <PID_v1.h>

// BLDC 电机相关引脚定义
int enablePin = 9;
int in1Pin = 8;
int in2Pin = 7;

double setpoint, input, output;
PID myPID(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT);

void setup() {
  // BLDC 电机驱动初始化
  pinMode(enablePin, OUTPUT);
  pinMode(in1Pin, OUTPUT);
  pinMode(in2Pin, OUTPUT);

  // PID 控制器初始化
  myPID.SetMode(AUTOMATIC);
  myPID.SetOutputLimits(-255, 255);
}

void loop() {
  // 读取关节角度传感器,赋值给 input 变量
  input = getJointAngle(); 

  // 设置期望角度,赋值给 setpoint 变量
  setpoint = desiredAngle;

  // 执行 PID 计算,得到输出 output
  myPID.Compute();

  // 根据 PID 输出控制 BLDC 电机
  controlBLDCMotor(output);
}

void controlBLDCMotor(int motorPower) {
  // 根据 motorPower 的正负,设置电机正转或反转
  if (motorPower >= 0) {
    digitalWrite(in1Pin, HIGH);
    digitalWrite(in2Pin, LOW);
  } else {
    digitalWrite(in1Pin, LOW);
    digitalWrite(in2Pin, HIGH);
  }
  analogWrite(enablePin, abs(motorPower));
}

要点解读:
使用 PID 库实现基于关节角度传感器的闭环控制
input 为当前关节角度,setpoint 为期望角度
通过 PID 计算得到控制输出 output,用于驱动 BLDC 电机

5、基于自适应 PID 的关节角度闭环控制:

#include <PID_AutoTune_v0.h>

// BLDC 电机相关引脚定义
int enablePin = 9;
int in1Pin = 8;
int in2Pin = 7;

double setpoint, input, output;
PID_ATune aTune(&input, &output);

void setup() {
  // BLDC 电机驱动初始化
  pinMode(enablePin, OUTPUT);
  pinMode(in1Pin, OUTPUT);
  pinMode(in2Pin, OUTPUT);

  // 自适应 PID 初始化
  aTune.SetNoiseBand(1);
  aTune.SetOutputStep(10);
  aTune.SetLookbackSec(10);
}

void loop() {
  // 读取关节角度传感器,赋值给 input 变量
  input = getJointAngle();

  // 设置期望角度,赋值给 setpoint 变量
  setpoint = desiredAngle;

  // 执行自适应 PID 计算,得到输出 output
  if(!aTune.Runtime()) {
    Kp = aTune.GetKp();
    Ki = aTune.GetKi();
    Kd = aTune.GetKd();
    aTune.SetTunings(Kp, Ki, Kd);
  }

  // 根据 PID 输出控制 BLDC 电机
  controlBLDCMotor(output);
}

void controlBLDCMotor(int motorPower) {
  // 根据 motorPower 的正负,设置电机正转或反转
  if (motorPower >= 0) {
    digitalWrite(in1Pin, HIGH);
    digitalWrite(in2Pin, LOW);
  } else {
    digitalWrite(in1Pin, LOW);
    digitalWrite(in2Pin, HIGH);
  }
  analogWrite(enablePin, abs(motorPower));
}

要点解读:
使用自适应 PID 库实现关节角度闭环控制
自动调整 PID 参数,适应系统变化
input 为当前关节角度,setpoint 为期望角度
通过自适应 PID 计算得到控制输出 output,用于驱动 BLDC 电机

6、基于模糊控制的关节角度闭环控制:

#include <FuzzyController.h>

// BLDC 电机相关引脚定义
int enablePin = 9;
int in1Pin = 8;
int in2Pin = 7;

double input, output;
FuzzyController fuzzy;

void setup() {
  // BLDC 电机驱动初始化
  pinMode(enablePin, OUTPUT);
  pinMode(in1Pin, OUTPUT);
  pinMode(in2Pin, OUTPUT);

  // 模糊控制器初始化
  fuzzy.addInput("Angle Error", -180, 180);
  fuzzy.addInput("Angle Velocity", -180, 180);
  fuzzy.addOutput("Motor Power", -255, 255);

  fuzzy.addRule("Angle Error is Negative AND Angle Velocity is Negative", "Motor Power is Positive");
  fuzzy.addRule("Angle Error is Positive AND Angle Velocity is Positive", "Motor Power is Negative");
  // 添加更多模糊规则
}

void loop() {
  // 读取关节角度传感器,计算角度误差和角速度
  double angleError = setpoint - getJointAngle();
  double angleVelocity = (angleError - oldAngleError) / TIME_DELTA;
  oldAngleError = angleError;

  // 执行模糊控制计算,得到控制输出 output
  input = {angleError, angleVelocity};
  fuzzy.evaluate(input, output);

  // 根据模糊控制输出驱动 BLDC 电机
  controlBLDCMotor(output);
}

void controlBLDCMotor(int motorPower) {
  // 根据 motorPower 的正负,设置电机正转或反转
  if (motorPower >= 0) {
    digitalWrite(in1Pin, HIGH);
    digitalWrite(in2Pin, LOW);
  } else {
    digitalWrite(in1Pin, LOW);
    digitalWrite(in2Pin, HIGH);
  }
  analogWrite(enablePin, abs(motorPower));
}

要点解读:
使用模糊控制库实现关节角度闭环控制
输入变量为角度误差和角速度,输出为电机功率
通过定义模糊规则实现基于状态的控制策略
执行模糊推理计算得到控制输出 output,用于驱动 BLDC 电机
以上几个案例展示了基于 Arduino BLDC 驱动的关节角度闭环控制的不同实现方式,包括 PID 控制、自适应 PID 控制和模糊控制。可根据具体应用需求进行选择和优化。

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

在这里插入图片描述

  • 15
    点赞
  • 16
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

驴友花雕

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值