Arduino BLDC 无刷电机模糊逻辑避障控制实战

五传感器模糊巡墙

使用五个红外测距传感器，实现更精准的沿墙模糊控制。通过计算位置误差来修正转向。

// 传感器引脚 (模拟输入)
const int irLeftFar = A0, irLeftNear = A1;
const int irFront = A2;
const int irRightNear = A3, irRightFar = A4;
const int pwmLeft = 9, pwmRight = 10;

int error = 0; // 位置误差：负值偏左，正值偏右

void setup() {
  pinMode(pwmLeft, OUTPUT);
  pinMode(pwmRight, OUTPUT);
  Serial.begin(9600);
}

void loop() {
  int valLF = analogRead(irLeftFar);
  int valLN = analogRead(irLeftNear);
  int valF = analogRead(irFront);
  int valRN = analogRead(irRightNear);
  int valRF = analogRead(irRightFar);

  // 模糊化处理：计算误差
  if (valLN > 600) error = -2;      // 偏左严重
  else if (valLN > 400) error = -1; // 偏左一点
  else if (valRN > 600) error = 2;  // 偏右严重
  else if (valRN > 400) error = 1;  // 偏右一点
  else if (valF > 500) error = 10;  // 前方有障碍
  else error = 0;                   // 居中

  // 模糊输出：计算转向修正量
  int correction = 0;
  switch (error) {
    case -2: correction = -120; break; // 急右转
    case -1: correction = -60; break;  // 缓右转
    case 0: correction = 0; break;     // 直行
    case 1: correction = 60; break;    // 缓左转
    case 2: correction = 120; break;   // 急左转
    case 10: correction = 180; break;  // 遇到前方障碍，左大转
  }

  int baseSpeed = 150;
  int leftSpeed = baseSpeed + correction;
  int rightSpeed = baseSpeed - correction;

  leftSpeed = constrain(leftSpeed, 0, 255);
  rightSpeed = constrain(rightSpeed, 0, 255);
  analogWrite(pwmLeft, leftSpeed);
  analogWrite(pwmRight, rightSpeed);

  Serial.print("Error: "); Serial.print(error);
  Serial.print(" | L: "); Serial.print(leftSpeed);
  Serial.print(" | R: "); Serial.println(rightSpeed);
  delay(50);
}

带输出平滑滤波的模糊控制

在模糊逻辑输出后加入低通滤波，消除传感器噪声导致的电机高频抖动。这是实际调试中非常关键的一步。

// 滤波参数
float alpha = 0.3; // 滤波系数 (0-1), 越大越平滑，但响应越慢
int filteredBias = 0;
int lastBias = 0;

void loop() {
  int distL = getDistance(trigL, echoL);
  int distF = getDistance(trigF, echoF);
  int distR = getDistance(trigR, echoR);

  // 模糊逻辑计算 rawBias
  int rawBias = 0;
  if (distF < 20) {
    rawBias = (distL > distR) ? -150 : 150;
  } else if (distL < 15) {
    rawBias = 80;
  } else if (distR < 15) {
    rawBias = -80;
  }

  // 一阶低通滤波：filtered = alpha * new + (1-alpha) * old
  filteredBias = alpha * rawBias + (1 - alpha) * lastBias;
  lastBias = filteredBias;

  // 只有当偏差变化足够大时才更新电机，减少微小抖动
  if (abs(filteredBias - lastBias) > 5) {
    int baseSpeed = 180;
    int leftSpeed = baseSpeed + filteredBias;
    int rightSpeed = baseSpeed - filteredBias;
    leftSpeed = constrain(leftSpeed, 0, 255);
    rightSpeed = constrain(rightSpeed, 0, 255);
    analogWrite(pwmLeft, leftSpeed);
    analogWrite(pwmRight, rightSpeed);
  }
  delay(50);
}

基于 SimpleFOC 的 BLDC 控制

使用 SimpleFOC 库驱动无刷电机，结合超声波传感器实现更专业的速度控制。

#include <SimpleFOC.h>
#include <NewPing.h>

#define TRIGGER_PIN 12
#define ECHO_PIN 11
#define MAX_DISTANCE 200
NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

BLDCMotor motor = BLDCMotor(7); // 7 极对数
BLDCDriver3PWM driver = BLDCDriver3PWM(5, 6, 7);

float distance, leftSpeed, rightSpeed;

void fuzzyControl() {
  if (distance < 10) {       // 极近
    leftSpeed = -0.5; rightSpeed = -0.5; // 后退
  } else if (distance < 30) { // 近
    leftSpeed = 0.3; rightSpeed = -0.3;  // 右转
  } else if (distance < 50) { // 中等
    leftSpeed = 0.5; rightSpeed = 0.5;   // 前进
  } else {                    // 远
    leftSpeed = 0.8; rightSpeed = 0.8;   // 快速前进
  }
}

void setup() {
  Serial.begin(115200);
  driver.init();
  motor.linkDriver(&driver);
  motor.controller = MotionControlType::velocity;
  motor.init();
  motor.initFOC();
}

void loop() {
  distance = sonar.ping_cm();
  if (distance == 0) distance = MAX_DISTANCE;

  fuzzyControl();
  motor.move(leftSpeed);
  delay(100);
}

调试与优化要点

• 模糊化输入：将原始距离转换为模糊集合（如'近''远'）。多传感器融合能避免单一传感器的局限性。
• 规则互斥：确保规则之间没有严重冲突。例如，不能同时存在'左边近则左转'和'左边近则右转'的规则。
• 去模糊化方法：重心法最常用，输出平滑；最大值平均法计算简单但可能跳变。资源有限平台可用查表法或简化规则。
• 可视化调试：利用 Arduino IDE 的串口绘图器观察输入变量和模糊输出曲线，确保规则触发合理。

工程安全提示

以上案例旨在拓展思路，实际应用中请务必注意：

1. 硬件适配：不同版本的 Arduino 或传感器引脚定义可能不同，请根据实际硬件调整。
2. 安全优先：涉及硬件操作前，确认引脚电平和连接安全性。务必预留急停机制，防止软件跑飞导致设备损坏。
3. 多次测试：代码可能存在编译错误或逻辑缺陷，需在真实环境中反复验证并调整参数。