简介面向32位单片机开发者和智能小车爱好者的蓝牙麦克纳姆轮循迹资源包提供一套从底层驱动到手机遥控的完整参考实现。工程基于标准库组织既有38个c源码文件、41个h头文件与汇编启动文件也包含编译过程产生的o、d、crf、lst等文件可辅助理解完整构建流程另外还附带Android蓝牙控制APK、docx技术文档、txt说明以及Keil工程配置、hex烧录文件覆盖开发、调试、使用全环节。全部261个文件压缩后约11.15MB目录结构清晰既适合仿写学习也能直接导入开发环境二次扩展。docx文档详细说明了蓝牙模块配置、PWM调速与麦轮运动学拆分注释贯穿关键函数能有效降低入门门槛。目前已有1098人浏览学习尤其适合初次接触麦轮运动控制或蓝牙串口通信的爱好者。1. 蓝牙麦轮循迹.zip一套能拿奖的嵌入式全向移动方案在大学生电子设计竞赛和机器人工坊里蓝牙麦轮循迹车是出现频率最高的题目之一。拿到蓝牙——麦轮循迹.zip 这个包后很多人的第一反应是打开串口助手下固件然后卡在同一个地方手机蓝牙连上了小车却不按预想方向走或者五路灰度传感器对着白纸黑胶带一放阈值怎么调都不对。这个包的核心其实只有三件事蓝牙模块只负责透传遥控速度主控负责按麦轮运动学公式分配四个轮速循迹回路用五路灰度传感器做 PD 纠偏。整套方案适合 STM32F103 或 Arduino 平台也适合想做全向移动底盘的机器人项目。下面按“运动学—蓝牙—算法—调试”的顺序把细节拆开让你拿到代码后能直接改参数跑通。2. 麦轮运动学与循迹传感器选型先把四轮速度算对很多麦轮车跑起来斜着冲问题不在电机而在四轮速度分配没有遵循运动学约束。麦轮Mecanum wheel表面有 45 度辊子四个轮的切向速度合成可以实现纵向、横向和旋转三个自由度。只做循迹时虽然主要用前向速度 vx 和偏航角速度 ω但仍要把速度正确映射到四个轮子上否则某个轮子会拖拽车体造成打滑和旋转漂移。2.1 麦轮逆运动学公式与坐标系约定这里必须约定坐标系否则网上抄来的公式符号不一致。我常用的坐标系是车体前方为 x 正方向左侧为 y 正方向逆时针旋转为 ω 正方向。四个轮子编号为左前 FL、右前 FR、左后 RL、右后 RR轮距为 2a轴距为 2b轮半径为 R。逆运动学公式为// 输入vx 前向速度vy 左向速度omega 逆时针旋转角速度 float fl ( vx - vy - (a b) * omega) / R; float fr ( vx vy (a b) * omega) / R; float rl ( vx vy - (a b) * omega) / R; float rr ( vx - vy (a b) * omega) / R;这段公式把车体速度拆到每个轮的线速度。以左前轮为例当车体向右移动vy 为负或顺时针旋转ω 为负时左前轮速度会下降这正是麦轮产生横向力的原因。注意ab不是轮距而是轮距一半加轴距一半单位必须与速度单位一致。实际工程里R可以归一化掉因为后续要转成 PWM 占空比或编码器目标转速只需要一个比例系数K_speed// 归一化后K_speed 由实际电机最高转速决定 float fl (vx - vy - (a b) * omega) * K_speed; float fr (vx vy (a b) * omega) * K_speed; float rl (vx vy - (a b) * omega) * K_speed; float rr (vx - vy (a b) * omega) * K_speed;这里系数统一提出来调参只需要调K_speed但四个轮子必须做限幅。限幅不能直接截断单个轮子的速度否则破坏运动学关系。常见做法是找出四个轮速中的最大值max_speed若超过上限则所有轮速乘以max_v / max_speed做等比缩放这样车体方向不漂移。下面这个表给出不同动作下四个轮子的速度极性方便在代码里验证符号动作FLFRRLRR前向右移--逆时针旋转--左斜前方00表格里的“右移”指车体向右平移此时 vy 为负数“左斜前方”是 vx0、vy0 的合成动作你可以看到对角轮速度对称。实际传感器方向不同电机接线反了整车左右速度和旋转符号都要取反建议先在桌面上空转验证。2.2 五路循迹传感器的优点与阈值自校准五路循迹传感器的优点在于能覆盖一次完整的黑线横截面不仅可以判断直线和单侧偏离还能识别十字路口和停车线。常见排布是五个模拟量探头等距中间三个对准黑线左右两个作为裕量。相比双路或三路传感器五路在过十字路口时不会突然丢失黑线也比摄像头循迹的嵌入式开销小得多。阈值自校准是循迹稳定性的第一道关。由于地面反光和供电电压都会改变 ADC 读数我一开机就让小车静止让传感器在无黑线区域采样若干次记录每路最大值和最小值取中间值作为阈值。下面的代码用 STM32 的 ADC 读取适合四路或五路灰度uint16_t cal_min[5] {4095,4095,4095,4095,4095}; uint16_t cal_max[5] {0,0,0,0,0}; void sensor_autocheck(uint8_t n_rounds) { for (int r 0; r n_rounds; r) { for (int i 0; i 5; i) { uint16_t v read_adc(i); if (v cal_min[i]) cal_min[i] v; if (v cal_max[i]) cal_max[i] v; } delay(10); } for (int i 0; i 5; i) { thresh[i] (cal_min[i] cal_max[i]) / 2; } }这段代码需要配合一个前提开机时传感器正下方是背景色没有压到黑线。若车停在黑线上采样值全部为黑阈值会错乱。可以在程序里增加一个开机校验在三秒内检测到中间几路长时间为黑色时用蜂鸣器报错提示。阈值设好后每个采样读值v如果大于thresh则按黑线处理为 1否则为 0。这里要小心一个误区模拟量灰度传感器的阈值不是固定的“500”之类。实际项目里充电前后阈值可能差 200。如果不想做开机自校准至少要在首次上电时打印各路 ADC 值手动把阈值填进配置头文件。3. 蓝牙模块接线与 AT 指令配置从 HC-05 搜索到串口透传蓝牙部分用经典蓝牙 SPP 比蓝牙 LE 简单手机端不需要开发 App用现成的“蓝牙串口调试”软件就能连接。HC-05 这颗模块几乎成了默认选择它兼容 HC-06但支持主从模式和手机配对后可以透传任意字节流。下面先讲硬件接线再给出 AT 指令序列最后讲串口数据帧的解析。3.1 蓝牙模块与 STM32/Arduino 的可靠接线HC-05 常见引脚有 VCC、GND、TXD、RXD、KEY、STATE。其中 KEY 在模块上电前拉高会进入 AT 模式这是配置入口STATE 输出连接状态可以接一个 LED。具体到主控不能直接把 HC-05 的 TXD 接到 5V 单片机的 RX 上因为模块逻辑电平是 3.3V但 5V 单片机 RX 识别 3.3V 通常还算可靠反过来单片机的 5V TX 到 HC-05 的 RX 必须分压。所以最常见做法是加一个 1K 2K 分压电阻或者直接用 3.3V 版本的主控。HC-05 引脚接 STM32F103接 Arduino Uno说明VCC5V5V模块自带稳压GNDGNDGND共地TXDPA10 (USART1_RX)RX (pin 0)3.3V 输出RXDPA9 (USART1_TX) 经分压TX (pin 1) 经分压5V 输入需要分压KEYPA8 或按钮D2上电高进入 ATSTATEPC13 或 LEDD3指示连接状态表中的 PA9/PA10 是 USART1用时需要配置复用推挽输出。如果板子上有蓝牙专用接口先量一下有没有电平转换电路。蓝牙模块供电必须稳定很多 HC-05 连不上是电源纹波过大导致的建议在 VCC 和 GND 之间并联一个 100uF 电解电容。串口配置建议设成 9600 8N1这是 HC-05 默认透传波特率。但 AT 指令模式下很多模块默认是 38400 8N1所以第一次进 AT 时先按 38400 测试。3.2 AT 指令序列与进入透传模式的完整步骤进入 AT 模式的方法是按住 KEY或者先把 KEY 接高电平再给蓝牙模块上电。此时用 USB 转 TTL 连接模块串口助手先按 38400 波特率发送AT返回 OK 就证明进入成功。下面是一段典型配置序列ATORGL ATROLE0 ATPSWD1234 ATUART9600,0,0 ATNAMEMecanum-BT ATRESET这段序列的含义ATORGL恢复默认ATROLE0设为从模式手机作为主设备发起配对如果两个蓝牙模块互连另一个设备设成 1ATPSWD设置配对密码ATUART9600,0,0把透传波特率固定为 9600ATRENAME设置蓝牙名称为 Mecanum-BTATRESET重启。每条指令必须在模块返回OK后再发下一条否则容易漏配置。提示如果AT指令没有返回OK先检查串口助手发送设置是否带回车换行HC-05 默认要求回车换行。另一个常见坑是 USB 转 TTL 模块的 TXD 和 RXD 接反接反时发AT会返回乱码或没有任何反应。配置完成后断开 KEY 重新上电模块进入透传模式。此时手机搜索蓝牙应该能搜到 Mecanum-BT输入密码 1234 配对。配对后手机上的蓝牙串口 App 会接管连接发送的数据原样到达主控串口。3.3 串口数据帧解析与环形缓冲手机端发送的遥控数据必须有一套固定帧格式否则主控无法区分速度和方向。我常用的格式是!vx,vy,omega#比如!0.50,0.00,0.30#表示前向 0.5、左移 0、逆时针旋转 0.3。下位机在串口接收中断里把数据压入环形缓冲区解析出!和#之间的内容再用sscanf提取三个浮点数char buf[32]; uint8_t len 0; uint32_t last_cmd_time 0; void uart_rx_irq_process(uint8_t byte) { if (byte #) { buf[len] \0; // 格式!vx,vy,omega# // buf 中不包含 #从 buf1 跳过 ! if (buf[0] !) { if (sscanf(buf 1, %f,%f,%f, rc_vx, rc_vy, rc_omega) 3) { last_cmd_time millis(); } } len 0; } else if (len sizeof(buf) - 1) { buf[len] byte; } }这段代码在每收到一个#时结束一帧用sscanf(buf 1, ...)跳过!和尾部#。注意sscanf返回值必须等于 3否则说明帧格式不对不要更新last_cmd_time。解析完的rc_vx、rc_vy、rc_omega会作为运动学函数的输入单位都归一化到-1.0 ~ 1.0最后乘上K_speed即可。这里必须补一个防呆逻辑在主循环里检查last_cmd_time是否超时比如 500 毫秒没有新数据就自动清零速度防止蓝牙意外断开后小车继续冲。4. 循迹控制算法与速度环用 PD 纠偏而不是乱打方向循迹控制的核心不是“看到黑线就转向”而是把传感器输出映射成一个连续偏差量让车头柔和回正。直接给固定转向角会让小车左冲右突而且蓝牙遥控也可能和循迹争夺控制权。所以我的方案是把遥控速度当作前馈把循迹纠偏量叠加在旋转角速度omega上二者共用一个运动学出口不会互相打架。4.1 五路传感器状态到连续偏差量的映射五路灰度传感器从左到右记为 S0 到 S4数字量黑线为 1白线为 0。定义偏差error为车体中心相对黑线的横向偏移正值表示黑线在车体左侧需要逆时针旋转修正负值表示黑线在右侧需要顺时针旋转修正。一个有效映射是int error 2 * s0 1 * s1 0 * s2 - 1 * s3 - 2 * s4;这里权重表示偏离程度中间路不产生偏差。当只压住最左一路 S0 时error2转向角速度应为正即逆时针旋转让车头向左回正。当只压住最右一路 S4 时error-2转向角速度为负让车头向右回正。如果传感器方向装反把权重取反即可。仅凭单个时刻的error还不够因为传感器间隔变化会产生阶梯。需要在主循环里以固定周期采样比如 10 毫秒一次。采样周期不能太短否则同一个传感器信号会被重复计算也不能太长否则车高速过弯时会冲出赛道。常见做法是控制循环定时 10ms与 PWM 频率解耦。路口检测使用“全丢线”或“中间多路同时触发”的状态。一般设一个cross_count当检测到十字路口标志时让循迹误差清零保持之前的方向直行一段时间。最简单的判断五路全部为 1 表示走到了黑带区域按十字路口处理。这个逻辑要加死区防止连续触发导致小车在十字路口转圈。4.2 PID 速度环与麦轮速度分配的实现有了error接下来用 PD 控制器算出修正角速度。积分项在循迹小车里通常不需要因为静态误差可以被比例项完全消除而且积分容易在过弯时积分饱和导致回正过度。下面是一个完整的控制函数float err_prev 0.0f; float dt 0.01f; // 10ms 控制周期 void control_loop(void) { uint8_t s[5]; read_sensors(s); // 读取五路灰度 float error calc_error(s); // 按上面权重映射 float derivative (error - err_prev) / dt; float pid_out Kp * error Kd * derivative; err_prev error; // 循迹时固定前向旋转量加入 PD 输出 float omega base_omega pid_out; mecanum_set_velocity(rc_vx, rc_vy, omega); }pid_out的单位和base_omega保持一致base_omega可以是 0也可以由蓝牙遥控叠加一个转向意图。Kp决定回正力度Kd用来抑制传感器跳变引起的高频抖动。给一个可行的参数起点Kp1.8Kd0.4dt0.01。注意error是传感器加权和量纲为“格”如果换用五路模拟量需要先把模拟值归一化到-2~2否则参数不通用。接着把vx、vy、omega填入第 2 章的mecanum_set_velocity。函数内部除了限幅还应该加一个斜坡限制让速度增量不超过每周期上限void mecanum_set_velocity(float vx, float vy, float w) { static float last_vx, last_vy, last_w; float max_step 0.05f; // 每周期速度增量上限 vx constrain_inc(vx, last_vx, max_step); vy constrain_inc(vy, last_vy, max_step); w constrain_inc(w, last_w, max_step); last_vx vx; last_vy vy; last_w w; // 计算四轮归一化速度 float fl (vx - vy - (A B) * w) * K_speed; float fr (vx vy (A B) * w) * K_speed; float rl (vx vy - (A B) * w) * K_speed; float rr (vx - vy (A B) * w) * K_speed; set_motor_duty(fl, fr, rl, rr); }constrain_inc不是标准库函数可以自己实现先判断输入和上一次的差是否超过max_step超过就按步长逼近。这样即使蓝牙断线或传感器跳变四个轮子的速度输出也不会突变麦轮不会因为瞬间加速度过大而打滑。限幅顺序应该先做斜坡限制再做等比缩放等比缩放最好放在set_motor_duty内部因为需要计算四轮最大值。4.3 循迹参数表与几种常见误用下面这个表整理了常见的初始参数注意不同车体重心、轮径和电机减速比会有差异不能盲抄参数推荐值作用调大后果调小后果Kp1.2~2.5回正比例摆动加剧过弯跟不上Kd0.2~0.6抑制振荡对噪声放大车头抖动max_step0.03~0.08速度斜率起步顿挫响应变慢control_period10ms采样频率高速丢失处理器占用常见误用之一是给四个轮子分别设定 PID却没有统一的运动学分配结果车辆原地旋转。另一个误用是在纯循迹时把vy设成非零导致小车一边前进一边横移传感器无法稳定对齐黑线。我一般只在遥控模式下允许vy参与循迹模式下强制vy0。5. 调试蓝牙连接失败与麦轮打滑串口日志是最好的排错工具最后的调试章节重点解决这个项目里最容易卡住的几个问题。排错不该靠猜而是按“蓝牙是否建立双向链路—运动学符号是否一致—循迹 PID 是否震荡”的顺序逐步验证。5.1 蓝牙搜索不到或连接即断先查 KEY 电平和供电电流手机搜不到 HC-05 时先看模块指示灯AT 模式下上电后指示灯通常常亮正常透传模式等待连接时快闪连接成功后慢闪。如果上电后完全不亮量 VCC 电压如果亮但搜不到检查是否还在 AT 模式此时蓝牙名称不会暴露给手机。AT 指令一直返回失败时用 USB 转 TTL 单独测试模块排除主控影响。另一个常见问题是供电不足HC-05 峰值电流超过 50mA从 STM32 板载 3.3V 输出取电容易掉压建议独立稳压供电。连接后如果发数据主控收不到优先抓串口日志在主控 UART 入口打印每个接收字节的十六进制码确认蓝牙发出的字节流是否完整。如果字节乱码大概率是两边波特率不一致如果!到#之间有数据丢失检查中断处理里是否占用了过长时间。手机端建议使用支持 HEX 显示的工具避免文本编码差异。5.2 麦轮打滑的验证方法先空转再看电流麦轮平地打滑的表现是车身斜向漂移、转弯半径比预期大。首先把小车架离地面用遥控给一个纯前向速度四个轮子应该同向同速旋转。如果某个轮子明显滞后检查该电机驱动输入和编码器方向。接着放到地面用极缓慢的斜坡提升速度观察车体是否直线前进。如果开始打滑说明加速度斜坡上限太高把max_step从 0.05 降到 0.02 重新测。循迹抖动则用串口打印error和pid_out。正常直线走时error应该在 -0.2 到 0.2 之间波动如果长期反向跳动把传感器权重表倒过来。如果pid_out高频来回震荡先调大 Kd再检查dt是否和实际控制周期一致不一致时微分项会放大噪声。最后一个小技巧保存所有参数到 Flash 或 EEPROM每次开机先加载再用三色 LED 显示校准状态绿色代表阈值自检通过蓝色代表蓝牙已连接红色代表传感器异常。这样在比赛现场不用接串口线也能快速判断小车健康状态。本文还有配套的精品资源点击获取 
长河君 · 2026/9/11 12:11:06 · 阅读 1.2k 蓝牙麦轮循迹小车实战：运动学、PD纠偏与HC-05配置全解
简介面向32位单片机开发者和智能小车爱好者的蓝牙麦克纳姆轮循迹资源包提供一套从底层驱动到手机遥控的完整参考实现。工程基于标准库组织既有38个c源码文件、41个h头文件与汇编启动文件也包含编译过程产生的o、d、crf、lst等文件可辅助理解完整构建流程另外还附带Android蓝牙控制APK、docx技术文档、txt说明以及Keil工程配置、hex烧录文件覆盖开发、调试、使用全环节。全部261个文件压缩后约11.15MB目录结构清晰既适合仿写学习也能直接导入开发环境二次扩展。docx文档详细说明了蓝牙模块配置、PWM调速与麦轮运动学拆分注释贯穿关键函数能有效降低入门门槛。目前已有1098人浏览学习尤其适合初次接触麦轮运动控制或蓝牙串口通信的爱好者。1. 蓝牙麦轮循迹.zip一套能拿奖的嵌入式全向移动方案在大学生电子设计竞赛和机器人工坊里蓝牙麦轮循迹车是出现频率最高的题目之一。拿到蓝牙——麦轮循迹.zip 这个包后很多人的第一反应是打开串口助手下固件然后卡在同一个地方手机蓝牙连上了小车却不按预想方向走或者五路灰度传感器对着白纸黑胶带一放阈值怎么调都不对。这个包的核心其实只有三件事蓝牙模块只负责透传遥控速度主控负责按麦轮运动学公式分配四个轮速循迹回路用五路灰度传感器做 PD 纠偏。整套方案适合 STM32F103 或 Arduino 平台也适合想做全向移动底盘的机器人项目。下面按“运动学—蓝牙—算法—调试”的顺序把细节拆开让你拿到代码后能直接改参数跑通。2. 麦轮运动学与循迹传感器选型先把四轮速度算对很多麦轮车跑起来斜着冲问题不在电机而在四轮速度分配没有遵循运动学约束。麦轮Mecanum wheel表面有 45 度辊子四个轮的切向速度合成可以实现纵向、横向和旋转三个自由度。只做循迹时虽然主要用前向速度 vx 和偏航角速度 ω但仍要把速度正确映射到四个轮子上否则某个轮子会拖拽车体造成打滑和旋转漂移。2.1 麦轮逆运动学公式与坐标系约定这里必须约定坐标系否则网上抄来的公式符号不一致。我常用的坐标系是车体前方为 x 正方向左侧为 y 正方向逆时针旋转为 ω 正方向。四个轮子编号为左前 FL、右前 FR、左后 RL、右后 RR轮距为 2a轴距为 2b轮半径为 R。逆运动学公式为// 输入vx 前向速度vy 左向速度omega 逆时针旋转角速度 float fl ( vx - vy - (a b) * omega) / R; float fr ( vx vy (a b) * omega) / R; float rl ( vx vy - (a b) * omega) / R; float rr ( vx - vy (a b) * omega) / R;这段公式把车体速度拆到每个轮的线速度。以左前轮为例当车体向右移动vy 为负或顺时针旋转ω 为负时左前轮速度会下降这正是麦轮产生横向力的原因。注意ab不是轮距而是轮距一半加轴距一半单位必须与速度单位一致。实际工程里R可以归一化掉因为后续要转成 PWM 占空比或编码器目标转速只需要一个比例系数K_speed// 归一化后K_speed 由实际电机最高转速决定 float fl (vx - vy - (a b) * omega) * K_speed; float fr (vx vy (a b) * omega) * K_speed; float rl (vx vy - (a b) * omega) * K_speed; float rr (vx - vy (a b) * omega) * K_speed;这里系数统一提出来调参只需要调K_speed但四个轮子必须做限幅。限幅不能直接截断单个轮子的速度否则破坏运动学关系。常见做法是找出四个轮速中的最大值max_speed若超过上限则所有轮速乘以max_v / max_speed做等比缩放这样车体方向不漂移。下面这个表给出不同动作下四个轮子的速度极性方便在代码里验证符号动作FLFRRLRR前向右移--逆时针旋转--左斜前方00表格里的“右移”指车体向右平移此时 vy 为负数“左斜前方”是 vx0、vy0 的合成动作你可以看到对角轮速度对称。实际传感器方向不同电机接线反了整车左右速度和旋转符号都要取反建议先在桌面上空转验证。2.2 五路循迹传感器的优点与阈值自校准五路循迹传感器的优点在于能覆盖一次完整的黑线横截面不仅可以判断直线和单侧偏离还能识别十字路口和停车线。常见排布是五个模拟量探头等距中间三个对准黑线左右两个作为裕量。相比双路或三路传感器五路在过十字路口时不会突然丢失黑线也比摄像头循迹的嵌入式开销小得多。阈值自校准是循迹稳定性的第一道关。由于地面反光和供电电压都会改变 ADC 读数我一开机就让小车静止让传感器在无黑线区域采样若干次记录每路最大值和最小值取中间值作为阈值。下面的代码用 STM32 的 ADC 读取适合四路或五路灰度uint16_t cal_min[5] {4095,4095,4095,4095,4095}; uint16_t cal_max[5] {0,0,0,0,0}; void sensor_autocheck(uint8_t n_rounds) { for (int r 0; r n_rounds; r) { for (int i 0; i 5; i) { uint16_t v read_adc(i); if (v cal_min[i]) cal_min[i] v; if (v cal_max[i]) cal_max[i] v; } delay(10); } for (int i 0; i 5; i) { thresh[i] (cal_min[i] cal_max[i]) / 2; } }这段代码需要配合一个前提开机时传感器正下方是背景色没有压到黑线。若车停在黑线上采样值全部为黑阈值会错乱。可以在程序里增加一个开机校验在三秒内检测到中间几路长时间为黑色时用蜂鸣器报错提示。阈值设好后每个采样读值v如果大于thresh则按黑线处理为 1否则为 0。这里要小心一个误区模拟量灰度传感器的阈值不是固定的“500”之类。实际项目里充电前后阈值可能差 200。如果不想做开机自校准至少要在首次上电时打印各路 ADC 值手动把阈值填进配置头文件。3. 蓝牙模块接线与 AT 指令配置从 HC-05 搜索到串口透传蓝牙部分用经典蓝牙 SPP 比蓝牙 LE 简单手机端不需要开发 App用现成的“蓝牙串口调试”软件就能连接。HC-05 这颗模块几乎成了默认选择它兼容 HC-06但支持主从模式和手机配对后可以透传任意字节流。下面先讲硬件接线再给出 AT 指令序列最后讲串口数据帧的解析。3.1 蓝牙模块与 STM32/Arduino 的可靠接线HC-05 常见引脚有 VCC、GND、TXD、RXD、KEY、STATE。其中 KEY 在模块上电前拉高会进入 AT 模式这是配置入口STATE 输出连接状态可以接一个 LED。具体到主控不能直接把 HC-05 的 TXD 接到 5V 单片机的 RX 上因为模块逻辑电平是 3.3V但 5V 单片机 RX 识别 3.3V 通常还算可靠反过来单片机的 5V TX 到 HC-05 的 RX 必须分压。所以最常见做法是加一个 1K 2K 分压电阻或者直接用 3.3V 版本的主控。HC-05 引脚接 STM32F103接 Arduino Uno说明VCC5V5V模块自带稳压GNDGNDGND共地TXDPA10 (USART1_RX)RX (pin 0)3.3V 输出RXDPA9 (USART1_TX) 经分压TX (pin 1) 经分压5V 输入需要分压KEYPA8 或按钮D2上电高进入 ATSTATEPC13 或 LEDD3指示连接状态表中的 PA9/PA10 是 USART1用时需要配置复用推挽输出。如果板子上有蓝牙专用接口先量一下有没有电平转换电路。蓝牙模块供电必须稳定很多 HC-05 连不上是电源纹波过大导致的建议在 VCC 和 GND 之间并联一个 100uF 电解电容。串口配置建议设成 9600 8N1这是 HC-05 默认透传波特率。但 AT 指令模式下很多模块默认是 38400 8N1所以第一次进 AT 时先按 38400 测试。3.2 AT 指令序列与进入透传模式的完整步骤进入 AT 模式的方法是按住 KEY或者先把 KEY 接高电平再给蓝牙模块上电。此时用 USB 转 TTL 连接模块串口助手先按 38400 波特率发送AT返回 OK 就证明进入成功。下面是一段典型配置序列ATORGL ATROLE0 ATPSWD1234 ATUART9600,0,0 ATNAMEMecanum-BT ATRESET这段序列的含义ATORGL恢复默认ATROLE0设为从模式手机作为主设备发起配对如果两个蓝牙模块互连另一个设备设成 1ATPSWD设置配对密码ATUART9600,0,0把透传波特率固定为 9600ATRENAME设置蓝牙名称为 Mecanum-BTATRESET重启。每条指令必须在模块返回OK后再发下一条否则容易漏配置。提示如果AT指令没有返回OK先检查串口助手发送设置是否带回车换行HC-05 默认要求回车换行。另一个常见坑是 USB 转 TTL 模块的 TXD 和 RXD 接反接反时发AT会返回乱码或没有任何反应。配置完成后断开 KEY 重新上电模块进入透传模式。此时手机搜索蓝牙应该能搜到 Mecanum-BT输入密码 1234 配对。配对后手机上的蓝牙串口 App 会接管连接发送的数据原样到达主控串口。3.3 串口数据帧解析与环形缓冲手机端发送的遥控数据必须有一套固定帧格式否则主控无法区分速度和方向。我常用的格式是!vx,vy,omega#比如!0.50,0.00,0.30#表示前向 0.5、左移 0、逆时针旋转 0.3。下位机在串口接收中断里把数据压入环形缓冲区解析出!和#之间的内容再用sscanf提取三个浮点数char buf[32]; uint8_t len 0; uint32_t last_cmd_time 0; void uart_rx_irq_process(uint8_t byte) { if (byte #) { buf[len] \0; // 格式!vx,vy,omega# // buf 中不包含 #从 buf1 跳过 ! if (buf[0] !) { if (sscanf(buf 1, %f,%f,%f, rc_vx, rc_vy, rc_omega) 3) { last_cmd_time millis(); } } len 0; } else if (len sizeof(buf) - 1) { buf[len] byte; } }这段代码在每收到一个#时结束一帧用sscanf(buf 1, ...)跳过!和尾部#。注意sscanf返回值必须等于 3否则说明帧格式不对不要更新last_cmd_time。解析完的rc_vx、rc_vy、rc_omega会作为运动学函数的输入单位都归一化到-1.0 ~ 1.0最后乘上K_speed即可。这里必须补一个防呆逻辑在主循环里检查last_cmd_time是否超时比如 500 毫秒没有新数据就自动清零速度防止蓝牙意外断开后小车继续冲。4. 循迹控制算法与速度环用 PD 纠偏而不是乱打方向循迹控制的核心不是“看到黑线就转向”而是把传感器输出映射成一个连续偏差量让车头柔和回正。直接给固定转向角会让小车左冲右突而且蓝牙遥控也可能和循迹争夺控制权。所以我的方案是把遥控速度当作前馈把循迹纠偏量叠加在旋转角速度omega上二者共用一个运动学出口不会互相打架。4.1 五路传感器状态到连续偏差量的映射五路灰度传感器从左到右记为 S0 到 S4数字量黑线为 1白线为 0。定义偏差error为车体中心相对黑线的横向偏移正值表示黑线在车体左侧需要逆时针旋转修正负值表示黑线在右侧需要顺时针旋转修正。一个有效映射是int error 2 * s0 1 * s1 0 * s2 - 1 * s3 - 2 * s4;这里权重表示偏离程度中间路不产生偏差。当只压住最左一路 S0 时error2转向角速度应为正即逆时针旋转让车头向左回正。当只压住最右一路 S4 时error-2转向角速度为负让车头向右回正。如果传感器方向装反把权重取反即可。仅凭单个时刻的error还不够因为传感器间隔变化会产生阶梯。需要在主循环里以固定周期采样比如 10 毫秒一次。采样周期不能太短否则同一个传感器信号会被重复计算也不能太长否则车高速过弯时会冲出赛道。常见做法是控制循环定时 10ms与 PWM 频率解耦。路口检测使用“全丢线”或“中间多路同时触发”的状态。一般设一个cross_count当检测到十字路口标志时让循迹误差清零保持之前的方向直行一段时间。最简单的判断五路全部为 1 表示走到了黑带区域按十字路口处理。这个逻辑要加死区防止连续触发导致小车在十字路口转圈。4.2 PID 速度环与麦轮速度分配的实现有了error接下来用 PD 控制器算出修正角速度。积分项在循迹小车里通常不需要因为静态误差可以被比例项完全消除而且积分容易在过弯时积分饱和导致回正过度。下面是一个完整的控制函数float err_prev 0.0f; float dt 0.01f; // 10ms 控制周期 void control_loop(void) { uint8_t s[5]; read_sensors(s); // 读取五路灰度 float error calc_error(s); // 按上面权重映射 float derivative (error - err_prev) / dt; float pid_out Kp * error Kd * derivative; err_prev error; // 循迹时固定前向旋转量加入 PD 输出 float omega base_omega pid_out; mecanum_set_velocity(rc_vx, rc_vy, omega); }pid_out的单位和base_omega保持一致base_omega可以是 0也可以由蓝牙遥控叠加一个转向意图。Kp决定回正力度Kd用来抑制传感器跳变引起的高频抖动。给一个可行的参数起点Kp1.8Kd0.4dt0.01。注意error是传感器加权和量纲为“格”如果换用五路模拟量需要先把模拟值归一化到-2~2否则参数不通用。接着把vx、vy、omega填入第 2 章的mecanum_set_velocity。函数内部除了限幅还应该加一个斜坡限制让速度增量不超过每周期上限void mecanum_set_velocity(float vx, float vy, float w) { static float last_vx, last_vy, last_w; float max_step 0.05f; // 每周期速度增量上限 vx constrain_inc(vx, last_vx, max_step); vy constrain_inc(vy, last_vy, max_step); w constrain_inc(w, last_w, max_step); last_vx vx; last_vy vy; last_w w; // 计算四轮归一化速度 float fl (vx - vy - (A B) * w) * K_speed; float fr (vx vy (A B) * w) * K_speed; float rl (vx vy - (A B) * w) * K_speed; float rr (vx - vy (A B) * w) * K_speed; set_motor_duty(fl, fr, rl, rr); }constrain_inc不是标准库函数可以自己实现先判断输入和上一次的差是否超过max_step超过就按步长逼近。这样即使蓝牙断线或传感器跳变四个轮子的速度输出也不会突变麦轮不会因为瞬间加速度过大而打滑。限幅顺序应该先做斜坡限制再做等比缩放等比缩放最好放在set_motor_duty内部因为需要计算四轮最大值。4.3 循迹参数表与几种常见误用下面这个表整理了常见的初始参数注意不同车体重心、轮径和电机减速比会有差异不能盲抄参数推荐值作用调大后果调小后果Kp1.2~2.5回正比例摆动加剧过弯跟不上Kd0.2~0.6抑制振荡对噪声放大车头抖动max_step0.03~0.08速度斜率起步顿挫响应变慢control_period10ms采样频率高速丢失处理器占用常见误用之一是给四个轮子分别设定 PID却没有统一的运动学分配结果车辆原地旋转。另一个误用是在纯循迹时把vy设成非零导致小车一边前进一边横移传感器无法稳定对齐黑线。我一般只在遥控模式下允许vy参与循迹模式下强制vy0。5. 调试蓝牙连接失败与麦轮打滑串口日志是最好的排错工具最后的调试章节重点解决这个项目里最容易卡住的几个问题。排错不该靠猜而是按“蓝牙是否建立双向链路—运动学符号是否一致—循迹 PID 是否震荡”的顺序逐步验证。5.1 蓝牙搜索不到或连接即断先查 KEY 电平和供电电流手机搜不到 HC-05 时先看模块指示灯AT 模式下上电后指示灯通常常亮正常透传模式等待连接时快闪连接成功后慢闪。如果上电后完全不亮量 VCC 电压如果亮但搜不到检查是否还在 AT 模式此时蓝牙名称不会暴露给手机。AT 指令一直返回失败时用 USB 转 TTL 单独测试模块排除主控影响。另一个常见问题是供电不足HC-05 峰值电流超过 50mA从 STM32 板载 3.3V 输出取电容易掉压建议独立稳压供电。连接后如果发数据主控收不到优先抓串口日志在主控 UART 入口打印每个接收字节的十六进制码确认蓝牙发出的字节流是否完整。如果字节乱码大概率是两边波特率不一致如果!到#之间有数据丢失检查中断处理里是否占用了过长时间。手机端建议使用支持 HEX 显示的工具避免文本编码差异。5.2 麦轮打滑的验证方法先空转再看电流麦轮平地打滑的表现是车身斜向漂移、转弯半径比预期大。首先把小车架离地面用遥控给一个纯前向速度四个轮子应该同向同速旋转。如果某个轮子明显滞后检查该电机驱动输入和编码器方向。接着放到地面用极缓慢的斜坡提升速度观察车体是否直线前进。如果开始打滑说明加速度斜坡上限太高把max_step从 0.05 降到 0.02 重新测。循迹抖动则用串口打印error和pid_out。正常直线走时error应该在 -0.2 到 0.2 之间波动如果长期反向跳动把传感器权重表倒过来。如果pid_out高频来回震荡先调大 Kd再检查dt是否和实际控制周期一致不一致时微分项会放大噪声。最后一个小技巧保存所有参数到 Flash 或 EEPROM每次开机先加载再用三色 LED 显示校准状态绿色代表阈值自检通过蓝色代表蓝牙已连接红色代表传感器异常。这样在比赛现场不用接串口线也能快速判断小车健康状态。本文还有配套的精品资源点击获取