简介一套基于STM32的智能搬运码垛小车完整工程资源面向单片机学习者、嵌入式开发者和自动化相关专业学生适用于研究小车运动控制、机械臂抓取与传感器融合定位等场景。资料涵盖STM32核心控制代码、伺服电机与舵机驱动、颜色识别、超声波避障及QTI力感知等模块并附带Keil工程文件、编译中间文件、hex固件及调试文档便于直接打开工程查看软硬件交互逻辑。压缩包共772个文件以C源码.c、头文件.h为主辅以uvproj工程配置、hex固件、map/lst调试文件及txt说明文档整体大小约15.83MB。已有1340人下载学习。通过本项目可掌握多传感器协同控制方法、电机闭环调节思路以及码垛任务的状态机设计适合需要完整嵌入式项目范例以提升综合开发能力的读者。1. 先分清搬运码垛小车到底难在哪闭环、时序和定位STM32智能搬运码垛小车这个标题的含金量不在STM32的选型也不在底盘跑得多快而在“码垛”两个字。一辆会跑的循迹小车入门教程遍地都是但要从取货点抓起一个货块、沿路走到码垛区、按两层三列摆好、再回到起点等下一趟这套完整动作链才算闭环。搬运码垛小车要处理的不只是电机转不转还有去哪里、抬多高、什么时候松手本质上是运动控制加动作时序的组合。这套项目适合准备课设、竞赛作品或者刚入嵌入式控制方向想做点有完成度的东西的人不需要上视觉把轮子、编码器和舵机配合好就已经能做出一个能演示、能答辩、能复现的完整项目。2. 硬件选型与系统骨架围绕STM32怎么搭一条能走能抓的主链路搬运码垛小车的硬件可以切成三条链底盘驱动链负责走码垛机构链负责抓和放控制与感知链负责告诉车“现在在哪、下一步干什么”。三条链之间没有太深的耦合先把每条链上的关键器件选对后面调PID和写时序才能少翻车。我常看到有人一上来就纠结主控要不要上F407、要不要加FreeRTOS实际上一辆码垛小车最重的计算也就是速度环和舵机角度映射根本喂不饱和。控制逻辑的主体是一张状态机表和三五个PID芯片资源和OS都不是瓶颈选型的第一要素是外设够用、开发资料多、坏了能马上换。2.1 主控选型STM32F103C8T6是多数项目的最优解就搬运码垛这个负载来说STM32F103C8T6几乎是为它量身定做的72MHz主频两路高级定时器加两路通用定时器正好能覆盖两路电机PWM、两路编码器计数和一路舵机PWM再加上串口、I2C、ADCOLED显示和电池电压检测也都接得下。F103C8T6这一类芯片虽然flash不算大但搬运码垛小车的代码量通常在几千行以内64KB完全够。如果后续想加蓝牙遥控或者串级PID也只是多占几十行代码不需要因此升级主控。F407的优势是主频高、定时器多但对这个场景属于性能过剩。反而要注意的是F103的编码器模式在同一时刻不能既当编码器输入又当PWM输出所以两路电机用TIM2出PWM编码器用TIM3和TIM4采集舵机单独挂到TIM1的通道上这样外设分配才不会打架。完整的外设规划如下表。外设作用说明TIM2左右电机PWM输出输出比较模式频率调到16kHz左右TIM3 / TIM4左右电机编码器输入编码器模式采集霍尔编码器AB相TIM1舵机PWM输出50Hz周期控制升降舵机和夹爪TIM610ms时基中断读编码器、跑PID、刷新状态机USART1串口调试打印实际转速、PID输出、当前状态I2C1OLED显示屏显示状态、电池电压、故障码ADC1电池电压采样分压后监测主电源是否掉压2.2 电机驱动选型TB6612比L298N更适合这个场景电机驱动板在搬运小车上直接决定两件事发热和续航。L298N是很多教程里的默认选项但它用的是三极管饱和导通压降经常超过两伏电池电压稍微低一点电机端的实际电压就掉得很厉害。码垛小车要爬坡、要反复启停电流本来就是脉冲式的L298N在这种工况下发热很明显是常见的“电机没劲”根源。TB6612或同级别的MOSFET驱动芯片导通压降只有零点几伏体积也小得多可以直接焊在主控板底下或者立着贴在小车底盘上。单路持续电流虽然标称比L298N小但对于30cm级别的小车、130到370电机、堵转电流不超过2A的情况完全够用。如果做的是载重更高的搬运平台电机已经用到大扭矩减速电机那就该考虑带散热片的更大电流驱动而不是继续在L298N和TB6612之间纠结。对比项TB6612L298N导通压降0.5V左右2V左右发热低高尺寸拇指大小巴掌大小持续电流1.2A每路2A每路逻辑电压3.3V/5V兼容5V逻辑电平适合场景中小型搬运小车大功率底盘选驱动板时还要确认逻辑电平F103的IO是3.3V部分L298N模块的逻辑输入需要5V直接接STM32可能出现电平识别不稳定。TB6612的逻辑输入兼容3.3V省掉一个电平转换的麻烦。2.3 码垛机构两种方案舵机夹爪和丝杆升降台码垛机构的方案选择取决于你要搬运的货物长什么样、有多重。最常见也最容易复现的是舵机夹爪方案一个标准舵机控制夹爪开合另一个舵机或小型推杆负责升降。夹爪用两片亚克力或PLA打印件内侧贴一层泡棉或橡胶就能夹住纸盒、瓶子、3D打印的测试块。这方案的好处是结构轻、控制简单、响应快坏处是夹持力有限超过500克的货物基本抓不稳。另一个更接近工业形态的方案是小行程丝杆升降台加上固定托板小车到位后升降台把货物抬到目标层高托板低端一撤货物滑进垛位。这种方案载重能力大得多码垛高度也更规整但需要额外一路电机驱动动作慢换向时还有回程间隙控制时序要专门处理。我一般建议做课设或竞赛演示用舵机夹爪理由很实际舵机的角度控制是一个定时器通道就能解决的事而丝杆升降涉及限位、堵转保护、停止位置标定调起来至少多花三天。先把夹爪方案跑通如果答辩时被问到载重能力再说明升级到丝杆方案的技术路径反而更能体现你清楚两种方案的边界。2.4 电源分配12V电池不能直接喂给舵机这是新手最容易忽略的地方。底盘电机直接用电池电压供电没问题但STM32、编码器、舵机和传感器不能全挂在同一个未经稳压的电源上。电机启动瞬间会拉低母线电压如果单片机和舵机直接从同一根线上取电轻则复位重则flash里的配置被改写这是典型的“跑一下就死机”的玄学问题。常见做法是3S锂电池标称11.1V给电机驱动供电电池出来接一个DC-DC降压模块输出5V/3A左右一路给STM32板和编码器另一路给舵机供电。要注意舵机堵转电流很大标准舵机堵转可能到1A以上所以舵机电源和单片机电源要从降压模块出来之后分两路走各走各的接线端子避免舵机堵转的尖峰串进单片机电源域。给一份我做过的低成本配置清单参考不用照抄但按这个思路选不会出大问题部件常见规格数量用途主控板STM32F103C8T6最小系统板1控制核心电机带编码器的直流减速电机2左右轮驱动减速比1:30左右电机驱动TB6612模块1双路H桥编码器霍尔AB相编码器2测速与里程舵机9g或20kg级别共2个2夹爪开合 升降电源3S锂电池 5V/3A降压1动力与逻辑分开供电传感器光电反射开关1到2到位校准和边界检测3. 底盘运动控制落地编码器测速、PID调速和差速转向底盘是所有动作的载体底盘运动控制没做好后面码垛位置歪了、夹爪对不齐都是从这里累积出来的。搬运码垛小车对底盘的要求不是快而是“每次停在同一位置”。要给出一致的停靠结果必须满足两个前提轮子转速闭环可控左右轮速度差可控。这两点分别对应编码器测速加PID以及差速转向公式。3.1 编码器测速与PWM输出先把轮子转速变成能读的数搬运小车用的直流减速电机通常是带霍尔编码器的型号减速比1:30左右时输出轴转一圈对应电机轴转30圈编码器输出轴端的脉冲数会乘上这个减速比。假设编码器线数是13线4倍频后电机轴每圈52个计数再乘减速比30输出轴转一圈就是1560个计数。这个数后续要经常用写代码时最好定义成宏不要散落在计算公式里。PWM输出这边有一个关键参数频率。很多默认工程把PWM频率设在1kHz电机在1kHz下会产生明显的啸叫转速也会跟着PWM纹波抖动。常见做法是让PWM频率落在16kHz以上超过人耳可听范围电机的电流也更连续。/* TIM2 CH1/CH2输出16kHz的PWM驱动左右电机 */ void MotorPWM_Init(void) { __HAL_RCC_TIM2_CLK_ENABLE(); htim2.Instance TIM2; htim2.Init.Prescaler 0; /* 72MHz / (01) 72MHz 计数频率 */ htim2.Init.Period 4499; /* 72MHz / 4500 16kHz */ htim2.Init.CounterMode TIM_COUNTERMODE_UP; HAL_TIM_PWM_Init(htim2); TIM_OC_InitTypeDef oc {0}; oc.OCMode TIM_OCMODE_PWM1; oc.Pulse 0; /* 初始占空比为0 */ oc.OCPolarity TIM_OCPOLARITY_HIGH; HAL_TIM_PWM_ConfigChannel(htim2, oc, TIM_CHANNEL_1); HAL_TIM_PWM_ConfigChannel(htim2, oc, TIM_CHANNEL_2); HAL_TIM_PWM_Start(htim2, TIM_CHANNEL_1); HAL_TIM_PWM_Start(htim2, TIM_CHANNEL_2); } /* TIM3编码器模式统计左电机AB相脉冲 */ void Encoder_Init(void) { __HAL_RCC_TIM3_CLK_ENABLE(); TIM_Encoder_InitTypeDef enc {0}; enc.EncoderMode TIM_ENCODERMODE_TI12; /* 双沿采样4倍频 */ enc.IC1Polarity TIM_ICPOLARITY_RISING; enc.IC2Polarity TIM_ICPOLARITY_RISING; /* 若方向反把这里改成下降沿 */ enc.IC1Prescaler TIM_ICPSC_DIV1; enc.IC2Prescaler TIM_ICPSC_DIV1; enc.IC1Filter 0x0F; /* 滤波去掉毛刺 */ enc.IC2Filter 0x0F; htim3.Instance TIM3; htim3.Init.Period 0xFFFF; /* 16位自动重装 */ HAL_TIM_Encoder_Init(htim3, enc); HAL_TIM_Encoder_Start(htim3, TIM_CHANNEL_ALL); __HAL_TIM_SET_COUNTER(htim3, 0); }编码器初始化里最值得说的是IC1Filter这个字段。霍尔编码器的信号在电机启动瞬间容易带毛刺不滤波的话后续PID读到的速度会一跳一跳的调到后面全是噪音。把滤波器开到一个合理档位能省很多排查时间。方向反了不必改接线把IC1Polarity改成下降沿或者读回负数后直接取反效果一样。3.2 PID速度环三个参数怎么调才不飘有了编码器读数下一步是让轮子精确转到目标转速。直流减速电机的转速随负载变化很明显搬运小车载货前后负载差异大开环PWM根本稳不住速度所以必须做反馈闭环。搬运速度环最常用的是增量式PID配合一个10ms定时中断读取当前速度计算输出增量。参数整定上我习惯遵循一个顺序先把Kp从0慢慢往上加让速度能接近目标但不震荡再加Ki消除稳态误差最后加一点Kd抑制超调。Kd在速度环里很容易引入噪声因为微分对高频干扰敏感编码器读数的波动会被放大所以Kd一般是三个参数里最小的甚至有些速度环只做PI就够了。/* 10ms定时中断读编码器、算实际速度、跑PID、更新占空比 */ void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance ! TIM6) return; int16_t cnt (int16_t)__HAL_TIM_GET_COUNTER(htim3); __HAL_TIM_SET_COUNTER(htim3, 0); /* cnt是10ms内的编码器脉冲数乘以100折算成“每秒计数” */ int16_t speed_actual cnt * 100; int16_t pid_out SpeedPID(target_speed_L, speed_actual); /* 上一次占空比数值加上增量然后限幅到±1800 */ static int16_t last_ccr_L 0; last_ccr_L pid_out; if (last_ccr_L 1800) last_ccr_L 1800; if (last_ccr_L -1800) last_ccr_L -1800; /* 负值代表反转TB6612需要切换IN1/IN2方向 */ if (last_ccr_L 0) { HAL_GPIO_WritePin(MOTORL_IN1_GPIO_Port, MOTORL_IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(MOTORL_IN2_GPIO_Port, MOTORL_IN2_Pin, GPIO_PIN_RESET); __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, last_ccr_L); } else { HAL_GPIO_WritePin(MOTORL_IN1_GPIO_Port, MOTORL_IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(MOTORL_IN2_GPIO_Port, MOTORL_IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, -last_ccr_L); } }速度环PID实现#define Kp 0.6f #define Ki 0.05f #define Kd 0.05f int16_t SpeedPID(int16_t target, int16_t actual) { static int16_t err_last 0; static int32_t err_sum 0; int16_t err target - actual; err_sum err; if (err_sum 500) err_sum 500; /* 积分限幅防饱和 */ if (err_sum -500) err_sum -500; float d_err err - err_last; err_last err; int32_t out (int32_t)(Kp * err Ki * err_sum Kd * d_err); return (out 400) ? 400 : ((out -400) ? -400 : out); }这里有两个容易被忽略的细节。第一是积分限幅没有它小车长时间堵转时err_sum会积累到很大一旦障碍物移开轮子会猛冲一下这就是“堵转后发疯”的原因。第二是输出限幅PID输出的是增量累加到占空比上但累加结果必须限制在PWM比较值的合法范围里否则超过ARR值后STM32的比较值会从高位溢出表现为占空比突然跳变。增量限幅我给的是±400配合Kp0.6单次输出修正量不超过当前占空比的百分之十几调试时从这个量级起步比较稳。3.3 差速转向搬运车行进时的两种姿态码垛小车在场地里只有两种姿态直行到目标垛位前以及原地旋转对准角度。两种姿态都可以用差速模型表达左右轮速度分别等于线速度加减一个角速度项。搬运小车的转向不需要像竞速车那样平滑过弯通常走到码垛区入口后原地转90度然后再直行对位这样每个动作都是可预测的。/* 设置差速linear为平均速度angular为角速度映射到左右轮目标转速 */ void SetDifferentialSpeed(int16_t linear, int16_t angular) { /* 角速度换算系数0.15由车体轮距决定实际按调试效果微调 */ int16_t diff (int16_t)(angular * 0.15f); target_speed_L linear diff; target_speed_R linear - diff; if (target_speed_L 1500) target_speed_L 1500; if (target_speed_L -1500) target_speed_L -1500; if (target_speed_R 1500) target_speed_R 1500; if (target_speed_R -1500) target_speed_R -1500; }原地旋转时linear给0angular给一个固定值左右轮速度相反车就会绕几何中心转。码垛对位最怕的是转完角度后车轮打滑导致航向偏掉所以我会在旋转前把速度降到很低旋转结束后延时200ms让车彻底停稳再进入直行对位。别小看这个停顿舵机抓取和底盘停稳如果有重叠货物会晃动放下去的位置就偏了。4. 码垛动作怎么规划舵机时序、垛位映射和到位检测底盘把货物运到码垛区之后真正考验控制逻辑的是码垛动作本身。码垛听起来只是“把东西放上去”但拆开看有三个问题夹爪什么时候张开、升降舵机转到哪一层、每个垛位在哪里。这三个问题的答案如果分散写在中断里各管各的程序很快就会变成一团乱麻。我一般会把码垛动作提前固定成一条“动作序列”码垛时只查表不现场算角度。4.1 舵机控制与抓取时序开合角度和抱紧力之间的取舍舵机控制的核心是50Hz周期下的PWM脉宽映射0.5ms到2.5ms对应0到180度。这个映射是所有舵机控制的基础写成一个通用函数后夹爪和升降舵机都复用同一个入口。/* 舵机角度设置50Hz周期脉宽500us~2500us */ void Servo_SetAngle(TIM_HandleTypeDef *htim, uint32_t channel, uint8_t angle) { if (angle 175) angle 175; /* 避免打到机械限位 */ if (angle 5) angle 5; uint32_t ccr 500 ((uint32_t)angle * 2000) / 180; __HAL_TIM_SET_COMPARE(htim, channel, ccr); }注意这个函数只负责把角度写到比较值寄存器舵机真正转到目标角度需要时间。标准舵机的响应时间通常在一两百毫秒级所以每次改角度后必须延时不能紧接着执行下一个机械动作。抓取时序上我常用的顺序是先下降、再张开、再闭合、最后上升放货时反过来先到位、再张开、小幅度后退、闭爪回收。夹爪的张开角度不要总给满给到刚好能包住货物外轮廓就行角度过大反而会让夹持行程变短小尺寸货物根本夹不住。升降舵机的角度选择也要留余量。看起来0到180度都能用但很多舵机在极限角度附近扭矩会下降而且机械结构的死点风险高我会把实际使用的角度限制在20度到160度之间。这样的话升降行程略小于理论值但重复精度更稳。4.2 垛位映射表两层三列的坐标怎么定义码垛规划的本质是把物理空间的垛位映射成一组底盘停靠距离和升降舵机角度。我做两层三列的码垛地图表按“先低后高、逐列摆放”的规则设计先把第一层三个位置放满再放第二层。这张表写死在代码里通过行列下标访问码垛顺序就是遍历下标。typedef struct { uint16_t run_mm; /* 从取货点前进到该垛位的距离单位mm */ uint8_t lift_deg; /* 升降舵机角度决定货物放置高度 */ } PalletCell; /* 两层三列码垛表第一层低角度第二层高角度 */ const PalletCell PAL_PLAN[2][3] { { { 100, 25 }, { 180, 25 }, { 260, 25 } }, /* 第一层高度角25度 */ { { 100, 80 }, { 180, 80 }, { 260, 80 } } /* 第二层高度角80度 */ }; #define GRIP_OPEN 150 /* 夹爪张开角度 */ #define GRIP_CLOSE 30 /* 夹爪闭合角度 */ void PlaceOnce(uint8_t layer, uint8_t col) { PalletCell cell PAL_PLAN[layer][col]; MoveByMillimeter(cell.run_mm); /* 底盘走指定距离 */ Servo_SetAngle(htim1, TIM_CHANNEL_2, cell.lift_deg); /* 升到目标层高 */ delay_ms(250); /* 等升降舵机到位 */ Servo_SetAngle(htim1, TIM_CHANNEL_1, GRIP_OPEN); /* 张开夹爪 */ delay_ms(300); /* 等货物脱离 */ MoveByMillimeter(-15); /* 后退15mm避免碰撞垛位 */ Servo_SetAngle(htim1, TIM_CHANNEL_1, GRIP_CLOSE); /* 闭爪收回 */ }这里有两个设计细节值得展开。第一第二层的高度是用升降舵机角度表达的没有用位移传感器角度和层高之间是近似线性关系调一次标定后重复精度一般够用。如果货物比较重导致舵机下垂角度和实际高度就不匹配了那时候才需要换丝杆方案或者加限位开关。第二放货时的“后退15mm”不是可有可无很多翻车都发生在夹爪松开后还停在原处货物其实还靠夹爪虚托着一闭爪又把货物带歪了。4.3 到位检测用限位开关还是编码器归零码垛小车的到位检测有三种常见做法限位开关、编码器里程、光电开关校准。限位开关是最可靠的绝对位置判据但每个垛位都装开关成本太高编码器里程适合长距离直线运动但轮子打滑会造成累计误差光电开关通常装在码垛区入口车身经过时触发用来把编码器计数归零消除之前的累计误差。我会结合着用运动过程中以编码器里程为主在进入码垛区入口处放一个光电反射开关车身挡光触发中断把里程计数清零。此后从入口到每个垛位的距离都是短距离相对运动误差很小这个方案比单纯依赖编码器靠谱得多也比每个垛位装限位开关省事。/* 光电开关触发中断入口清零里程 */ void EXTI_IRQHandler(void) { if (__HAL_GPIO_EXTI_GET_IT(SENSOR_PIN) ! RESET) { __HAL_GPIO_EXTI_CLEAR_IT(SENSOR_PIN); encoder_L 0; encoder_R 0; flag_entry_triggered 1; } }里程闭环函数用左右轮编码器的平均值作为判断依据因为单轮计数在转弯和打滑时都会漂移平均值能抵消一部分左右不均的偏差。长距离段之间加一个清零点是搬运小车定位最实用的低成本手段。5. 搬运码垛小车最常见的5个坑与排查方法这一章列的是我自己做搬运码垛小车时踩过、也帮别人排查过的问题。每条都按现象、原因、解决的顺序写适合在调试时对照定位。5.1 电机只抖不走还伴随着明显的电流声现象上电后电机嗡嗡响轮子小幅振动但转不起来用手摸电机壳发烫电池电压掉得很快。原因大概率是PWM频率太低。很多开发板模板默认把定时器分频做得很大PWM频率只有1kHz左右这个频率下直流电机的电感会限制电流上升导致转子只在每个周期的前段获得少量能量表现出来就是抖动。另一个常见原因是电源线太细电机启动瞬间压降太大芯片都被拉复位了表现是“一启动就重启”。解决先把PWM频率改到16kHz也就是把定时器的Prescaler设为0、Period设为4499然后用直径0.75平方毫米以上的硅胶线重新给驱动板供电最好从电池端直接焊接不走杜邦线。这两个改动做完抖动问题基本消失。5.2 PID一上电就冲过头转速来回震荡现象给定目标速度后轮子先猛加速然后明显减速到停再加速如此往复串口打印实际转速能看到一条围绕目标值大幅摆动的曲线。原因最常见的是Kp过大系统进入振荡其次是编码器AB相方向接反导致反馈符号错误PID把一个正误差当成负误差来纠正形成正反馈。还有一种隐蔽原因是没有做输出限幅PID输出累加到占空比后超出定时器ARR发生比较值回绕。解决先把Kp降到原来的一半以下Ki和Kd都清零确认转速能缓慢逼近目标然后检查编码器方向把车架起来用手缓慢转轮子观察串口打印的计数值是否和实际方向一致不对就把IC1Polarity改成下降沿。最后检查PID输出累加值是否永远落在0到1800之间超出则强制限幅。5.3 夹爪明明闭合了圆柱体货物还是滑落现象夹爪夹一个方形测试块没问题换成矿泉水瓶或圆管夹紧后稍微一晃就掉有时瓶身还被夹出了凹痕。原因夹爪接触面是平的圆柱体只有两条线接触压强很大但摩擦力小另外圆柱体受力后会产生轴向滑移平夹爪没有限制轴向移动的结构。解决在夹爪内侧贴一层2mm厚的泡棉双面胶或橡胶垫接触面会从线接触变成面接触摩擦力立刻上来如果你有条件打印夹爪把夹爪内壁改成V型槽V型槽能同时限制圆柱体的上下和左右移动。还有一个调试习惯夹持力靠舵机角度表达太紧会挤压货物太松会滑落实测时以夹住后轻轻抖动不脱落为准。5.4 码垛位置每次偏移几厘米越码越歪现象第一次放货位置正第二箱开始逐渐偏右或偏前到第三层时货块边缘已经超出了前一层甚至碰倒旁边的箱子。原因这是典型的累计误差问题。编码器里程依赖轮子滚动但小车在加速、负重和微转弯时都会打滑每次打滑损失几毫米经过几次动作放大成厘米级偏移。另外底盘每次停稳的瞬间惯性滑动也会贡献偏差车速越快偏差越大。解决在码垛区入口安装一个光电反射开关每次进码垛区时触发清零把累计误差重置掉。另外把最后一段直行的目标速度降到巡航速度的一半停稳后延时200ms再执行夹爪动作惯性滑移会大幅减少。我见过不少人把精力花在修改PID追求零误差实际上这个场景下做归零校准比调PID更治本。5.5 舵机一动作单片机就复位现象夹爪或升降舵机转动的瞬间OLED闪一下或者直接重启串口输出停在初始化日志处。原因舵机的堵转电流瞬间可以冲到1A以上如果舵机供电线和单片机供电线在同一个降压模块的同一路输出上电流突变引起的电压跌落会直接打到单片机的复位门槛。更严重的情况是电源线上寄生电感导致的负压尖峰。解决把舵机电源和单片机电源从降压模块出来后分两条支路供电各自独立走线到负载端在舵机电源端和单片机电源端各加一个470uF电解电容和一个0.1uF陶瓷电容陶瓷电容负责吸收高频尖峰电解电容负责稳住跌落。这个组合是我测过最有效的低成本抗复位方案。电源地线不要吝啬用同一根粗线在主电容处汇合避免形成地环路。6. 把控制逻辑收进状态机外加一个开机自检习惯前面几章的代码解决的是“单个动作怎么做”但一辆码垛小车需要连续完成取货、行走、摆放、归位一整套动作。如果这些动作用一堆延时调用硬串起来后期加一个传感器或者改一个时序都很痛苦。把逻辑收进状态机是这一步的关键也是搬运小车从“能跑”变成“像样”的分水岭。typedef enum { ST_IDLE, ST_PICK, /* 到取货点闭爪抓取 */ ST_LIFT, /* 升到运输高度 */ ST_DRIVE, /* 前往码垛区 */ ST_PLACE, /* 按垛位表放货 */ ST_RETURN /* 回取货点进入下一轮 */ } SysState; SysState state_cur ST_IDLE; void Task_StateMachine(void) { static uint8_t layer 0, col 0; switch (state_cur) { case ST_IDLE: if (start_button_pressed) state_cur ST_PICK; break; case ST_PICK: MoveByMillimeter(PICK_POSITION_MM); Servo_SetAngle(htim1, TIM_CHANNEL_1, GRIP_CLOSE); delay_ms(200); state_cur ST_LIFT; break; case ST_LIFT: Servo_SetAngle(htim1, TIM_CHANNEL_2, TRANSPORT_HEIGHT); delay_ms(250); state_cur ST_DRIVE; break; case ST_DRIVE: /* 到达码垛区入口光电开关清零里程 */ if (flag_entry_triggered) state_cur ST_PLACE; else SetDifferentialSpeed(SPEED_CRUISE, 0); break; case ST_PLACE: PlaceOnce(layer, col); col; if (col 3) { col 0; layer; } if (layer 2) state_cur ST_RETURN; else state_cur ST_DRIVE; break; case ST_RETURN: MoveByMillimeter(-RETURN_DISTANCE); layer 0; col 0; state_cur ST_IDLE; break; } }状态机的每个状态只负责一件事进入条件、执行动作、退出条件。我最开始调试时总希望把延时写短一点让动作快一些后来发现码垛动作的正确率依赖每个状态的稳定完成所以我在每个状态入口都加一个100ms超时如果状态没在预期时间内完成就进入故障状态并停止所有输出。这个习惯后来救过我很多次至少每次翻车都能从串口日志里看到卡在哪个状态而不是对着一个静止的小车猜原因。我建议所有状态都预留一个手动单步测试入口按键按一下状态机只前进一个状态。这样调试夹爪时序时不需要让小车完整跑一圈大大缩短了迭代周期。如果你能做到开机自检里包含“舵机回中、编码器清零、光电开关检测、电压低报警”这几项再配合状态机日志这台搬运码垛小车就已经具备了一个小型自动化设备该有的排错能力。希望这些从选型到排查的经验能帮你少走弯路也欢迎你按这个框架自己改出一套更顺手的码垛动作链。本文还有配套的精品资源点击获取
简介一套基于STM32的智能搬运码垛小车完整工程资源面向单片机学习者、嵌入式开发者和自动化相关专业学生适用于研究小车运动控制、机械臂抓取与传感器融合定位等场景。资料涵盖STM32核心控制代码、伺服电机与舵机驱动、颜色识别、超声波避障及QTI力感知等模块并附带Keil工程文件、编译中间文件、hex固件及调试文档便于直接打开工程查看软硬件交互逻辑。压缩包共772个文件以C源码.c、头文件.h为主辅以uvproj工程配置、hex固件、map/lst调试文件及txt说明文档整体大小约15.83MB。已有1340人下载学习。通过本项目可掌握多传感器协同控制方法、电机闭环调节思路以及码垛任务的状态机设计适合需要完整嵌入式项目范例以提升综合开发能力的读者。1. 先分清搬运码垛小车到底难在哪闭环、时序和定位STM32智能搬运码垛小车这个标题的含金量不在STM32的选型也不在底盘跑得多快而在“码垛”两个字。一辆会跑的循迹小车入门教程遍地都是但要从取货点抓起一个货块、沿路走到码垛区、按两层三列摆好、再回到起点等下一趟这套完整动作链才算闭环。搬运码垛小车要处理的不只是电机转不转还有去哪里、抬多高、什么时候松手本质上是运动控制加动作时序的组合。这套项目适合准备课设、竞赛作品或者刚入嵌入式控制方向想做点有完成度的东西的人不需要上视觉把轮子、编码器和舵机配合好就已经能做出一个能演示、能答辩、能复现的完整项目。2. 硬件选型与系统骨架围绕STM32怎么搭一条能走能抓的主链路搬运码垛小车的硬件可以切成三条链底盘驱动链负责走码垛机构链负责抓和放控制与感知链负责告诉车“现在在哪、下一步干什么”。三条链之间没有太深的耦合先把每条链上的关键器件选对后面调PID和写时序才能少翻车。我常看到有人一上来就纠结主控要不要上F407、要不要加FreeRTOS实际上一辆码垛小车最重的计算也就是速度环和舵机角度映射根本喂不饱和。控制逻辑的主体是一张状态机表和三五个PID芯片资源和OS都不是瓶颈选型的第一要素是外设够用、开发资料多、坏了能马上换。2.1 主控选型STM32F103C8T6是多数项目的最优解就搬运码垛这个负载来说STM32F103C8T6几乎是为它量身定做的72MHz主频两路高级定时器加两路通用定时器正好能覆盖两路电机PWM、两路编码器计数和一路舵机PWM再加上串口、I2C、ADCOLED显示和电池电压检测也都接得下。F103C8T6这一类芯片虽然flash不算大但搬运码垛小车的代码量通常在几千行以内64KB完全够。如果后续想加蓝牙遥控或者串级PID也只是多占几十行代码不需要因此升级主控。F407的优势是主频高、定时器多但对这个场景属于性能过剩。反而要注意的是F103的编码器模式在同一时刻不能既当编码器输入又当PWM输出所以两路电机用TIM2出PWM编码器用TIM3和TIM4采集舵机单独挂到TIM1的通道上这样外设分配才不会打架。完整的外设规划如下表。外设作用说明TIM2左右电机PWM输出输出比较模式频率调到16kHz左右TIM3 / TIM4左右电机编码器输入编码器模式采集霍尔编码器AB相TIM1舵机PWM输出50Hz周期控制升降舵机和夹爪TIM610ms时基中断读编码器、跑PID、刷新状态机USART1串口调试打印实际转速、PID输出、当前状态I2C1OLED显示屏显示状态、电池电压、故障码ADC1电池电压采样分压后监测主电源是否掉压2.2 电机驱动选型TB6612比L298N更适合这个场景电机驱动板在搬运小车上直接决定两件事发热和续航。L298N是很多教程里的默认选项但它用的是三极管饱和导通压降经常超过两伏电池电压稍微低一点电机端的实际电压就掉得很厉害。码垛小车要爬坡、要反复启停电流本来就是脉冲式的L298N在这种工况下发热很明显是常见的“电机没劲”根源。TB6612或同级别的MOSFET驱动芯片导通压降只有零点几伏体积也小得多可以直接焊在主控板底下或者立着贴在小车底盘上。单路持续电流虽然标称比L298N小但对于30cm级别的小车、130到370电机、堵转电流不超过2A的情况完全够用。如果做的是载重更高的搬运平台电机已经用到大扭矩减速电机那就该考虑带散热片的更大电流驱动而不是继续在L298N和TB6612之间纠结。对比项TB6612L298N导通压降0.5V左右2V左右发热低高尺寸拇指大小巴掌大小持续电流1.2A每路2A每路逻辑电压3.3V/5V兼容5V逻辑电平适合场景中小型搬运小车大功率底盘选驱动板时还要确认逻辑电平F103的IO是3.3V部分L298N模块的逻辑输入需要5V直接接STM32可能出现电平识别不稳定。TB6612的逻辑输入兼容3.3V省掉一个电平转换的麻烦。2.3 码垛机构两种方案舵机夹爪和丝杆升降台码垛机构的方案选择取决于你要搬运的货物长什么样、有多重。最常见也最容易复现的是舵机夹爪方案一个标准舵机控制夹爪开合另一个舵机或小型推杆负责升降。夹爪用两片亚克力或PLA打印件内侧贴一层泡棉或橡胶就能夹住纸盒、瓶子、3D打印的测试块。这方案的好处是结构轻、控制简单、响应快坏处是夹持力有限超过500克的货物基本抓不稳。另一个更接近工业形态的方案是小行程丝杆升降台加上固定托板小车到位后升降台把货物抬到目标层高托板低端一撤货物滑进垛位。这种方案载重能力大得多码垛高度也更规整但需要额外一路电机驱动动作慢换向时还有回程间隙控制时序要专门处理。我一般建议做课设或竞赛演示用舵机夹爪理由很实际舵机的角度控制是一个定时器通道就能解决的事而丝杆升降涉及限位、堵转保护、停止位置标定调起来至少多花三天。先把夹爪方案跑通如果答辩时被问到载重能力再说明升级到丝杆方案的技术路径反而更能体现你清楚两种方案的边界。2.4 电源分配12V电池不能直接喂给舵机这是新手最容易忽略的地方。底盘电机直接用电池电压供电没问题但STM32、编码器、舵机和传感器不能全挂在同一个未经稳压的电源上。电机启动瞬间会拉低母线电压如果单片机和舵机直接从同一根线上取电轻则复位重则flash里的配置被改写这是典型的“跑一下就死机”的玄学问题。常见做法是3S锂电池标称11.1V给电机驱动供电电池出来接一个DC-DC降压模块输出5V/3A左右一路给STM32板和编码器另一路给舵机供电。要注意舵机堵转电流很大标准舵机堵转可能到1A以上所以舵机电源和单片机电源要从降压模块出来之后分两路走各走各的接线端子避免舵机堵转的尖峰串进单片机电源域。给一份我做过的低成本配置清单参考不用照抄但按这个思路选不会出大问题部件常见规格数量用途主控板STM32F103C8T6最小系统板1控制核心电机带编码器的直流减速电机2左右轮驱动减速比1:30左右电机驱动TB6612模块1双路H桥编码器霍尔AB相编码器2测速与里程舵机9g或20kg级别共2个2夹爪开合 升降电源3S锂电池 5V/3A降压1动力与逻辑分开供电传感器光电反射开关1到2到位校准和边界检测3. 底盘运动控制落地编码器测速、PID调速和差速转向底盘是所有动作的载体底盘运动控制没做好后面码垛位置歪了、夹爪对不齐都是从这里累积出来的。搬运码垛小车对底盘的要求不是快而是“每次停在同一位置”。要给出一致的停靠结果必须满足两个前提轮子转速闭环可控左右轮速度差可控。这两点分别对应编码器测速加PID以及差速转向公式。3.1 编码器测速与PWM输出先把轮子转速变成能读的数搬运小车用的直流减速电机通常是带霍尔编码器的型号减速比1:30左右时输出轴转一圈对应电机轴转30圈编码器输出轴端的脉冲数会乘上这个减速比。假设编码器线数是13线4倍频后电机轴每圈52个计数再乘减速比30输出轴转一圈就是1560个计数。这个数后续要经常用写代码时最好定义成宏不要散落在计算公式里。PWM输出这边有一个关键参数频率。很多默认工程把PWM频率设在1kHz电机在1kHz下会产生明显的啸叫转速也会跟着PWM纹波抖动。常见做法是让PWM频率落在16kHz以上超过人耳可听范围电机的电流也更连续。/* TIM2 CH1/CH2输出16kHz的PWM驱动左右电机 */ void MotorPWM_Init(void) { __HAL_RCC_TIM2_CLK_ENABLE(); htim2.Instance TIM2; htim2.Init.Prescaler 0; /* 72MHz / (01) 72MHz 计数频率 */ htim2.Init.Period 4499; /* 72MHz / 4500 16kHz */ htim2.Init.CounterMode TIM_COUNTERMODE_UP; HAL_TIM_PWM_Init(htim2); TIM_OC_InitTypeDef oc {0}; oc.OCMode TIM_OCMODE_PWM1; oc.Pulse 0; /* 初始占空比为0 */ oc.OCPolarity TIM_OCPOLARITY_HIGH; HAL_TIM_PWM_ConfigChannel(htim2, oc, TIM_CHANNEL_1); HAL_TIM_PWM_ConfigChannel(htim2, oc, TIM_CHANNEL_2); HAL_TIM_PWM_Start(htim2, TIM_CHANNEL_1); HAL_TIM_PWM_Start(htim2, TIM_CHANNEL_2); } /* TIM3编码器模式统计左电机AB相脉冲 */ void Encoder_Init(void) { __HAL_RCC_TIM3_CLK_ENABLE(); TIM_Encoder_InitTypeDef enc {0}; enc.EncoderMode TIM_ENCODERMODE_TI12; /* 双沿采样4倍频 */ enc.IC1Polarity TIM_ICPOLARITY_RISING; enc.IC2Polarity TIM_ICPOLARITY_RISING; /* 若方向反把这里改成下降沿 */ enc.IC1Prescaler TIM_ICPSC_DIV1; enc.IC2Prescaler TIM_ICPSC_DIV1; enc.IC1Filter 0x0F; /* 滤波去掉毛刺 */ enc.IC2Filter 0x0F; htim3.Instance TIM3; htim3.Init.Period 0xFFFF; /* 16位自动重装 */ HAL_TIM_Encoder_Init(htim3, enc); HAL_TIM_Encoder_Start(htim3, TIM_CHANNEL_ALL); __HAL_TIM_SET_COUNTER(htim3, 0); }编码器初始化里最值得说的是IC1Filter这个字段。霍尔编码器的信号在电机启动瞬间容易带毛刺不滤波的话后续PID读到的速度会一跳一跳的调到后面全是噪音。把滤波器开到一个合理档位能省很多排查时间。方向反了不必改接线把IC1Polarity改成下降沿或者读回负数后直接取反效果一样。3.2 PID速度环三个参数怎么调才不飘有了编码器读数下一步是让轮子精确转到目标转速。直流减速电机的转速随负载变化很明显搬运小车载货前后负载差异大开环PWM根本稳不住速度所以必须做反馈闭环。搬运速度环最常用的是增量式PID配合一个10ms定时中断读取当前速度计算输出增量。参数整定上我习惯遵循一个顺序先把Kp从0慢慢往上加让速度能接近目标但不震荡再加Ki消除稳态误差最后加一点Kd抑制超调。Kd在速度环里很容易引入噪声因为微分对高频干扰敏感编码器读数的波动会被放大所以Kd一般是三个参数里最小的甚至有些速度环只做PI就够了。/* 10ms定时中断读编码器、算实际速度、跑PID、更新占空比 */ void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance ! TIM6) return; int16_t cnt (int16_t)__HAL_TIM_GET_COUNTER(htim3); __HAL_TIM_SET_COUNTER(htim3, 0); /* cnt是10ms内的编码器脉冲数乘以100折算成“每秒计数” */ int16_t speed_actual cnt * 100; int16_t pid_out SpeedPID(target_speed_L, speed_actual); /* 上一次占空比数值加上增量然后限幅到±1800 */ static int16_t last_ccr_L 0; last_ccr_L pid_out; if (last_ccr_L 1800) last_ccr_L 1800; if (last_ccr_L -1800) last_ccr_L -1800; /* 负值代表反转TB6612需要切换IN1/IN2方向 */ if (last_ccr_L 0) { HAL_GPIO_WritePin(MOTORL_IN1_GPIO_Port, MOTORL_IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(MOTORL_IN2_GPIO_Port, MOTORL_IN2_Pin, GPIO_PIN_RESET); __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, last_ccr_L); } else { HAL_GPIO_WritePin(MOTORL_IN1_GPIO_Port, MOTORL_IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(MOTORL_IN2_GPIO_Port, MOTORL_IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(htim2, TIM_CHANNEL_1, -last_ccr_L); } }速度环PID实现#define Kp 0.6f #define Ki 0.05f #define Kd 0.05f int16_t SpeedPID(int16_t target, int16_t actual) { static int16_t err_last 0; static int32_t err_sum 0; int16_t err target - actual; err_sum err; if (err_sum 500) err_sum 500; /* 积分限幅防饱和 */ if (err_sum -500) err_sum -500; float d_err err - err_last; err_last err; int32_t out (int32_t)(Kp * err Ki * err_sum Kd * d_err); return (out 400) ? 400 : ((out -400) ? -400 : out); }这里有两个容易被忽略的细节。第一是积分限幅没有它小车长时间堵转时err_sum会积累到很大一旦障碍物移开轮子会猛冲一下这就是“堵转后发疯”的原因。第二是输出限幅PID输出的是增量累加到占空比上但累加结果必须限制在PWM比较值的合法范围里否则超过ARR值后STM32的比较值会从高位溢出表现为占空比突然跳变。增量限幅我给的是±400配合Kp0.6单次输出修正量不超过当前占空比的百分之十几调试时从这个量级起步比较稳。3.3 差速转向搬运车行进时的两种姿态码垛小车在场地里只有两种姿态直行到目标垛位前以及原地旋转对准角度。两种姿态都可以用差速模型表达左右轮速度分别等于线速度加减一个角速度项。搬运小车的转向不需要像竞速车那样平滑过弯通常走到码垛区入口后原地转90度然后再直行对位这样每个动作都是可预测的。/* 设置差速linear为平均速度angular为角速度映射到左右轮目标转速 */ void SetDifferentialSpeed(int16_t linear, int16_t angular) { /* 角速度换算系数0.15由车体轮距决定实际按调试效果微调 */ int16_t diff (int16_t)(angular * 0.15f); target_speed_L linear diff; target_speed_R linear - diff; if (target_speed_L 1500) target_speed_L 1500; if (target_speed_L -1500) target_speed_L -1500; if (target_speed_R 1500) target_speed_R 1500; if (target_speed_R -1500) target_speed_R -1500; }原地旋转时linear给0angular给一个固定值左右轮速度相反车就会绕几何中心转。码垛对位最怕的是转完角度后车轮打滑导致航向偏掉所以我会在旋转前把速度降到很低旋转结束后延时200ms让车彻底停稳再进入直行对位。别小看这个停顿舵机抓取和底盘停稳如果有重叠货物会晃动放下去的位置就偏了。4. 码垛动作怎么规划舵机时序、垛位映射和到位检测底盘把货物运到码垛区之后真正考验控制逻辑的是码垛动作本身。码垛听起来只是“把东西放上去”但拆开看有三个问题夹爪什么时候张开、升降舵机转到哪一层、每个垛位在哪里。这三个问题的答案如果分散写在中断里各管各的程序很快就会变成一团乱麻。我一般会把码垛动作提前固定成一条“动作序列”码垛时只查表不现场算角度。4.1 舵机控制与抓取时序开合角度和抱紧力之间的取舍舵机控制的核心是50Hz周期下的PWM脉宽映射0.5ms到2.5ms对应0到180度。这个映射是所有舵机控制的基础写成一个通用函数后夹爪和升降舵机都复用同一个入口。/* 舵机角度设置50Hz周期脉宽500us~2500us */ void Servo_SetAngle(TIM_HandleTypeDef *htim, uint32_t channel, uint8_t angle) { if (angle 175) angle 175; /* 避免打到机械限位 */ if (angle 5) angle 5; uint32_t ccr 500 ((uint32_t)angle * 2000) / 180; __HAL_TIM_SET_COMPARE(htim, channel, ccr); }注意这个函数只负责把角度写到比较值寄存器舵机真正转到目标角度需要时间。标准舵机的响应时间通常在一两百毫秒级所以每次改角度后必须延时不能紧接着执行下一个机械动作。抓取时序上我常用的顺序是先下降、再张开、再闭合、最后上升放货时反过来先到位、再张开、小幅度后退、闭爪回收。夹爪的张开角度不要总给满给到刚好能包住货物外轮廓就行角度过大反而会让夹持行程变短小尺寸货物根本夹不住。升降舵机的角度选择也要留余量。看起来0到180度都能用但很多舵机在极限角度附近扭矩会下降而且机械结构的死点风险高我会把实际使用的角度限制在20度到160度之间。这样的话升降行程略小于理论值但重复精度更稳。4.2 垛位映射表两层三列的坐标怎么定义码垛规划的本质是把物理空间的垛位映射成一组底盘停靠距离和升降舵机角度。我做两层三列的码垛地图表按“先低后高、逐列摆放”的规则设计先把第一层三个位置放满再放第二层。这张表写死在代码里通过行列下标访问码垛顺序就是遍历下标。typedef struct { uint16_t run_mm; /* 从取货点前进到该垛位的距离单位mm */ uint8_t lift_deg; /* 升降舵机角度决定货物放置高度 */ } PalletCell; /* 两层三列码垛表第一层低角度第二层高角度 */ const PalletCell PAL_PLAN[2][3] { { { 100, 25 }, { 180, 25 }, { 260, 25 } }, /* 第一层高度角25度 */ { { 100, 80 }, { 180, 80 }, { 260, 80 } } /* 第二层高度角80度 */ }; #define GRIP_OPEN 150 /* 夹爪张开角度 */ #define GRIP_CLOSE 30 /* 夹爪闭合角度 */ void PlaceOnce(uint8_t layer, uint8_t col) { PalletCell cell PAL_PLAN[layer][col]; MoveByMillimeter(cell.run_mm); /* 底盘走指定距离 */ Servo_SetAngle(htim1, TIM_CHANNEL_2, cell.lift_deg); /* 升到目标层高 */ delay_ms(250); /* 等升降舵机到位 */ Servo_SetAngle(htim1, TIM_CHANNEL_1, GRIP_OPEN); /* 张开夹爪 */ delay_ms(300); /* 等货物脱离 */ MoveByMillimeter(-15); /* 后退15mm避免碰撞垛位 */ Servo_SetAngle(htim1, TIM_CHANNEL_1, GRIP_CLOSE); /* 闭爪收回 */ }这里有两个设计细节值得展开。第一第二层的高度是用升降舵机角度表达的没有用位移传感器角度和层高之间是近似线性关系调一次标定后重复精度一般够用。如果货物比较重导致舵机下垂角度和实际高度就不匹配了那时候才需要换丝杆方案或者加限位开关。第二放货时的“后退15mm”不是可有可无很多翻车都发生在夹爪松开后还停在原处货物其实还靠夹爪虚托着一闭爪又把货物带歪了。4.3 到位检测用限位开关还是编码器归零码垛小车的到位检测有三种常见做法限位开关、编码器里程、光电开关校准。限位开关是最可靠的绝对位置判据但每个垛位都装开关成本太高编码器里程适合长距离直线运动但轮子打滑会造成累计误差光电开关通常装在码垛区入口车身经过时触发用来把编码器计数归零消除之前的累计误差。我会结合着用运动过程中以编码器里程为主在进入码垛区入口处放一个光电反射开关车身挡光触发中断把里程计数清零。此后从入口到每个垛位的距离都是短距离相对运动误差很小这个方案比单纯依赖编码器靠谱得多也比每个垛位装限位开关省事。/* 光电开关触发中断入口清零里程 */ void EXTI_IRQHandler(void) { if (__HAL_GPIO_EXTI_GET_IT(SENSOR_PIN) ! RESET) { __HAL_GPIO_EXTI_CLEAR_IT(SENSOR_PIN); encoder_L 0; encoder_R 0; flag_entry_triggered 1; } }里程闭环函数用左右轮编码器的平均值作为判断依据因为单轮计数在转弯和打滑时都会漂移平均值能抵消一部分左右不均的偏差。长距离段之间加一个清零点是搬运小车定位最实用的低成本手段。5. 搬运码垛小车最常见的5个坑与排查方法这一章列的是我自己做搬运码垛小车时踩过、也帮别人排查过的问题。每条都按现象、原因、解决的顺序写适合在调试时对照定位。5.1 电机只抖不走还伴随着明显的电流声现象上电后电机嗡嗡响轮子小幅振动但转不起来用手摸电机壳发烫电池电压掉得很快。原因大概率是PWM频率太低。很多开发板模板默认把定时器分频做得很大PWM频率只有1kHz左右这个频率下直流电机的电感会限制电流上升导致转子只在每个周期的前段获得少量能量表现出来就是抖动。另一个常见原因是电源线太细电机启动瞬间压降太大芯片都被拉复位了表现是“一启动就重启”。解决先把PWM频率改到16kHz也就是把定时器的Prescaler设为0、Period设为4499然后用直径0.75平方毫米以上的硅胶线重新给驱动板供电最好从电池端直接焊接不走杜邦线。这两个改动做完抖动问题基本消失。5.2 PID一上电就冲过头转速来回震荡现象给定目标速度后轮子先猛加速然后明显减速到停再加速如此往复串口打印实际转速能看到一条围绕目标值大幅摆动的曲线。原因最常见的是Kp过大系统进入振荡其次是编码器AB相方向接反导致反馈符号错误PID把一个正误差当成负误差来纠正形成正反馈。还有一种隐蔽原因是没有做输出限幅PID输出累加到占空比后超出定时器ARR发生比较值回绕。解决先把Kp降到原来的一半以下Ki和Kd都清零确认转速能缓慢逼近目标然后检查编码器方向把车架起来用手缓慢转轮子观察串口打印的计数值是否和实际方向一致不对就把IC1Polarity改成下降沿。最后检查PID输出累加值是否永远落在0到1800之间超出则强制限幅。5.3 夹爪明明闭合了圆柱体货物还是滑落现象夹爪夹一个方形测试块没问题换成矿泉水瓶或圆管夹紧后稍微一晃就掉有时瓶身还被夹出了凹痕。原因夹爪接触面是平的圆柱体只有两条线接触压强很大但摩擦力小另外圆柱体受力后会产生轴向滑移平夹爪没有限制轴向移动的结构。解决在夹爪内侧贴一层2mm厚的泡棉双面胶或橡胶垫接触面会从线接触变成面接触摩擦力立刻上来如果你有条件打印夹爪把夹爪内壁改成V型槽V型槽能同时限制圆柱体的上下和左右移动。还有一个调试习惯夹持力靠舵机角度表达太紧会挤压货物太松会滑落实测时以夹住后轻轻抖动不脱落为准。5.4 码垛位置每次偏移几厘米越码越歪现象第一次放货位置正第二箱开始逐渐偏右或偏前到第三层时货块边缘已经超出了前一层甚至碰倒旁边的箱子。原因这是典型的累计误差问题。编码器里程依赖轮子滚动但小车在加速、负重和微转弯时都会打滑每次打滑损失几毫米经过几次动作放大成厘米级偏移。另外底盘每次停稳的瞬间惯性滑动也会贡献偏差车速越快偏差越大。解决在码垛区入口安装一个光电反射开关每次进码垛区时触发清零把累计误差重置掉。另外把最后一段直行的目标速度降到巡航速度的一半停稳后延时200ms再执行夹爪动作惯性滑移会大幅减少。我见过不少人把精力花在修改PID追求零误差实际上这个场景下做归零校准比调PID更治本。5.5 舵机一动作单片机就复位现象夹爪或升降舵机转动的瞬间OLED闪一下或者直接重启串口输出停在初始化日志处。原因舵机的堵转电流瞬间可以冲到1A以上如果舵机供电线和单片机供电线在同一个降压模块的同一路输出上电流突变引起的电压跌落会直接打到单片机的复位门槛。更严重的情况是电源线上寄生电感导致的负压尖峰。解决把舵机电源和单片机电源从降压模块出来后分两条支路供电各自独立走线到负载端在舵机电源端和单片机电源端各加一个470uF电解电容和一个0.1uF陶瓷电容陶瓷电容负责吸收高频尖峰电解电容负责稳住跌落。这个组合是我测过最有效的低成本抗复位方案。电源地线不要吝啬用同一根粗线在主电容处汇合避免形成地环路。6. 把控制逻辑收进状态机外加一个开机自检习惯前面几章的代码解决的是“单个动作怎么做”但一辆码垛小车需要连续完成取货、行走、摆放、归位一整套动作。如果这些动作用一堆延时调用硬串起来后期加一个传感器或者改一个时序都很痛苦。把逻辑收进状态机是这一步的关键也是搬运小车从“能跑”变成“像样”的分水岭。typedef enum { ST_IDLE, ST_PICK, /* 到取货点闭爪抓取 */ ST_LIFT, /* 升到运输高度 */ ST_DRIVE, /* 前往码垛区 */ ST_PLACE, /* 按垛位表放货 */ ST_RETURN /* 回取货点进入下一轮 */ } SysState; SysState state_cur ST_IDLE; void Task_StateMachine(void) { static uint8_t layer 0, col 0; switch (state_cur) { case ST_IDLE: if (start_button_pressed) state_cur ST_PICK; break; case ST_PICK: MoveByMillimeter(PICK_POSITION_MM); Servo_SetAngle(htim1, TIM_CHANNEL_1, GRIP_CLOSE); delay_ms(200); state_cur ST_LIFT; break; case ST_LIFT: Servo_SetAngle(htim1, TIM_CHANNEL_2, TRANSPORT_HEIGHT); delay_ms(250); state_cur ST_DRIVE; break; case ST_DRIVE: /* 到达码垛区入口光电开关清零里程 */ if (flag_entry_triggered) state_cur ST_PLACE; else SetDifferentialSpeed(SPEED_CRUISE, 0); break; case ST_PLACE: PlaceOnce(layer, col); col; if (col 3) { col 0; layer; } if (layer 2) state_cur ST_RETURN; else state_cur ST_DRIVE; break; case ST_RETURN: MoveByMillimeter(-RETURN_DISTANCE); layer 0; col 0; state_cur ST_IDLE; break; } }状态机的每个状态只负责一件事进入条件、执行动作、退出条件。我最开始调试时总希望把延时写短一点让动作快一些后来发现码垛动作的正确率依赖每个状态的稳定完成所以我在每个状态入口都加一个100ms超时如果状态没在预期时间内完成就进入故障状态并停止所有输出。这个习惯后来救过我很多次至少每次翻车都能从串口日志里看到卡在哪个状态而不是对着一个静止的小车猜原因。我建议所有状态都预留一个手动单步测试入口按键按一下状态机只前进一个状态。这样调试夹爪时序时不需要让小车完整跑一圈大大缩短了迭代周期。如果你能做到开机自检里包含“舵机回中、编码器清零、光电开关检测、电压低报警”这几项再配合状态机日志这台搬运码垛小车就已经具备了一个小型自动化设备该有的排错能力。希望这些从选型到排查的经验能帮你少走弯路也欢迎你按这个框架自己改出一套更顺手的码垛动作链。本文还有配套的精品资源点击获取
