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