1. 项目概述当“小尚”学会自己走“小尚别跟丢了”——这听起来像是一个人对宠物的呼唤但在我们电子爱好者和创客的圈子里它代表着一个充满趣味和挑战的项目一台基于麦克纳姆轮、能够实现自动跟随功能的小车。麦克纳姆轮这个听起来有点“黑科技”的轮子赋予了小车全向移动的能力可以像螃蟹一样横着走原地旋转让跟随动作更加灵活和精准。而“自动跟随”则是让这台小车摆脱遥控器的束缚像一个忠实的伙伴通过传感器感知你的位置并自主调整运动轨迹紧紧跟在你身后。这个项目融合了机械结构、电子控制和软件算法是学习机器人技术、嵌入式开发和自动控制的绝佳实践平台。无论是对于参加电子设计竞赛如电赛中的智能送药小车、物流小车等题目的学生还是对于想要深入理解PID控制、传感器融合、运动学解算的爱好者都具有很高的参考价值。它不仅仅是一个玩具更是一个微缩的智能移动机器人原型其核心思想可以扩展到AGV自动导引运输车、服务机器人等更广阔的领域。接下来我将从设计思路到代码实现完整拆解如何让“小尚”真正聪明地跟上来。2. 核心方案设计与硬件选型解析2.1 整体系统架构设计要让小车实现自动跟随核心是形成一个完整的感知-决策-执行的闭环系统。我们的“小尚”也不例外其系统架构可以清晰地划分为三个层次感知层负责“看”到目标也就是你。这是小车的眼睛。常见的方案有超声波测距、红外线、蓝牙RSSI信号强度以及视觉摄像头。考虑到成本、复杂度和环境适应性对于入门和中等复杂度的项目超声波结合蓝牙信标或纯超声波阵列是性价比很高的选择。超声波模块如HC-SR04价格低廉测距相对准确且不受环境光线影响。而通过多个模块组成阵列可以判断目标的大致方位。决策层负责“思考”该怎么做。这是小车的大脑。我们通常使用一款微控制器如Arduino、STM32 或 micro:bit。它接收来自感知层的距离和方位数据运行核心的跟随算法计算出小车当前应该执行的运动指令例如向前30%速度同时向右旋转15%速度。micro:bit因其内置蓝牙、加速度计、磁力计且编程环境Makecode/JavaScript/Python对新手友好在本项目中是一个非常有吸引力的选择。执行层负责“行动”。这是小车的四肢。核心就是麦克纳姆轮和配套的电机驱动。麦克纳姆轮由许多倾斜的小辊子组成通过四个轮子不同的转速和方向组合可以实现平面内任意方向的移动。这需要电机驱动板如L298N、TB6612FNG或更专业的麦克纳姆轮驱动板来驱动四个直流电机。为什么选择麦克纳姆轮而不是普通轮普通差速小车两个驱动轮要实现跟随特别是侧向移动调整位置时需要频繁地前进、后退加旋转动作生硬路径不流畅。而麦克纳姆轮小车可以直接进行横向平移在调整与目标的相对位置时更加直接、高效和平稳这使得跟随算法可以更简洁效果也更“优雅”。2.2 关键硬件组件选型与考量主控板micro:bit v2优势内置蓝牙5.0便于后期扩展手机APP遥控或蓝牙信标跟随内置加速度计和磁力计可用于辅助校准或提供更多数据Makecode图形化编程和Python文本编程降低了入门门槛社区资源丰富。注意micro:bit的GPIO口和计算能力对于复杂的多传感器融合算法可能稍显吃力但对于基础的超声波跟随完全足够。若需要运行更复杂的滤波算法如卡尔曼滤波或视觉处理STM32系列如STM32F4是更强大的选择。感知模块HC-SR04超声波传感器 × 3布局采用前、左、右三个方向的布局。正前方的传感器用于检测与目标的距离决定跟随的“紧迫度”左右两侧的传感器用于判断目标是否在中心线上决定横向平移的“方向”。这是实现平面内跟随的最小有效传感器配置。参数测量范围2cm-400cm精度约3mm。需注意其波束角较大约15度可能同时检测到非目标物体需要通过软件设置合理的检测阈值和滤波。执行单元麦克纳姆轮套件 直流减速电机 电机驱动板麦克纳姆轮选择45mm或60mm直径的较为常见。务必分清“左旋”和“右旋”轮子并按照“X”型或“O”型布局正确安装这是实现全向移动的基础。直流减速电机建议选择带编码器的版本。虽然基础跟随可以不用编码器但编码器能提供精确的转速反馈是实现更高级闭环速度控制、提升运动精度的关键。额定电压需与你的电池匹配常用6V或12V。电机驱动板TB6612FNG是比经典L298N更好的选择。它效率更高发热量小支持更大电流单路1.2A并且内置待机与刹车功能控制逻辑更清晰。一个TB6612可以驱动两个电机因此本项目需要两块。电源系统18650锂电池组 降压模块电机驱动需要较高的电压如7.4V或11.1V以获得足够的扭矩和速度。而micro:bit和传感器需要稳定的5V或3.3V。方案使用两节或三节18650锂电池串联组成电池组7.4V或11.1V直接供给电机驱动板。同时通过一个DC-DC降压模块如LM2596将电池电压降至稳定的5V为micro:bit和传感器供电。务必确保电源功率充足电机启动瞬间电流很大劣质电源或容量不足的电池会导致系统复位。注意电机驱动逻辑。控制麦克纳姆轮需要理解“运动学逆解”。简单说就是给定一个期望的速度矢量包括X方向速度、Y方向速度、自转速度通过一个固定的公式计算出四个轮子各自应有的转速。这个计算需要在主控板的代码中完成。网上有现成的计算库但理解其原理至关重要。3. 运动学原理与核心算法实现3.1 麦克纳姆轮运动学解算这是项目的数学核心。我们定义小车自身的坐标系前进方向为Y轴正方向向右平移方向为X轴正方向逆时针旋转为正。假设我们期望小车以速度Vx右为正、Vy前为正、ω逆时针为正运动。四个轮子分别位于左前(LF)、右前(RF)、左后(LB)、右后(RB)。对于常见的“X”型布局从上方看辊子轴线指向车体中心运动学逆解公式如下速度_LF -Vx Vy ω * K 速度_RF Vx Vy - ω * K 速度_LB Vx Vy ω * K 速度_RB -Vx Vy - ω * K其中K是一个与小车轮距和轴距相关的常数通常为(轮距轴距)/2。公式中的正负号取决于轮子旋向和安装方向上述公式是一种常见配置。你需要根据自己轮子的实际旋向和安装方式可能需要对公式进行微调。在代码中我们需要实现一个函数输入Vx, Vy, ω输出四个电机的PWM占空比值。注意计算出的速度值需要映射到电机驱动PWM的有效范围例如-255到255。# 示例基于micro:bit的简化Python代码片段 def mecanum_calculate(vx, vy, omega): # K 为小车结构常数需要根据实际测量调整 K 0.15 # 计算各轮理论速度 speed_lf -vx vy omega * K speed_rf vx vy - omega * K speed_lb vx vy omega * K speed_rb -vx vy - omega * K # 归一化处理防止超过PWM最大值 max_speed max(abs(speed_lf), abs(speed_rf), abs(speed_lb), abs(speed_rb), 1) scale 255.0 / max_speed # 返回映射后的PWM值假设驱动板支持正负控制 pwm_lf int(speed_lf * scale) pwm_rf int(speed_rf * scale) pwm_lb int(speed_lb * scale) pwm_rb int(speed_rb * scale) return pwm_lf, pwm_rf, pwm_lb, pwm_rb3.2 自动跟随控制算法设计跟随算法的本质是一个闭环控制系统。我们以三超声波方案为例设定目标状态我们希望目标人物位于小车正前方并保持一个安全的跟随距离D_target例如50厘米。获取当前状态通过三个超声波传感器我们得到前方距离D_front左侧距离D_left右侧距离D_right。为了简化我们可以用D_left - D_right的差值来近似判断目标中心的横向偏移。计算误差距离误差E_distance D_front - D_target如果人在前面D_front变小误差为负小车需要后退不在跟随场景中通常我们只处理人在前方的情况即D_front 某个最小阈值。如果人太近小车应停止或后退如果人远了小车应前进。这里我们定义一个“死区”只有当D_front大于D_target 死区时才前进小于D_target - 死区时才后退或停止。方位误差E_heading D_left - D_right如果E_heading 0说明目标偏右小车需要向左平移。生成控制指令根据E_distance计算纵向速度Vy。可以使用简单的比例控制Vy Kp_distance * E_distance。Kp_distance是比例系数需要调试。根据E_heading计算横向速度Vx。同样使用比例控制Vx Kp_heading * E_heading。旋转速度ω在这个简单模型中可以设为0或者引入一个很小的常数用于抵消小车本身的不对称性。执行控制将计算出的(Vx, Vy, 0)代入上述运动学函数得到四个电机的PWM值并输出到电机驱动板。# 跟随算法核心循环示例 D_target 50 # 目标距离 50cm dead_zone 10 # 死区 ±10cm Kp_dist 2.0 # 距离比例系数 Kp_head 1.5 # 方位比例系数 while True: # 1. 读取传感器数据 (假设已有相关函数) Df read_ultrasonic_front() Dl read_ultrasonic_left() Dr read_ultrasonic_right() # 2. 计算误差 E_dist Df - D_target E_head Dl - Dr # 3. 应用死区和比例控制 Vy 0 if abs(E_dist) dead_zone: Vy Kp_dist * E_dist # 限制最大速度 Vy max(min(Vy, 100), -100) Vx Kp_head * E_head Vx max(min(Vx, 100), -100) # 限制横向速度 # 4. 运动学解算并驱动电机 pwm_values mecanum_calculate(Vx, Vy, 0) set_motor_pwm(*pwm_values) # 假设的电机设置函数 sleep(50) # 控制周期约20Hz实操心得PID的引入。上面的比例控制P控制是最简单的但实际中小车可能会在目标距离附近来回振荡。这时就需要引入积分I和微分D控制。I控制可以消除静态误差最终稳定在精确距离D控制可以抑制振荡让跟随更平滑。可以从P控制开始调试稳定后再尝试加入D最后是I。调试PID参数是个耐心活记住口诀“参数整定找最佳从小到大顺序查先是比例后积分最后再把微分加”。4. 系统搭建与电路连接详解4.1 机械结构组装要点底盘与轮子安装确保四个麦克纳姆轮安装高度一致且能自由转动。轮子必须按照设计图纸左旋和右旋交替安装通常从上方看辊子形成的斜面指向车体中心。用螺丝固定牢固防止高速转动时松动。电机固定直流电机需要用螺丝或扎带牢牢固定在底盘上。电机轴与轮子之间的联轴器要安装紧密避免打滑。如果使用带编码器的电机注意编码器线不要被轮子或底盘刮到。传感器布局三个超声波传感器建议用支架固定在小车前方呈一个倒“品”字形或水平排列。确保它们的检测区域正对前方、左前、右前并且没有被车体其他部分如轮子遮挡。传感器安装要稳固避免振动导致数据跳变。主控与电路板固定使用尼龙柱或螺丝将micro:bit扩展板、电机驱动板、电源模块等固定在底盘上方。布局应合理便于接线和调试。考虑重心位置尽量使电池等重物放低、居中提高行驶稳定性。4.2 电路连接图与接线说明由于无法绘制图表我将用文字详细描述连接关系。接线前务必断开所有电源电源部分电池组正负极接入电机驱动板的电源输入端子VM, GND。同时电池组正负极接入降压模块的输入端子。降压模块的输出5V, GND接入一块面包板或PCB的电源轨作为系统逻辑电源。micro:bit与驱动板将micro:bit通过边缘连接器插在专用的电机驱动扩展板上是最简单的方式。如果没有则需要手动连接TB6612FNG驱动板 (需要两块)每块驱动板的VCC和GND接逻辑电源5V。每块驱动板的STBY待机引脚接高电平5V以启用。AIN1/AIN2和BIN1/BIN2是控制电机转向和速度的PWM输入分别接micro:bit的GPIO口如P0, P1, P8, P12等。PWMA/PWMB接micro:bit的PWM输出口支持PWM的引脚如P0, P1, P2, P13, P14, P15等用于控制电机速度。AO1/AO2和BO1/BO2输出接对应的直流电机。超声波传感器连接每个HC-SR04有4个引脚Vcc,Trig,Echo,Gnd。Vcc接逻辑5VGnd接逻辑地。Trig触发引脚接micro:bit任意GPIO设置为输出模式。Echo回声引脚接micro:bit任意GPIO但要注意HC-SR04的Echo输出是5V电平而micro:bit的GPIO只能耐受3.3V。必须进行电平转换简单的办法是用两个电阻如1kΩ和2kΩ组成分压电路将5V分压至约3.3V后再接入micro:bit。或者使用现成的3.3V/5V双向电平转换模块。避坑指南电源噪声与干扰。电机在启动和换向时会产生巨大的电流尖峰和电磁干扰这可能导致micro:bit复位或传感器读数异常。解决方案1) 在电机电源输入端并联一个大容量电解电容如470uF-1000uF/16V和一个小容量瓷片电容0.1uF以吸收尖峰2) 逻辑电源与电机驱动电源之间可以加一个磁珠或使用独立的降压模块3) 信号线特别是PWM和Echo线尽量远离电机电源线如果平行走线可考虑使用屏蔽线或双绞线。5. 软件编程与Makecode/Arduino实现5.1 Micro:bit Makecode图形化编程对于初学者Makecode提供了快速上手的途径。我们需要加载一些扩展库加载“Sonar”扩展用于驱动超声波传感器。加载支持麦克纳姆轮的电机驱动扩展如“HCRobot”或“iBIT”或者使用通用的“PCA9685”舵机驱动扩展来模拟PWM输出如果驱动板支持I2C控制。主要逻辑块在无限循环中首先读取三个超声波传感器的距离值。进行阈值判断如果前方距离小于安全距离如20cm则立即停止所有电机刹车。计算距离误差和方位误差。根据误差使用映射块将误差值转换为电机速度值-100到100。调用麦克纳姆轮驱动块设置四个电机的速度。Makecode的驱动块通常已经封装了运动学计算你只需要输入Vx,Vy,ω三个参数。Makecode的局限性复杂的数学运算如PID在图形化编程中实现起来比较繁琐代码可读性也会下降。它适合快速验证想法和基础功能。5.2 Arduino/PlatformIO进阶代码实现对于追求性能和灵活性的开发者使用Arduino框架C/C是更好的选择。这里以PlatformIO环境为例展示核心代码结构。// 引脚定义 #define TRIG_F 2 #define ECHO_F 3 #define TRIG_L 4 #define ECHO_L 5 #define TRIG_R 6 #define ECHO_R 7 // 电机驱动引脚定义 (以TB6612为例两块驱动板) #define AIN1 8 #define AIN2 9 #define PWMA 10 // 左前电机 // ... 定义其他11个控制引脚 // PID参数与目标值 float Kp_dist 2.0, Ki_dist 0.05, Kd_dist 0.5; float Kp_head 1.5, Ki_head 0.02, Kd_head 0.3; float targetDist 50.0; float lastDistErr 0, integralDist 0; float lastHeadErr 0, integralHead 0; // 超声波读取函数 float readUltrasonic(int trigPin, int echoPin) { digitalWrite(trigPin, LOW); delayMicroseconds(2); digitalWrite(trigPin, HIGH); delayMicroseconds(10); digitalWrite(trigPin, LOW); long duration pulseIn(echoPin, HIGH, 30000); // 超时30ms return duration * 0.034 / 2; // 声速340m/s除以2 } // PID计算函数 float computePID(float error, float lastErr, float integral, float Kp, float Ki, float Kd, float dt) { integral error * dt; float derivative (error - lastErr) / dt; float output Kp * error Ki * integral Kd * derivative; lastErr error; // 输出限幅 output constrain(output, -255, 255); return output; } void setup() { // 初始化串口、引脚模式 Serial.begin(115200); pinMode(TRIG_F, OUTPUT); pinMode(ECHO_F, INPUT); // ... 初始化其他引脚 // 初始化电机驱动引脚为OUTPUT } void loop() { unsigned long currentTime millis(); static unsigned long lastTime 0; float dt (currentTime - lastTime) / 1000.0; // 转换为秒 if (dt 0.05) return; // 控制周期约20Hz lastTime currentTime; // 1. 读取传感器 float distF readUltrasonic(TRIG_F, ECHO_F); float distL readUltrasonic(TRIG_L, ECHO_L); float distR readUltrasonic(TRIG_R, ECHO_R); // 过滤无效读数 if (distF 400 || distF 2) distF targetDist; // 超范围则用目标值代替 // 同理处理distL, distR // 2. 安全判断 if (distF 15.0) { // 紧急停止距离 stopMotors(); return; } // 3. 计算PID float distErr distF - targetDist; float headErr distL - distR; float Vy computePID(distErr, lastDistErr, integralDist, Kp_dist, Ki_dist, Kd_dist, dt); float Vx computePID(headErr, lastHeadErr, integralHead, Kp_head, Ki_head, Kd_head, dt); // 4. 运动学解算并输出PWM mecanumDrive(Vx, Vy, 0); // 第三个参数为旋转速度此处为0 // 5. 串口调试输出可选 Serial.print(DistF:); Serial.print(distF); Serial.print( Vy:); Serial.print(Vy); Serial.print( Vx:); Serial.println(Vx); }编程技巧软件滤波。超声波传感器数据容易受到噪声干扰。除了硬件上做好电源滤波软件上可以采用“中值滤波”或“一阶低通滤波”。例如连续读取5次距离去掉最大最小值后取平均能有效滤除偶然的跳变。一阶低通滤波公式filtered_value α * new_value (1-α) * last_filtered_value其中α是滤波系数0α1值越小滤波效果越强但响应也越慢。6. 调试、优化与功能扩展6.1 系统调试步骤与技巧调试应分步进行切勿一次性组装完所有部件再上电。单元测试电机与驱动单独编写测试程序让每个电机正转、反转、调速确保接线正确轮子转向符合运动学公式的预期。测试麦克纳姆轮的基本运动单独给Vx、Vy、ω观察小车是否准确执行前、后、左、右平移和旋转。传感器单独测试每个超声波传感器读取其距离值用手在面前移动观察串口输出的数据是否连续、合理。检查电平转换电路是否工作正常。开环测试将运动学解算函数与手动控制如通过串口发送指令结合验证小车能按照指令精确运动。例如发送“Vx50, Vy0, ω0”小车应向右平滑平移。闭环调试先调距离环暂时屏蔽横向控制Vx0只使用前方传感器。让人站在小车前方不同距离调试Kp_dist使小车能稳定地跟随并停在目标距离附近。先调P出现等幅振荡就加一点D。再调方位环固定距离让人在小车前方左右移动调试Kp_head使小车能通过横向平移将人调整到中心。同样振荡则加D。最后联调两个环同时工作微调参数确保跟随动作平滑无剧烈振荡或响应迟钝。现场调试在不同地面光滑地板、地毯测试摩擦力不同会影响电机性能可能需要微调PID参数或最大速度限制。6.2 性能优化与功能扩展方向基础跟随实现后可以从以下方面提升传感器升级多传感器融合增加更多超声波传感器形成密集阵列或引入一个二维激光雷达如RPLidar A1可以获得更精确的环境轮廓实现更智能的避障和路径预测。视觉识别使用OpenMV或树莓派加摄像头通过颜色识别或人脸识别来锁定特定目标这样就不再需要人身上佩戴任何信标实现真正的视觉跟随。UWB精确定位如果需要在较大范围内实现厘米级精度的跟随UWB超宽带模块是一个专业选择。算法优化状态机设计引入状态机让小车拥有不同的行为模式如“搜索”、“跟随”、“避障”、“停止”。例如当丢失目标时进入“搜索”模式原地旋转。路径规划在跟随中加入简单的局部路径规划如动态窗口法DWA让小车在跟随的同时能绕开静态障碍物。数据融合与滤波对传感器数据使用卡尔曼滤波可以更准确地估计目标的速度和位置实现预测性跟随让人感觉小车更“聪明”。工程化改进加入电池电压监测实时监测电池电压当电压过低时主动报警并停止防止电池过放。无线调试与配置通过蓝牙或Wi-Fi用手机APP实时查看传感器数据、PID参数并能动态调整参数无需连接电脑。完善安全逻辑增加急停开关、防跌落传感器红外或超声波朝下以及碰撞检测传感器触边或IMU检测急加速度。从“小尚别跟丢了”这个有趣的想法出发我们一步步拆解了全向移动底盘的选择、传感器方案的权衡、控制算法的核心原理、硬件的连接细节以及软件的调试心法。这个过程充满了挑战但也正是这些挑战让最终看到小车灵巧地跟在身后时那份成就感变得无比真实。无论你是为了竞赛还是纯粹出于热爱希望这篇详尽的拆解能为你铺平道路。记住硬件连接要细心软件调试要耐心遇到问题多查资料、多动手实验。这台自动跟随的麦克纳姆轮小车将会是你机器人学习之旅中一个非常扎实的里程碑。