简介STM32F103C8T6前轮舵机转向智能小车黑线循迹避障运动程序源代码面向智能小车爱好者、嵌入式初学者及单片机课程设计人群旨在解决前轮转向小车在循迹与避障场景下的运动控制问题。整个工程基于Keil4编写针对STM32F103C8T6芯片覆盖L293D电机驱动、TT直流减速电机、1602液晶显示、舵机转向、六路循迹模块与红外避障模块的协同控制逻辑完整作者已在实车上亲测可用。资源包共189个文件、2.18MB包含C语言源程序、头文件、启动汇编、Keil工程配置以及编译生成的hex烧录文件等还涉及定时器、RCC、ADC等标准外设驱动文件便于直接编译烧录也可在此基础上二次开发。目前已有677人学习下载可作前轮转向小车方案的参考样板帮助理解前轮舵机转向控制、黑线循迹算法、红外避障判断及PWM调速等关键环节适合竞赛准备与课程设计参考。1. 前轮转向小车循迹避障和两轮差速小车差在哪同样做黑线循迹和避障把两轮差速底盘换成前轮转向结构很多人第一版程序跑起来就发现车不走直线、弯道冲线、遇到障碍想原地掉头也做不到。这颗 STM32F103C8T6 最小系统板驱动前轮转向小车核心难点不在代码量而在运动模型变了后轮驱动、前轮舵机指向决定了小车只能靠转向角和车速配合实现曲线运动转弯半径有下限循迹和避障本质上是两个不同优先级的控制状态。这篇文章就围绕 STM32F103C8T6 来写把前轮转向运动学、灰度传感器循迹、超声波避障和状态仲裁拆开讲附上能直接改的 C 语言代码、参数表和调试方法适合正在做课设、竞赛车模或想理解轮式机器人运动控制的工程师对照落地。2. 前轮转向运动学阿克曼几何与舵机转向控制2.1 阿克曼转向几何左右前轮为什么不能转同样角度两轮差速小车的转向靠左右轮速度差实现车体可以绕自身中心旋转运动学上是典型的微分驱动模型。前轮转向小车则相反后轮是驱动轮前轮是转向轮转向时前轮并不是简单偏转同一个角度而是遵循阿克曼转向几何内侧轮的转角要大于外侧轮使四个车轮的瞬时转动中心交于同一点轮胎在弯道中才不会产生侧滑。实际车模的前轮转向结构大多是四连杆或五连杆做不出教科书级别的完整阿克曼但计算和调参时仍用阿克曼模型做近似。常用参数定义如下轴距L前轮轴到后轮轴的水平距离小车底盘尺寸决定典型值 1520cm。轮距T左右转向轮中心的间距典型值 1218cm。等效转角δ舵机带给主销的转向角也就是代码里最终输出的角度。转弯半径近似为R L / tan(δ)。这个式子决定了控制器设计的物理上限轴距越大、同样转角下转弯半径越大转向越迟钝轮距只影响内外轮转角分配不改变主转角下的半径。循迹时如果误差持续大于一个车身宽度靠加大转向角救不回来只能降速。所以在代码里转向角一般限制在 ±35° 而不是舵机物理极限 ±45°机械限位处的堵转电流和舵机抖动都会放大留出余量既是保护舵机也是给循迹的 PD 控制留出调节空间。2.2 舵机 PWM 中位校准与转向角映射转向舵机三根线电源、地、PWM 信号。PWM 频率固定 50Hz周期 20ms脉宽 1.0ms 对应一侧极限1.5ms 理论中位2.0ms 对应另一侧极限。STM32F103C8T6 通常用定时器 TIM2 或 TIM3 的 PWM 输出通道驱动信号线接任意带复用功能的引脚这里以 TIM2_CH3 在 PA2 输出为例// 舵机PWM初始化TIM2_CH3PA2输出50Hz void Servo_PWM_Init(void) { GPIO_InitTypeDef gpio; TIM_TimeBaseInitTypeDef tb; TIM_OCInitTypeDef oc; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); gpio.GPIO_Pin GPIO_Pin_2; gpio.GPIO_Mode GPIO_Mode_AF_PP; gpio.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, gpio); tb.TIM_Prescaler 72 - 1; // 72MHz分频到1MHz计数单位1us tb.TIM_CounterMode TIM_CounterMode_Up; tb.TIM_Period 20000 - 1; // 20000us 20ms周期 TIM_TimeBaseInit(TIM2, tb); oc.TIM_OCMode TIM_OCMode_PWM1; oc.TIM_OutputState TIM_OutputState_Enable; oc.TIM_Pulse 1500; // 1.5ms中位脉宽 TIM_OC3Init(TIM2, oc); TIM_OC3PreloadConfig(TIM2, TIM_OCPreload_Enable); TIM_Cmd(TIM2, ENABLE); }这段代码把系统主频 72MHz 分频到 1MHz计数器每 1us 加一重装值 20000 得到 20ms 周期TIM_Pulse设成 1500 对应 1.5ms 脉宽。后面转向时直接调用TIM_SetCompare3即可脉宽值和微秒数一比一不用换算。中位是不能信理论值的。同样标 1.5ms 的国产和进口舵机中位偏差可能到 ±20us表现就是直线循迹时前轮本身偏了一点车辆走 S 形。校准方法是通电后用代码从 1400 到 1600 每隔 10us 停留一秒扫一遍找到车轮刚好处在正中的脉宽值写进常量。舵机信号脉宽对应状态左极限1.0ms转向角 -45°中位1.5ms需实测校准转向角 0°右极限2.0ms转向角 45°转向角到脉宽的映射用线性关系#define SERVO_CENTER 1480 // 实测校准后的中位脉宽 #define SERVO_MIN 1120 // 左极限脉宽 #define SERVO_MAX 1880 // 右极限脉宽 void Servo_SetAngle(int8_t angle) { uint16_t pulse; if (angle 35) angle 35; if (angle -35) angle -35; if (angle 0) { pulse SERVO_CENTER (SERVO_MAX - SERVO_CENTER) * angle / 35; } else { pulse SERVO_CENTER - (SERVO_CENTER - SERVO_MIN) * (-angle) / 35; } TIM_SetCompare3(TIM2, pulse); }正负号约定要和机械装配保持一致。舵机装在车架左右两侧时转向方向容易取反所以Servo_SetAngle里建议加串口打印脉宽配合肉眼确认方向。2.3 转向角限制、车速前馈与电机驱动前轮转向小车过弯时速度必须降下来原因在R L / tan(δ)本身转向角确定后稳态转弯半径就定了入弯过程有延迟车速越快越容易冲出线外。代码里不要把转向和速度做成两个完全独立的控制器更常见的是由转向角实时反推速度上限。uint8_t speed 45 - (uint8_t)(abs(angle) * 0.8f); if (speed 20) speed 20; Motor_SetSpeed(speed);三个参数分别对应电机 PWM 上限 45、降速斜率 0.8 和最低速度 20数值按你的电机驱动原理图和电池电压调整。降压斜率越大弯道减速越明显直线恢复越快设置太高会导致频繁加减速电流冲击反而让循迹不稳定。电机驱动部分和舵机供电建议完全分开TB6612 或 DRV8833 的逻辑电源单独从 5V 取电机电源直接从电池取避免舵机堵转时把传感器 ADC 的参考电压拉偏。3. 黑线循迹传感器阈值、误差计算与 PD 转向3.1 循迹传感器布局与动态阈值校准循迹通常用 45 路红外反射传感器或灰度传感器。我一般推荐 5 路奇数路存在明确的中心传感器中心对准黑线中心时误差为 0而且误差正负对称。传感器做成弧形排列横向跨距 812cm间距 1.52cm间隔参照黑线宽度——通常比赛用的黑线宽 1.82cm传感器间距比线宽略小才能保证压线时至少一路有响应。读取方式上ST MCU 多路 GPIO 直接读数字量虽然简单但地线干扰和元器件差异会带来误判。STM32F103C8T6 的 PA0PA7 都带 ADC把 5 路传感器接 5 个 ADC 引脚用 12 位采样值做动态阈值抗环境光能力比固定比较器的方案好。上电时让小车平稳放在无黑线的地面上采样 50 次作为地面基准再推到全黑区域采样作为黑线基准。static uint16_t groundBase[5]; static uint16_t lineBase[5]; void Sensor_Calibrate(void) { // 先测地面再测黑线每路各自累计50次取平均 for (uint8_t i 0; i 5; i) { uint32_t sum 0; for (uint8_t k 0; k 50; k) { sum ADC_Read(i); // 12位ADC范围0~4095 Delay_ms(2); } groundBase[i] (uint16_t)(sum / 50); } // lineBase[] 的采集同理小车推至黑线上方执行 } uint8_t Sensor_GetState(uint8_t index) { uint16_t value ADC_Read(index); if (value (groundBase[index] lineBase[index]) / 2) return 1; // 检测到黑线 return 0; // 地面 }5 个传感器各自用独立基准而不是全系统共用一个固定阈值可以有效解决元器件离散性造成的某一路提前翻转、另一路延迟翻转问题。注意采集基准时传感器离地高度要保持一致手持晃动会让基准整体偏移。3.2 传感器权重、误差计算与 PD 转向控制5 路状态折算成连续误差值用加权法。每路传感器分配权重中心为 0向左依次为 -2、-1向右依次为 1、2检测到黑线就累加对应权重int16_t GetLineError(void) { int16_t error 0; error Sensor_GetState(0) ? -2 : 0; error Sensor_GetState(1) ? -1 : 0; error Sensor_GetState(2) ? 0 : 0; error Sensor_GetState(3) ? 1 : 0; error Sensor_GetState(4) ? 2 : 0; return error; }传感器位置权重含义最左-2黑线大幅偏左偏左-1黑线小幅偏左中心0黑线对准中心偏右1黑线小幅偏右最右2黑线大幅偏右误差不需要精确等于物理偏移量只要沿偏移方向单调、极限可区分即可。然后 PD 控制转向角static int16_t lastError 0; void LineFollow_Control(void) { int16_t error GetLineError(); float P 1.2f; float D 1.5f; int16_t angle; angle (int16_t)(P * error D * (error - lastError)); if (angle 35) angle 35; if (angle -35) angle -35; Servo_SetAngle((int8_t)angle); lastError error; uint8_t speed 45 - (uint8_t)(abs(angle) * 0.8f); if (speed 20) speed 20; Motor_SetSpeed(speed); }D 项在循迹里起阻尼作用。前轮转向舵机有响应延迟只有 P 项时小车会围绕黑线来回摆动误差越大转角越大转角大了又冲过线形成低频振荡。D 项对误差变化率做反向修正误差快速增大时抑制转角误差快速减小时提前回正这是直线稳定性和弯道跟线效果的关键。提示如果车在直线段持续摆头超过 1 秒先检查 D 项是否被主循环的阻塞破坏了采样周期再检查舵机中位。多数“PD 调不稳”的问题不在算法本身而在舵机中位不准和主循环周期抖动。P 和 D 的整定顺序建议先设 D0P 从 0.5 逐步加找到能稳定过中等弯道的临界值然后逐步加 D 直到直线上不再摆头。对前轮转向小车速度为 3050 油门时P 正常落在 1.02.0D 落在 0.82.5继续放大概率就是振荡。3.3 防冲线速度低通滤波与转向解耦基础 PD 在长直线末端接急弯时容易冲线因为误差信号来得晚P 项瞬间打到限幅。一个实用的技巧是把速度闭环和转向闭环解耦转向直接用当前误差速度用上一周期的误差或转向角平滑值。速度指令加一级低通滤波static uint8_t smoothSpeed 0; void Motor_SetSpeedFiltered(uint8_t target) { smoothSpeed (uint8_t)(smoothSpeed * 0.7f target * 0.3f); Motor_SetSpeed(smoothSpeed); }0.7 和 0.3 是速度低通系数让速度变化跟随转向角的整体趋势而不是被某一次误差跳变瞬间打满。效果是入弯前车先因为转向角增大而降速而不是冲到弯心才刹车过弯成功率明显提升。低通系数越大越平滑但响应也越慢如果直道末端接的是连续 S 弯0.6/0.4 的分配会更激进一些。4. 避障设计超声波滤波、状态机与循迹仲裁4.1 超声波测距与异常数据过滤避障传感器通常用 HC-SR04测距范围 2cm4m精度 ±3mm低速小车完全够用。模块就两个控制脚Trig 拉高 10us 以上触发测距Echo 输出高电平宽度和距离成正比。测量 Echo 高电平时间再乘声速的一半得到距离。主循环在跑循迹 PD 时如果用延时轮询等 Echo容易丢脉冲建议用定时器输入捕获或外部中断记录边沿// 假设Echo接PB4外部中断响应上升沿和下降沿 void EXTI4_IRQHandler(void) { static uint8_t edge 0; if (EXTI_GetITStatus(EXTI_Line4) ! RESET) { EXTI_ClearITPendingBit(EXTI_Line4); if (edge 0) { TIM_SetCounter(TIM4, 0); // 上升沿清零定时器 edge 1; } else { echoTicks TIM_GetCounter(TIM4); // 下降沿读出时间 edge 0; } } }TIM4 配置为 1MHz 自由计数echoTicks单位就是 us。距离换算用distance echoTicks / 58单位厘米数。58 来自声速换算往返时间除以 2 再乘 343m/s简化后就是除以 58。温度变化 10 度约产生 2% 误差避障触发距离取 2030cm完全在容忍范围内。异常数据过滤比测距本身更关键。HC-SR04 第一次测距经常返回 0物体表面不平整时还有跳变值。我在状态机上加三层过滤距离为 0 或超过 200cm 直接丢弃连续 5 次取中值不用平均值与上一次有效值差超过 30cm 时数据标记可疑不参与决策。取中值是为了滤掉瞬时反射干扰平均值反而会被一个异常大值整体拉偏避障对最近障碍距离更敏感中值更合理。4.2 前轮转向避障状态机设计前轮转向小车避障不能照抄差速车的“原地转身”逻辑。差速车可以 90 度转体绕开障碍再 90 度归位前轮转向的最小转弯半径可能已经接近障碍尺寸路径摆动幅度很大。最稳妥的是六状态机正常循迹、停车、左打满绕行、保持方向直行、右打回轨、重新找线。typedef enum { FSM_FOLLOW, // 正常循迹 FSM_BRAKE, // 检测到障碍停车 FSM_AVOID_LEFT, // 左打满绕行 FSM_AVOID_RIGHT, // 右打回轨方向 FSM_SEARCH_LINE // 重新找线 } CarFSM_t; CarFSM_t fsm FSM_FOLLOW; uint16_t fsmTimer 0; void Obstacle_Avoid(void) { switch (fsm) { case FSM_FOLLOW: if (ultraDist 0.1f ultraDist 25.0f) { fsm FSM_BRAKE; fsmTimer 0; } break; case FSM_BRAKE: Motor_SetSpeed(0); Servo_SetAngle(0); if (fsmTimer 80) // 80 * 10ms 0.8s { fsm FSM_AVOID_LEFT; fsmTimer 0; } break; case FSM_AVOID_LEFT: Servo_SetAngle(-30); Motor_SetSpeed(30); if (fsmTimer 150) // 1.5s横向绕行 { fsm FSM_AVOID_RIGHT; fsmTimer 0; } break; case FSM_AVOID_RIGHT: Servo_SetAngle(35); Motor_SetSpeed(30); if (lineDetected()) // 任一传感器压到黑线 { fsm FSM_SEARCH_LINE; fsmTimer 0; } break; case FSM_SEARCH_LINE: if (GetLineError() 0 lineDetected()) { fsm FSM_FOLLOW; Servo_SetAngle(0); } else if (fsmTimer 300) // 3s找不到线就继续摆头扫描 { Servo_SetAngle(25); } break; } }每个状态必须有明确的进入条件、执行动作和退出条件外加超时强制转移。FSM_BRAKE里的 0.8 秒强制转移是防止超声波偶发误触发把状态机卡死FSM_SEARCH_LINE的 300 个周期超时则是防止丢失黑线后无限摆动。超时参数按主循环节拍计算10ms 一个 tick150 就是 1.5s。状态退出条件超时保护FSM_FOLLOW距离 25cm不设超时FSM_BRAKE0.8s 定时结束1s 强制转移FSM_AVOID_LEFT1.5s 定时结束2sFSM_AVOID_RIGHT任一传感器压线3sFSM_SEARCH_LINE中心传感器压线5s 后停车4.3 避障与循迹的仲裁谁优先、何时切回避障和循迹同时开启时避障永远优先循迹只在避障结束并且重新检测到黑线时恢复。这个优先级不能靠一个简单的 if 嵌套实现因为两者都要持续控制转向和速度如果写成“先循迹再判断障碍”循迹控制器会在避障状态下继续覆盖舵机角度出现转向角叠加的乱输出。正确做法是主循环入口直接判断距离满足避障条件就走避障逻辑不满足才走循迹while (1) { ultraDist Ultrasonic_GetFilteredDistance(); if (ultraDist 0.1f ultraDist 25.0f) { Obstacle_Avoid(); // 进入避障状态机 } else { LineFollow_Control(); // 正常循迹PD } Delay_ms(10); }避障状态执行期间循迹函数不会被调用转向和速度完全由避障状态机接管。还有一个隐藏问题超声波朝前检测循迹过弯时检测到的可能是弯道外侧挡板而不是路径上的障碍。解决方法是给避障判定加一个约束条件只有abs(GetLineError()) 1也就是车头基本对准黑线时超声波距离才参与避障判断误差偏大说明车辆正在入弯这个周期跳过避障判定。5. 代码框架、固定节拍与串口在线调参5.1 主循环节拍与实际初始化顺序裸机程序按固定节拍跑让 PD 采样和超声波测距都在同一时间基准上。用定时器产生 10ms 中断置标志主循环每次处理一个 tick所有控制逻辑按节拍执行。初始化顺序建议系统主频、GPIO、定时器 PWM、串口、ADC 采样、传感器基准校准、舵机回中、电机归零最后打开全局中断进入主循环。传感器校准必须放在舵机回中之前因为校准过程需要小车静止舵机上电瞬间可能会有抖动先回中再校准可以避免车头偏移影响传感器对地面的采样。5.2 串口在线调参与对照表串口是调小车最重要的工具把 error、angle、speed、distance、状态机编号按固定周期上报。调试 PD 时不要每次改参数都重新烧写把 P 和 D 设成全局变量用串口中断在线修改void USART1_IRQHandler(void) { uint8_t ch USART_ReceiveData(USART1); if (ch q) Pgain 0.1f; else if (ch a) Pgain - 0.1f; else if (ch w) Dgain 0.1f; else if (ch s) Dgain - 0.1f; }串口通信波特率固定 115200调试效率比改一次烧一次快三四倍。实测时先把车架起、驱动轮悬空手动拨动前轮检查舵机方向再放地上跑直线看纠偏范围。调参参数典型范围设置建议舵机中位脉宽实测 ±20us换舵机必须重新校准转向角限幅±30° ~ ±40°留 10° 给机械限位循迹速度30% ~ 50% 油门直线快、弯道由转角反推避障触发距离20cm ~ 30cm大于车速 × 舵机延迟的 2 倍PD 采样周期10ms 固定必须固定否则 D 失效速度低通系数0.6 ~ 0.8越大越平滑响应越慢最后收在 D 项的真实含义上D 项完全依赖相邻两次误差的差值主循环如果被超声波等待或串口打印阻塞超过 5msD 项就失去了导数意义系统等价于在低采样率下跑 PD循迹效果会明显劣化。测距改成中断方式后串口打印只在整定阶段开启正式比赛或验收时关掉打印和调试标志。只有固定节拍下的 PD才是前轮转向小车真正能稳定复现的参数。本文还有配套的精品资源点击获取
简介STM32F103C8T6前轮舵机转向智能小车黑线循迹避障运动程序源代码面向智能小车爱好者、嵌入式初学者及单片机课程设计人群旨在解决前轮转向小车在循迹与避障场景下的运动控制问题。整个工程基于Keil4编写针对STM32F103C8T6芯片覆盖L293D电机驱动、TT直流减速电机、1602液晶显示、舵机转向、六路循迹模块与红外避障模块的协同控制逻辑完整作者已在实车上亲测可用。资源包共189个文件、2.18MB包含C语言源程序、头文件、启动汇编、Keil工程配置以及编译生成的hex烧录文件等还涉及定时器、RCC、ADC等标准外设驱动文件便于直接编译烧录也可在此基础上二次开发。目前已有677人学习下载可作前轮转向小车方案的参考样板帮助理解前轮舵机转向控制、黑线循迹算法、红外避障判断及PWM调速等关键环节适合竞赛准备与课程设计参考。1. 前轮转向小车循迹避障和两轮差速小车差在哪同样做黑线循迹和避障把两轮差速底盘换成前轮转向结构很多人第一版程序跑起来就发现车不走直线、弯道冲线、遇到障碍想原地掉头也做不到。这颗 STM32F103C8T6 最小系统板驱动前轮转向小车核心难点不在代码量而在运动模型变了后轮驱动、前轮舵机指向决定了小车只能靠转向角和车速配合实现曲线运动转弯半径有下限循迹和避障本质上是两个不同优先级的控制状态。这篇文章就围绕 STM32F103C8T6 来写把前轮转向运动学、灰度传感器循迹、超声波避障和状态仲裁拆开讲附上能直接改的 C 语言代码、参数表和调试方法适合正在做课设、竞赛车模或想理解轮式机器人运动控制的工程师对照落地。2. 前轮转向运动学阿克曼几何与舵机转向控制2.1 阿克曼转向几何左右前轮为什么不能转同样角度两轮差速小车的转向靠左右轮速度差实现车体可以绕自身中心旋转运动学上是典型的微分驱动模型。前轮转向小车则相反后轮是驱动轮前轮是转向轮转向时前轮并不是简单偏转同一个角度而是遵循阿克曼转向几何内侧轮的转角要大于外侧轮使四个车轮的瞬时转动中心交于同一点轮胎在弯道中才不会产生侧滑。实际车模的前轮转向结构大多是四连杆或五连杆做不出教科书级别的完整阿克曼但计算和调参时仍用阿克曼模型做近似。常用参数定义如下轴距L前轮轴到后轮轴的水平距离小车底盘尺寸决定典型值 1520cm。轮距T左右转向轮中心的间距典型值 1218cm。等效转角δ舵机带给主销的转向角也就是代码里最终输出的角度。转弯半径近似为R L / tan(δ)。这个式子决定了控制器设计的物理上限轴距越大、同样转角下转弯半径越大转向越迟钝轮距只影响内外轮转角分配不改变主转角下的半径。循迹时如果误差持续大于一个车身宽度靠加大转向角救不回来只能降速。所以在代码里转向角一般限制在 ±35° 而不是舵机物理极限 ±45°机械限位处的堵转电流和舵机抖动都会放大留出余量既是保护舵机也是给循迹的 PD 控制留出调节空间。2.2 舵机 PWM 中位校准与转向角映射转向舵机三根线电源、地、PWM 信号。PWM 频率固定 50Hz周期 20ms脉宽 1.0ms 对应一侧极限1.5ms 理论中位2.0ms 对应另一侧极限。STM32F103C8T6 通常用定时器 TIM2 或 TIM3 的 PWM 输出通道驱动信号线接任意带复用功能的引脚这里以 TIM2_CH3 在 PA2 输出为例// 舵机PWM初始化TIM2_CH3PA2输出50Hz void Servo_PWM_Init(void) { GPIO_InitTypeDef gpio; TIM_TimeBaseInitTypeDef tb; TIM_OCInitTypeDef oc; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); gpio.GPIO_Pin GPIO_Pin_2; gpio.GPIO_Mode GPIO_Mode_AF_PP; gpio.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, gpio); tb.TIM_Prescaler 72 - 1; // 72MHz分频到1MHz计数单位1us tb.TIM_CounterMode TIM_CounterMode_Up; tb.TIM_Period 20000 - 1; // 20000us 20ms周期 TIM_TimeBaseInit(TIM2, tb); oc.TIM_OCMode TIM_OCMode_PWM1; oc.TIM_OutputState TIM_OutputState_Enable; oc.TIM_Pulse 1500; // 1.5ms中位脉宽 TIM_OC3Init(TIM2, oc); TIM_OC3PreloadConfig(TIM2, TIM_OCPreload_Enable); TIM_Cmd(TIM2, ENABLE); }这段代码把系统主频 72MHz 分频到 1MHz计数器每 1us 加一重装值 20000 得到 20ms 周期TIM_Pulse设成 1500 对应 1.5ms 脉宽。后面转向时直接调用TIM_SetCompare3即可脉宽值和微秒数一比一不用换算。中位是不能信理论值的。同样标 1.5ms 的国产和进口舵机中位偏差可能到 ±20us表现就是直线循迹时前轮本身偏了一点车辆走 S 形。校准方法是通电后用代码从 1400 到 1600 每隔 10us 停留一秒扫一遍找到车轮刚好处在正中的脉宽值写进常量。舵机信号脉宽对应状态左极限1.0ms转向角 -45°中位1.5ms需实测校准转向角 0°右极限2.0ms转向角 45°转向角到脉宽的映射用线性关系#define SERVO_CENTER 1480 // 实测校准后的中位脉宽 #define SERVO_MIN 1120 // 左极限脉宽 #define SERVO_MAX 1880 // 右极限脉宽 void Servo_SetAngle(int8_t angle) { uint16_t pulse; if (angle 35) angle 35; if (angle -35) angle -35; if (angle 0) { pulse SERVO_CENTER (SERVO_MAX - SERVO_CENTER) * angle / 35; } else { pulse SERVO_CENTER - (SERVO_CENTER - SERVO_MIN) * (-angle) / 35; } TIM_SetCompare3(TIM2, pulse); }正负号约定要和机械装配保持一致。舵机装在车架左右两侧时转向方向容易取反所以Servo_SetAngle里建议加串口打印脉宽配合肉眼确认方向。2.3 转向角限制、车速前馈与电机驱动前轮转向小车过弯时速度必须降下来原因在R L / tan(δ)本身转向角确定后稳态转弯半径就定了入弯过程有延迟车速越快越容易冲出线外。代码里不要把转向和速度做成两个完全独立的控制器更常见的是由转向角实时反推速度上限。uint8_t speed 45 - (uint8_t)(abs(angle) * 0.8f); if (speed 20) speed 20; Motor_SetSpeed(speed);三个参数分别对应电机 PWM 上限 45、降速斜率 0.8 和最低速度 20数值按你的电机驱动原理图和电池电压调整。降压斜率越大弯道减速越明显直线恢复越快设置太高会导致频繁加减速电流冲击反而让循迹不稳定。电机驱动部分和舵机供电建议完全分开TB6612 或 DRV8833 的逻辑电源单独从 5V 取电机电源直接从电池取避免舵机堵转时把传感器 ADC 的参考电压拉偏。3. 黑线循迹传感器阈值、误差计算与 PD 转向3.1 循迹传感器布局与动态阈值校准循迹通常用 45 路红外反射传感器或灰度传感器。我一般推荐 5 路奇数路存在明确的中心传感器中心对准黑线中心时误差为 0而且误差正负对称。传感器做成弧形排列横向跨距 812cm间距 1.52cm间隔参照黑线宽度——通常比赛用的黑线宽 1.82cm传感器间距比线宽略小才能保证压线时至少一路有响应。读取方式上ST MCU 多路 GPIO 直接读数字量虽然简单但地线干扰和元器件差异会带来误判。STM32F103C8T6 的 PA0PA7 都带 ADC把 5 路传感器接 5 个 ADC 引脚用 12 位采样值做动态阈值抗环境光能力比固定比较器的方案好。上电时让小车平稳放在无黑线的地面上采样 50 次作为地面基准再推到全黑区域采样作为黑线基准。static uint16_t groundBase[5]; static uint16_t lineBase[5]; void Sensor_Calibrate(void) { // 先测地面再测黑线每路各自累计50次取平均 for (uint8_t i 0; i 5; i) { uint32_t sum 0; for (uint8_t k 0; k 50; k) { sum ADC_Read(i); // 12位ADC范围0~4095 Delay_ms(2); } groundBase[i] (uint16_t)(sum / 50); } // lineBase[] 的采集同理小车推至黑线上方执行 } uint8_t Sensor_GetState(uint8_t index) { uint16_t value ADC_Read(index); if (value (groundBase[index] lineBase[index]) / 2) return 1; // 检测到黑线 return 0; // 地面 }5 个传感器各自用独立基准而不是全系统共用一个固定阈值可以有效解决元器件离散性造成的某一路提前翻转、另一路延迟翻转问题。注意采集基准时传感器离地高度要保持一致手持晃动会让基准整体偏移。3.2 传感器权重、误差计算与 PD 转向控制5 路状态折算成连续误差值用加权法。每路传感器分配权重中心为 0向左依次为 -2、-1向右依次为 1、2检测到黑线就累加对应权重int16_t GetLineError(void) { int16_t error 0; error Sensor_GetState(0) ? -2 : 0; error Sensor_GetState(1) ? -1 : 0; error Sensor_GetState(2) ? 0 : 0; error Sensor_GetState(3) ? 1 : 0; error Sensor_GetState(4) ? 2 : 0; return error; }传感器位置权重含义最左-2黑线大幅偏左偏左-1黑线小幅偏左中心0黑线对准中心偏右1黑线小幅偏右最右2黑线大幅偏右误差不需要精确等于物理偏移量只要沿偏移方向单调、极限可区分即可。然后 PD 控制转向角static int16_t lastError 0; void LineFollow_Control(void) { int16_t error GetLineError(); float P 1.2f; float D 1.5f; int16_t angle; angle (int16_t)(P * error D * (error - lastError)); if (angle 35) angle 35; if (angle -35) angle -35; Servo_SetAngle((int8_t)angle); lastError error; uint8_t speed 45 - (uint8_t)(abs(angle) * 0.8f); if (speed 20) speed 20; Motor_SetSpeed(speed); }D 项在循迹里起阻尼作用。前轮转向舵机有响应延迟只有 P 项时小车会围绕黑线来回摆动误差越大转角越大转角大了又冲过线形成低频振荡。D 项对误差变化率做反向修正误差快速增大时抑制转角误差快速减小时提前回正这是直线稳定性和弯道跟线效果的关键。提示如果车在直线段持续摆头超过 1 秒先检查 D 项是否被主循环的阻塞破坏了采样周期再检查舵机中位。多数“PD 调不稳”的问题不在算法本身而在舵机中位不准和主循环周期抖动。P 和 D 的整定顺序建议先设 D0P 从 0.5 逐步加找到能稳定过中等弯道的临界值然后逐步加 D 直到直线上不再摆头。对前轮转向小车速度为 3050 油门时P 正常落在 1.02.0D 落在 0.82.5继续放大概率就是振荡。3.3 防冲线速度低通滤波与转向解耦基础 PD 在长直线末端接急弯时容易冲线因为误差信号来得晚P 项瞬间打到限幅。一个实用的技巧是把速度闭环和转向闭环解耦转向直接用当前误差速度用上一周期的误差或转向角平滑值。速度指令加一级低通滤波static uint8_t smoothSpeed 0; void Motor_SetSpeedFiltered(uint8_t target) { smoothSpeed (uint8_t)(smoothSpeed * 0.7f target * 0.3f); Motor_SetSpeed(smoothSpeed); }0.7 和 0.3 是速度低通系数让速度变化跟随转向角的整体趋势而不是被某一次误差跳变瞬间打满。效果是入弯前车先因为转向角增大而降速而不是冲到弯心才刹车过弯成功率明显提升。低通系数越大越平滑但响应也越慢如果直道末端接的是连续 S 弯0.6/0.4 的分配会更激进一些。4. 避障设计超声波滤波、状态机与循迹仲裁4.1 超声波测距与异常数据过滤避障传感器通常用 HC-SR04测距范围 2cm4m精度 ±3mm低速小车完全够用。模块就两个控制脚Trig 拉高 10us 以上触发测距Echo 输出高电平宽度和距离成正比。测量 Echo 高电平时间再乘声速的一半得到距离。主循环在跑循迹 PD 时如果用延时轮询等 Echo容易丢脉冲建议用定时器输入捕获或外部中断记录边沿// 假设Echo接PB4外部中断响应上升沿和下降沿 void EXTI4_IRQHandler(void) { static uint8_t edge 0; if (EXTI_GetITStatus(EXTI_Line4) ! RESET) { EXTI_ClearITPendingBit(EXTI_Line4); if (edge 0) { TIM_SetCounter(TIM4, 0); // 上升沿清零定时器 edge 1; } else { echoTicks TIM_GetCounter(TIM4); // 下降沿读出时间 edge 0; } } }TIM4 配置为 1MHz 自由计数echoTicks单位就是 us。距离换算用distance echoTicks / 58单位厘米数。58 来自声速换算往返时间除以 2 再乘 343m/s简化后就是除以 58。温度变化 10 度约产生 2% 误差避障触发距离取 2030cm完全在容忍范围内。异常数据过滤比测距本身更关键。HC-SR04 第一次测距经常返回 0物体表面不平整时还有跳变值。我在状态机上加三层过滤距离为 0 或超过 200cm 直接丢弃连续 5 次取中值不用平均值与上一次有效值差超过 30cm 时数据标记可疑不参与决策。取中值是为了滤掉瞬时反射干扰平均值反而会被一个异常大值整体拉偏避障对最近障碍距离更敏感中值更合理。4.2 前轮转向避障状态机设计前轮转向小车避障不能照抄差速车的“原地转身”逻辑。差速车可以 90 度转体绕开障碍再 90 度归位前轮转向的最小转弯半径可能已经接近障碍尺寸路径摆动幅度很大。最稳妥的是六状态机正常循迹、停车、左打满绕行、保持方向直行、右打回轨、重新找线。typedef enum { FSM_FOLLOW, // 正常循迹 FSM_BRAKE, // 检测到障碍停车 FSM_AVOID_LEFT, // 左打满绕行 FSM_AVOID_RIGHT, // 右打回轨方向 FSM_SEARCH_LINE // 重新找线 } CarFSM_t; CarFSM_t fsm FSM_FOLLOW; uint16_t fsmTimer 0; void Obstacle_Avoid(void) { switch (fsm) { case FSM_FOLLOW: if (ultraDist 0.1f ultraDist 25.0f) { fsm FSM_BRAKE; fsmTimer 0; } break; case FSM_BRAKE: Motor_SetSpeed(0); Servo_SetAngle(0); if (fsmTimer 80) // 80 * 10ms 0.8s { fsm FSM_AVOID_LEFT; fsmTimer 0; } break; case FSM_AVOID_LEFT: Servo_SetAngle(-30); Motor_SetSpeed(30); if (fsmTimer 150) // 1.5s横向绕行 { fsm FSM_AVOID_RIGHT; fsmTimer 0; } break; case FSM_AVOID_RIGHT: Servo_SetAngle(35); Motor_SetSpeed(30); if (lineDetected()) // 任一传感器压到黑线 { fsm FSM_SEARCH_LINE; fsmTimer 0; } break; case FSM_SEARCH_LINE: if (GetLineError() 0 lineDetected()) { fsm FSM_FOLLOW; Servo_SetAngle(0); } else if (fsmTimer 300) // 3s找不到线就继续摆头扫描 { Servo_SetAngle(25); } break; } }每个状态必须有明确的进入条件、执行动作和退出条件外加超时强制转移。FSM_BRAKE里的 0.8 秒强制转移是防止超声波偶发误触发把状态机卡死FSM_SEARCH_LINE的 300 个周期超时则是防止丢失黑线后无限摆动。超时参数按主循环节拍计算10ms 一个 tick150 就是 1.5s。状态退出条件超时保护FSM_FOLLOW距离 25cm不设超时FSM_BRAKE0.8s 定时结束1s 强制转移FSM_AVOID_LEFT1.5s 定时结束2sFSM_AVOID_RIGHT任一传感器压线3sFSM_SEARCH_LINE中心传感器压线5s 后停车4.3 避障与循迹的仲裁谁优先、何时切回避障和循迹同时开启时避障永远优先循迹只在避障结束并且重新检测到黑线时恢复。这个优先级不能靠一个简单的 if 嵌套实现因为两者都要持续控制转向和速度如果写成“先循迹再判断障碍”循迹控制器会在避障状态下继续覆盖舵机角度出现转向角叠加的乱输出。正确做法是主循环入口直接判断距离满足避障条件就走避障逻辑不满足才走循迹while (1) { ultraDist Ultrasonic_GetFilteredDistance(); if (ultraDist 0.1f ultraDist 25.0f) { Obstacle_Avoid(); // 进入避障状态机 } else { LineFollow_Control(); // 正常循迹PD } Delay_ms(10); }避障状态执行期间循迹函数不会被调用转向和速度完全由避障状态机接管。还有一个隐藏问题超声波朝前检测循迹过弯时检测到的可能是弯道外侧挡板而不是路径上的障碍。解决方法是给避障判定加一个约束条件只有abs(GetLineError()) 1也就是车头基本对准黑线时超声波距离才参与避障判断误差偏大说明车辆正在入弯这个周期跳过避障判定。5. 代码框架、固定节拍与串口在线调参5.1 主循环节拍与实际初始化顺序裸机程序按固定节拍跑让 PD 采样和超声波测距都在同一时间基准上。用定时器产生 10ms 中断置标志主循环每次处理一个 tick所有控制逻辑按节拍执行。初始化顺序建议系统主频、GPIO、定时器 PWM、串口、ADC 采样、传感器基准校准、舵机回中、电机归零最后打开全局中断进入主循环。传感器校准必须放在舵机回中之前因为校准过程需要小车静止舵机上电瞬间可能会有抖动先回中再校准可以避免车头偏移影响传感器对地面的采样。5.2 串口在线调参与对照表串口是调小车最重要的工具把 error、angle、speed、distance、状态机编号按固定周期上报。调试 PD 时不要每次改参数都重新烧写把 P 和 D 设成全局变量用串口中断在线修改void USART1_IRQHandler(void) { uint8_t ch USART_ReceiveData(USART1); if (ch q) Pgain 0.1f; else if (ch a) Pgain - 0.1f; else if (ch w) Dgain 0.1f; else if (ch s) Dgain - 0.1f; }串口通信波特率固定 115200调试效率比改一次烧一次快三四倍。实测时先把车架起、驱动轮悬空手动拨动前轮检查舵机方向再放地上跑直线看纠偏范围。调参参数典型范围设置建议舵机中位脉宽实测 ±20us换舵机必须重新校准转向角限幅±30° ~ ±40°留 10° 给机械限位循迹速度30% ~ 50% 油门直线快、弯道由转角反推避障触发距离20cm ~ 30cm大于车速 × 舵机延迟的 2 倍PD 采样周期10ms 固定必须固定否则 D 失效速度低通系数0.6 ~ 0.8越大越平滑响应越慢最后收在 D 项的真实含义上D 项完全依赖相邻两次误差的差值主循环如果被超声波等待或串口打印阻塞超过 5msD 项就失去了导数意义系统等价于在低采样率下跑 PD循迹效果会明显劣化。测距改成中断方式后串口打印只在整定阶段开启正式比赛或验收时关掉打印和调试标志。只有固定节拍下的 PD才是前轮转向小车真正能稳定复现的参数。本文还有配套的精品资源点击获取
