Arduino BLDC 使用 6.5 寸轮毂电机的智能动态跟随机器人底盘
基于 Arduino 与 6.5 寸轮毂电机的智能动态跟随机器人底盘，是一种将一体化高扭矩动力单元与实时感知决策系统深度融合的移动平台方案。该方案利用轮毂电机'轮内驱动'的紧凑特性，结合 Arduino（或 ESP32 等兼容主控）的灵活控制能力，旨在实现对人、车或特定目标的平滑、抗扰、低延迟的伴随运动。
一、主要特点
1. 一体化高扭矩动力架构
- 直驱/准直驱结构：6.5 寸轮毂电机将 BLDC 电机、行星减速器（常见速比 1:10~1:30）、轮毂及轴承高度集成。省去了皮带、链条等中间传动环节，传动效率高（>85%），结构紧凑，底盘离地间隙低，重心稳。
- 大扭矩低速特性：得益于内置减速，轮毂电机在低转速下可输出极大扭矩（峰值可达 8
25 N·m），能轻松驱动 3080kg 级底盘，具备良好的爬坡（<5°）和越障（过坎）能力，且低速运行平稳无顿挫。 - 自带霍尔反馈：电机内置霍尔传感器，可直接用于测速和转向判断，无需外接编码器即可实现速度闭环控制，为里程计（Odometry）提供基础数据。
2. 多模态动态感知融合
- 无线信号定位（BLE/UWB）：利用蓝牙 RSSI（信号强度）或 UWB（超宽带）TOF（飞行时间）技术，精确测量与目标标签的距离和角度，实现非接触式'电子牵绳'跟随。
- 视觉/激光辅助：结合 OpenCV 进行人脸/特征点识别，或利用激光雷达/ToF 传感器进行轮廓跟踪与避障，确保在复杂动态环境中不跟丢、不碰撞。
- IMU 姿态补偿：内置 MPU6050 等 IMU，通过卡尔曼滤波融合数据，补偿底盘在加速/刹车时的俯仰/横滚姿态，防止因重心偏移导致的控制失稳。
3. 分层式智能控制策略
- 上层：轨迹规划：根据感知到的目标相对位姿（距离、方位角、速度），规划出期望的底盘线速度与角速度。
- 底层：差速 PID 闭环：Arduino 主控接收上层指令，通过双路 PID 控制器分别调节左右轮毂电机的转速，利用差速运动学实现前进、后退、原地旋转及任意半径转向，响应速度快，机动性强。
二、核心应用场景
- 智能物流搬运（人机协同 AGV）：在仓库或产线，底盘作为跟随式 AGV，自动尾随工人进行物料配送，解放双手，提升拣选效率。
- 服务与接待机器人：在商场、酒店、机场，作为智能行李车或导览车，自动跟随顾客移动，提供物品寄存或引导服务。
- 安防巡检与特种作业：在园区或危险区域，作为移动监控平台，伴随安保人员巡逻，或跟随排爆人员运送设备，保持安全距离。
- 科研与教育平台：作为 ROS（机器人操作系统）、SLAM（同步定位与建图）、多传感器融合算法的验证平台，用于高校教学与竞赛。
三、注意事项与关键技术挑战
1. 电源管理与电磁兼容（EMC）
- 独立供电：轮毂电机启动电流极大（峰值可达 10A 以上），严禁使用同一路电源直接为 Arduino 及传感器供电，否则电压跌落将导致 MCU 复位。必须采用隔离 DC-DC 模块（如 24V 转 5V）为控制电路单独供电。
- 去耦电容：在 ESC（电调）电源输入端并联大容量低 ESR 电解电容（1000μF~4700μF），吸收电机换向产生的反电动势尖峰，稳定母线电压。
- 布线抗干扰：动力线（粗）与信号线（细）必须分开走线，避免平行布线，最好垂直交叉。霍尔线、IMU 线需使用屏蔽线，防止 PWM 噪声干扰传感器读数。
2. 控制算法的实时性与平滑性
- 主控算力升级：标准的 Arduino Uno（ATmega328P）处理复杂的传感器融合（如卡尔曼滤波）和多路 PID 闭环时可能力不从心。推荐使用 ESP32（双核，可一核处理通信一核处理控制）或 Teensy 4.0 等高算力板卡，确保控制频率≥50Hz。
- S 曲线加减速：直接给阶跃速度指令会导致电机冲击大、轮胎打滑。必须采用 S 型速度规划，限制加加速度（Jerk），使速度曲线平滑过渡，提升乘坐舒适性和跟随精度。
- 抗积分饱和：在目标突然消失或被障碍物阻挡时，PID 积分项会累积导致电机'飞车'。必须设置积分限幅和失控保护逻辑（如信号丢失超时自动刹车）。
3. 机械安装与轮胎选型
- 轴刚性固定：6.5 寸轮毂电机通常通过 16mm 轴或法兰固定。必须使用紧定螺钉 + 夹紧套或刚性连接板确保轴不松动，任何晃动都会导致霍尔测速不准和底盘跑偏。
- 轮胎匹配：PU 实心胎适合室内平坦地面，控制精准、不爆胎；橡胶充气胎适合室外不平地面，减震好、越障强，但需注意胎压，气压不足会影响里程计精度。
4. 安全冗余机制
- 硬件急停：必须设计独立的硬件急停回路（如串联急停按钮），当触发时直接切断电机供电，优先级高于软件逻辑。
- 软件限幅：在代码中限制 PWM 输出最大值，防止因算法 bug 输出全速指令；同时设置软件限位，防止机器人冲出安全区域。
四、核心实现案例
1、基于 UWB 超宽带定位的差速跟随（PID 控制）
功能：通过 UWB 模块（如 DW1000）获取目标与机器人的相对位置，使用 PID 算法控制轮毂电机实现平滑跟随。 硬件：
- Arduino Mega/Due（支持多串口）
- 2×BLDC 轮毂电机（6.5 寸，带编码器）
- 2×SimpleFOC Shield（驱动电机）
- DW1000 UWB 模块×2（主从机）
#include <SimpleFOC.h>
#include <DW1000.h>
// UWB 库（需自行实现或使用第三方库）
// 左轮电机
BLDCMotor leftMotor(7);
BLDCDriver3PWM leftDriver(9, 10, 11, 8);
MagneticSensorI2C leftEncoder(AS5600_I2C);
// 右轮电机
BLDCMotor rightMotor(12);
BLDCDriver3PWM rightDriver(13, 14, 15, 16);
MagneticSensorI2C rightEncoder(AS5600_I2C);
// UWB 定位参数
float targetX = 0, targetY = 0; // 目标坐标（通过 UWB 更新）
float robotX = 0, robotY = 0; // 机器人坐标
float desiredDistance = 1.0; // 期望跟随距离（米）
float desiredAngle = 0; // 期望朝向（弧度）
// PID 参数
float Kp_dist = 0.8, Ki_dist = 0.05, Kd_dist = 0.1;
Kp_angle = , Ki_angle = , Kd_angle = ;
{
leftMotor.(&leftEncoder);
leftMotor.(&leftDriver);
leftMotor.controller = MotionControlType::velocity;
leftMotor.PID_velocity.P = ;
leftMotor.();
rightMotor.(&rightEncoder);
rightMotor.(&rightDriver);
rightMotor.controller = MotionControlType::velocity;
rightMotor.PID_velocity.P = ;
rightMotor.();
DW(Serial1);
DW();
Serial.();
}
{
(DW()) {
dist, angle;
DW(&dist, &angle);
targetX = robotX + dist * (angle);
targetY = robotY + dist * (angle);
}
dx = targetX - robotX;
dy = targetY - robotY;
currentDistance = (dx * dx + dy * dy);
currentAngle = (dy, dx);
errorDist = desiredDistance - currentDistance;
errorAngle = desiredAngle - currentAngle;
errorAngle = (errorAngle > PI) ? errorAngle - * PI : (errorAngle < -PI) ? errorAngle + * PI : errorAngle;
integralDist = , integralAngle = ;
derivativeDist = (errorDist - lastErrorDist) / ;
derivativeAngle = (errorAngle - lastErrorAngle) / ;
outputDist = Kp_dist * errorDist + Ki_dist * integralDist + Kd_dist * derivativeDist;
outputAngle = Kp_angle * errorAngle + Ki_angle * integralAngle + Kd_angle * derivativeAngle;
integralDist += errorDist * ;
integralAngle += errorAngle * ;
lastErrorDist = errorDist;
lastErrorAngle = errorAngle;
baseSpeed = outputDist * ;
turnRate = outputAngle * ;
leftSpeed = baseSpeed - turnRate;
rightSpeed = baseSpeed + turnRate;
leftMotor.(leftSpeed);
rightMotor.(rightSpeed);
robotX += (leftSpeed + rightSpeed) * * (currentAngle) / ;
robotY += (leftSpeed + rightSpeed) * * (currentAngle) / ;
();
}
2、基于 OpenMV 视觉的色块跟随（纯追踪算法）
功能：通过 OpenMV 摄像头识别特定颜色色块，计算机器人与目标的相对位置，使用纯追踪算法控制轮毂电机。 硬件：
- Arduino Nano 33 BLE Sense（支持 I2C/UART）
- OpenMV Cam H7（带 UART 输出）
- 2×BLDC 轮毂电机（6.5 寸）
- SimpleFOC Shield
#include <SimpleFOC.h>
// 电机初始化（同案例 1）
BLDCMotor leftMotor(7);
BLDCDriver3PWM leftDriver(9, 10, 11, 8);
MagneticSensorI2C leftEncoder(AS5600_I2C);
BLDCMotor rightMotor(12);
BLDCDriver3PWM rightDriver(13, 14, 15, 16);
MagneticSensorI2C rightEncoder(AS5600_I2C);
// 视觉参数
float targetX = 160, targetY = 120; // OpenMV 图像中心坐标（320x240）
float lookaheadRatio = 0.5; // 预瞄点比例（0~1）
void setup() {
// 电机初始化
leftMotor.linkSensor(&leftEncoder);
leftMotor.linkDriver(&leftDriver);
leftMotor.controller = MotionControlType::velocity;
leftMotor.initFOC();
rightMotor.linkSensor(&rightEncoder);
rightMotor.linkDriver(&rightDriver);
rightMotor.controller = MotionControlType::velocity;
rightMotor.initFOC();
Serial2.begin();
Serial.();
}
{
(Serial() > ) {
String msg = Serial();
commaIndex = msg.();
targetX = msg.(, commaIndex).();
targetY = msg.(commaIndex + ).();
}
imageCenterX = , imageCenterY = ;
dx = targetX - imageCenterX;
dy = targetY - imageCenterY;
angleToTarget = (dy, dx);
robotAngle = ;
globalAngle = angleToTarget + robotAngle;
baseSpeed = ;
turnGain = ;
errorAngle = globalAngle;
leftMotor.(baseSpeed - errorAngle * turnGain);
rightMotor.(baseSpeed + errorAngle * turnGain);
Serial.();
Serial.(targetX);
Serial.();
Serial.(targetY);
Serial.();
Serial.(angleToTarget * / PI);
();
}
3、基于激光雷达的 SLAM 跟随（动态避障）
功能：通过 RPLIDAR A1 获取环境点云，使用 SLAM 算法定位机器人与目标，结合 A*路径规划实现动态避障跟随。 硬件：
- Arduino Portenta H7（高性能 MCU）
- RPLIDAR A1（通过 UART 连接）
- 2×BLDC 轮毂电机（6.5 寸）
- SimpleFOC Shield
#include <SimpleFOC.h>
#include <RPLidar.h>
// 需自行实现或使用第三方库
// 电机初始化（同案例 1）
BLDCMotor leftMotor(7);
BLDCDriver3PWM leftDriver(9, 10, 11, 8);
MagneticSensorI2C leftEncoder(AS5600_I2C);
BLDCMotor rightMotor(12);
BLDCDriver3PWM rightDriver(13, 14, 15, 16);
MagneticSensorI2C rightEncoder(AS5600_I2C);
// 激光雷达参数
RPLidar lidar;
float robotPos[2] = {0, 0}; // 机器人位置（通过 SLAM 更新）
float targetPos[2] = {2, 0}; // 目标位置
float path[100][2]; // 存储路径点
int pathLength = 0;
void setup() {
// 电机初始化
leftMotor.linkSensor(&leftEncoder);
leftMotor.(&leftDriver);
leftMotor.controller = MotionControlType::velocity;
leftMotor.();
rightMotor.(&rightEncoder);
rightMotor.(&rightDriver);
rightMotor.controller = MotionControlType::velocity;
rightMotor.();
lidar.(Serial2);
Serial.();
}
{
(lidar.()) {
scanData[][];
lidar.(scanData);
(scanData);
(robotPos, targetPos, path, &pathLength);
}
(pathLength > ) {
;
;
lookaheadDist = + (pathLength > ? : );
Vector2 lookahead = (currentPos, nextPoint, lookaheadDist);
dx = lookahead.x - robotPos[];
dy = lookahead.y - robotPos[];
angleToTarget = (dy, dx);
baseSpeed = ;
turnRate = angleToTarget * ;
leftMotor.(baseSpeed - turnRate);
rightMotor.(baseSpeed + turnRate);
}
();
}
{}
{}
{}
4、基于超声波与 PID 的恒距平滑跟随
功能描述：这是最经典的跟随方案。利用超声波测距，通过 PID 算法将距离误差转化为电机速度指令。相比简单的'近了就退，远了就进'，PID 能让底盘在接近目标时自动减速，实现平滑停靠，避免急停急启造成的晃动。
#include <SimpleFOC.h>
// --- 硬件定义 ---
// 假设使用 SimpleFOC 驱动 6.5 寸轮毂电机
BLDCMotor motorL(7); // 7 对极电机
BLDCMotor motorR(7);
// 驱动器引脚需根据实际板卡定义
BLDCDriver3PWM driverL(9, 10, 11, 8);
BLDCDriver3PWM driverR(5, 6, 7, 4);
// 超声波引脚
#define TRIG_PIN 2
#define ECHO_PIN 3
// --- 跟随参数 ---
const float TARGET_DIST = 50.0; // 目标跟随距离 (cm)
const float MAX_DIST = 200.0; // 最大检测距离
const float MIN_DIST = 20.0; // 最小安全距离
// --- PID 控制器 ---
// 输入是距离误差，输出是电机速度
float Kp = 2.0, Ki = 0.0, Kd = 1.0; // 需实测整定
float lastError = 0;
float integral = 0;
{
Serial.();
(TRIG_PIN, OUTPUT);
(ECHO_PIN, INPUT);
driverL.voltage_power_supply = ;
driverL.();
motorL.(&driverL);
motorL.();
motorL.();
driverR.voltage_power_supply = ;
driverR.();
motorR.(&driverR);
motorR.();
motorR.();
}
{
(TRIG_PIN, LOW);
();
(TRIG_PIN, HIGH);
();
(TRIG_PIN, LOW);
duration = (ECHO_PIN, HIGH, );
(duration * ) / ;
}
{
distance = ();
(distance > MAX_DIST || distance < ) {
motorL.();
motorR.();
;
}
error = distance - TARGET_DIST;
integral += error;
derivative = error - lastError;
speedCmd = (Kp * error) + (Ki * integral) + (Kd * derivative);
lastError = error;
((speedCmd) < ) speedCmd = ;
speedCmd = (speedCmd, , );
motorL.(speedCmd);
motorR.(speedCmd);
motorL.();
motorR.();
();
}
5、基于蓝牙 RSSI 信号强度的定向跟随
功能描述：利用蓝牙模块（如 HC-05）的信号强度指示（RSSI）来判断目标的远近。信号越强（数值越接近 0）代表越近，信号越弱（负值越大）代表越远。这是一种低成本、无需视觉的'盲跟随'方案。
#include <SoftwareSerial.h>
// --- 硬件定义 ---
SoftwareSerial btSerial(10, 11); // RX, TX 连接蓝牙模块
// --- 跟随参数 ---
const int RSSI_TARGET = -40; // 目标信号强度 (dBm)，需实测校准
const int RSSI_TOO_CLOSE = -20; // 太近阈值
const int RSSI_TOO_FAR = -70; // 太远阈值
// --- 电机控制 ---
const int MOTOR_L_PWM = 9;
const int MOTOR_R_PWM = 10;
const int MOTOR_L_DIR = 2;
const int MOTOR_R_DIR = 3;
void setup() {
Serial.begin(9600);
btSerial.begin(9600); // 蓝牙波特率通常为 9600 或 38400
pinMode(MOTOR_L_PWM, OUTPUT);
pinMode(MOTOR_R_PWM, OUTPUT);
pinMode(MOTOR_L_DIR, OUTPUT);
pinMode(MOTOR_R_DIR, OUTPUT);
// 初始化电机方向...
}
void loop() {
// 1. 读取 RSSI (AT 指令模式或特定模块会自动上报)
rssi = ();
(rssi == ) ;
speed = ;
(rssi > RSSI_TOO_CLOSE) {
speed = ;
(MOTOR_L_DIR, LOW);
(MOTOR_R_DIR, LOW);
} (rssi < RSSI_TOO_FAR) {
speed = ;
(MOTOR_L_DIR, HIGH);
(MOTOR_R_DIR, HIGH);
} {
speed = (rssi, RSSI_TOO_FAR, RSSI_TARGET, , );
(MOTOR_L_DIR, HIGH);
(MOTOR_R_DIR, HIGH);
}
(MOTOR_L_PWM, (speed));
(MOTOR_R_PWM, (speed));
Serial.();
Serial.(rssi);
Serial.();
Serial.(speed);
();
}
{
;
}
6、多传感器融合与防碰撞急停
功能描述：单纯的跟随容易发生碰撞。本案例在跟随的基础上，增加了前后双超声波检测，构建了一个简单的'安全包围盒'。一旦检测到前方有突发障碍物或后方有人靠近，立即触发急停或避让逻辑，提升安全性。
#include <NewPing.h>
// --- 传感器定义 ---
#define SONAR_NUM 2
#define TRIG_PIN_FRONT 2
#define ECHO_PIN_FRONT 3
#define TRIG_PIN_REAR 4
#define ECHO_PIN_REAR 5
#define MAX_DIST 200
NewPing sonar[SONAR_NUM] = {
NewPing(TRIG_PIN_FRONT, ECHO_PIN_FRONT, MAX_DIST),
NewPing(TRIG_PIN_REAR, ECHO_PIN_REAR, MAX_DIST)
};
// --- 安全阈值 ---
const int STOP_DIST_FRONT = 30; // 前方急停距离
const int STOP_DIST_REAR = 20; // 后方急停距离
// --- 电机状态 ---
int motorSpeed = 0;
void setup() {
Serial.begin(9600);
// 初始化电机驱动...
}
void loop() {
// 1. 读取传感器 (分时触发避免干扰)
delay(50);
unsigned int distFront = sonar[0].ping_cm();
delay(50);
unsigned int distRear = sonar[1].ping_cm();
((distFront > && distFront < STOP_DIST_FRONT) || (distRear > && distRear < STOP_DIST_REAR)) {
motorSpeed = ;
(, );
Serial.();
;
}
(distFront > && distFront < MAX_DIST) {
(distFront > ) {
motorSpeed = ;
} {
motorSpeed = ;
}
(motorSpeed, motorSpeed);
}
Serial.();
Serial.(distFront);
Serial.();
Serial.(distRear);
}
{
}
五、要点解读
- 轮毂电机的 FOC 控制优势：案例 4 使用了 SimpleFOC 库。6.5 寸轮毂电机通常是无刷电机（BLDC），相比传统直流电机，使用 FOC（磁场定向控制）能实现极低速下的平稳运行和精准扭矩控制。这对于跟随机器人至关重要，因为它能避免低速跟随时的'顿挫感'。
- PID 在距离控制中的应用：在案例 4 中，我们不是简单地控制'动'或'停'，而是控制'速度'。PID 算法将距离误差转化为速度指令。当距离远时速度快，距离近时速度慢，到达目标距离时速度为 0，这种平滑过渡是提升用户体验的关键。
- RSSI 跟随的局限与校准：案例 5 利用蓝牙信号强度（RSSI）跟随，成本极低，但受环境影响大（多径效应）。关键点在于校准：不同的手机、不同的蓝牙模块，其信号强度基准不同。必须在实际环境中测试，找到'舒适距离'对应的 RSSI 值（如 -40dBm），并设置合理的死区。
- 多传感器抗干扰设计：案例 6 使用了 NewPing 库并加入了 delay 分时触发。这是因为超声波传感器在发射声波时会产生机械振动，如果多个传感器同时触发，回波会相互干扰（串扰）。通过分时读取（例如间隔 50ms），可以确保数据的准确性。
- 安全冗余机制：在涉及大功率轮毂电机的应用中，惯性很大，刹车距离长。案例 6 展示了'安全包围盒'的概念：不仅要看前面（跟随目标），还要看后面（防止被撞击）和侧面。一旦检测到任何方向的突发障碍，急停逻辑的优先级必须高于跟随逻辑，这是机器人安全设计的铁律。
请注意：以上案例仅作为思路拓展的参考示例，不保证完全正确、适配所有场景或可直接编译运行。由于硬件平台、实际使用场景、Arduino 版本的差异，均可能影响代码的适配性与使用方法的选择。在实际编程开发时，请务必根据自身硬件配置、使用场景及具体功能需求进行针对性调整，并通过多次实测验证效果；同时需确保硬件接线正确，充分了解所用传感器、执行器等设备的技术规范与核心特性。对于涉及硬件操作的代码，使用前务必核对引脚定义、电平参数等关键信息的准确性与安全性，避免因参数错误导致硬件损坏或运行异常。
