简介本资源为2023年中国农业机器人大赛二等奖作品——草莓采摘机器人的STM32端完整代码面向嵌入式开发学习者、机器人竞赛参赛者及农业自动化方向的学生与工程师。方案以正点原子F4核心板为主控搭配Jetson nano与USB摄像头完成草莓颜色识别并通过通讯协议与STM32协同工作底盘采用酷点机器人350×400底盘机械臂为幻尔leArm另集成GY-53激光测距传感器与维特智能MPU6050陀螺仪。代码涵盖上述设备的驱动与控制函数、与Jetson nano的通讯实现并基于任务调度机制分别执行各项任务可作为多设备协同控制的学习范例。压缩包共244个文件以62个h头文件、60个c源文件为核心辅以Keil工程配置、编译中间文件与烧录文件等整体约7.77MB目录结构清晰。目前已有608人学习下载适合希望借鉴获奖方案、理解传感器融合与任务调度思路的读者参考。1. 草莓采摘机器人STM32代码拆包从竞赛二等奖作品里能挖到什么去年帮一个学弟看他的毕业设计题目是果蔬采摘机器人控制系统他拿着某宝买的开发板例程改了两周舵机抖得像帕金森草莓没摘下来几颗叶子倒是打落一地。后来我翻到这份2023年中国农业机器人大赛二等奖作品的STM32代码包让他照着重构了一遍控制层问题基本消停了。这份资源就是一套完整的草莓采摘机器人嵌入式控制源码核心跑在STM32上覆盖了机械臂多轴联动、视觉坐标解析、末端执行器抓取时序、以及底盘运动控制这几块。它适合正在做农业机器人、竞赛项目或者嵌入式控制课程设计的人尤其是那些手里有硬件但控制逻辑写不利索、多任务调度一团糟的开发者。代码本身不是那种跑通就完事的demo里面有状态机、有串口协议、有PWM调速的细节处理能看出是实际比赛调过的版本。如果你正卡在“舵机响应慢半拍”“视觉给坐标但机械臂对不上”“多个外设抢中断”这类问题上这份代码值得拆开看看。2. 先看架构再动手这份STM32工程怎么组织2.1 工程目录与模块划分拿到代码包先别急着编译花十分钟把目录结构捋清楚后面改起来才不迷路。这份工程常见做法是按“硬件驱动层—功能模块层—任务调度层”三层来分。硬件驱动层放的是bsp文件夹里面按外设拆成bsp_gpio.c、bsp_tim.c、bsp_usart.c、bsp_pwm.c这些每个文件只干一件事比如bsp_pwm.c里就封装了定时器通道的占空比设置函数不掺业务逻辑。功能模块层是modules机械臂逆解、舵机角度映射、串口协议解析、视觉数据缓存都在这层每个模块对外暴露几个函数指针或者结构体句柄。任务调度层在app里主循环和中断服务函数调这层的接口把各个模块串起来跑。这种分法最大的好处是换硬件不用重写业务。比如你从STM32F103换到F407理论上只改bsp里的寄存器操作和时钟配置modules和app基本不动。我见过太多人把所有代码塞进main.c两千行起步改一个舵机引脚要全局搜索替换那才是血泪经验。2.2 关键数据结构与全局句柄代码里一般会定义一个SystemHandle或者RobotHandle结构体把机械臂当前角度、目标角度、底盘速度、视觉坐标、系统状态这些变量全塞进去。这样做的原因是中断和主循环之间要共享数据用全局散变量容易漏加volatile编译器一优化就出玄学问题。下面是一个典型的句柄定义我按常见写法补全了注释typedef struct { float joint_angle[4]; // 四个关节当前角度单位度 float target_angle[4]; // 逆解算出的目标角度 uint8_t arm_state; // 0空闲 1运动中 2到位 3错误 int16_t vision_x; // 视觉传来的像素X坐标 int16_t vision_y; // 视觉传来的像素Y坐标 uint8_t vision_ready; // 视觉数据就绪标志1有效 float chassis_speed[2]; // 左右轮线速度单位m/s uint32_t error_code; // 错误码位域每位代表一类故障 } RobotHandle_t; extern RobotHandle_t g_robot; // 全局句柄中断和主循环共用逻辑说明这个结构体把机器人所有运行时状态集中管理中断里只改vision_ready和vision_x/y主循环读这些标志做逆解避免在中断里做浮点运算。参数上joint_angle用float是因为逆解涉及三角函数用int会丢精度error_code用位域是为了一个变量记录多种故障省RAM也方便串口上报。2.3 编译环境与下载配置代码包一般带MDK-ARM工程文件或者Makefile我建议先用Keil打开确认器件型号和时钟树。常见坑是原工程用的外部晶振频率和你板子不一样比如原工程配8MHz晶振倍频到72MHz你板子是12MHz直接下载串口波特率会偏视觉通信全是乱码。检查system_stm32f1xx.c里的HSE_VALUE宏改成你实际晶振频率。下载器用ST-Link的话在Keil的Debug选项卡里选ST-Link DebuggerFlash Download里勾上Reset and Run不然每次下载完要手动按复位。串口助手先别开等确认程序跑起来LED闪了再接视觉模块否则分不清是代码问题还是接线问题。3. 机械臂逆解与舵机控制从坐标到角度的落地3.1 逆解算法在STM32上的实现取舍草莓采摘机械臂一般是四自由度底座旋转、大臂俯仰、小臂俯仰、末端旋转。逆解就是已知草莓在机械臂坐标系下的XYZ反推四个关节角度。常见做法有两种几何法和DH参数法。几何法推导简单代码里就是几个atan2和acos但只适合特定构型DH参数法通用性强但矩阵运算多在STM32F1这种没有FPU的片子上跑一次要几百微秒。这份代码大概率用的是几何法加分段处理因为竞赛作品对实时性要求高视觉帧率也就10到20帧逆解必须在1ms内算完。我一般会先把逆解公式在MATLAB或者Python里验证一遍确认角度范围和实际机械臂对得上再移植到C。移植时注意atan2的参数顺序是(y, x)不是(x, y)这个搞反了机械臂会往反方向抡直接撞限位。3.2 舵机角度映射与PWM占空比计算算出来的角度是数学角度舵机要的是PWM脉宽。常见舵机控制周期20ms脉宽0.5ms到2.5ms对应0到180度。STM32的定时器配置成PWM模式ARR设19999PSC设71这样计数频率是1MHz一个计数就是1微秒CCR直接写脉宽微秒数。下面是一个角度转CCR的函数// 舵机角度转PWM比较值适用于TIM1通道1 // angle: 目标角度范围0-180 // 返回值: 写入CCR寄存器的值 uint16_t servo_angle_to_ccr(float angle) { // 限幅防止逆解异常输出超范围角度 if (angle 0.0f) angle 0.0f; if (angle 180.0f) angle 180.0f; // 0度对应500us180度对应2500us线性映射 float pulse_us 500.0f (angle / 180.0f) * 2000.0f; // 定时器计数频率1MHz1计数1us直接返回脉宽值 return (uint16_t)pulse_us; }逻辑说明先限幅再映射是因为逆解在奇异点附近可能算出负角度或者超过180度的值不限幅舵机会堵转发热。参数上500和2500是常见模拟舵机的脉宽范围如果你用的数字舵机范围可能是500到2500或者800到2200拿示波器测一下最稳。CCR直接写微秒数这个技巧依赖定时器分频配置换定时器或者改PSC后要重新算。3.3 多轴联动与速度规划四个关节如果各自独立运动末端轨迹是乱的草莓没到跟前机械臂先撞支架了。常见做法是让所有关节同时启动、同时到达每个关节的速度按角度差比例分配。代码里一般用一个move_arm_sync函数输入四个目标角度和总运动时间内部算出每个关节的步进增量放在定时器中断里每毫秒更新一次。总运动时间不能太短舵机有最大角速度限制一般60度每秒你让它0.1秒转90度它要么跟不上要么抖。我一般把总时间设成max_angle_diff / 60.0 * 1.5留50%余量。4. 视觉坐标解析与串口通信让机械臂知道草莓在哪4.1 串口协议帧格式与解析状态机视觉模块一般通过串口把草莓的像素坐标和大小发给STM32帧格式常见是0xAA 0x55 数据长度 数据 校验和。STM32这边不能用HAL_UART_Receive阻塞收那样主循环全卡死。正确做法是开串口接收中断每收一个字节进一次中断用状态机拼帧。下面是一个典型的状态机实现// 串口接收状态机在USART1_IRQHandler里调用 typedef enum { STATE_HEAD1, // 等待帧头1 STATE_HEAD2, // 等待帧头2 STATE_LEN, // 接收长度 STATE_DATA, // 接收数据 STATE_CHECK // 接收校验 } RxState_t; void vision_uart_rx_byte(uint8_t byte) { static RxState_t state STATE_HEAD1; static uint8_t buf[32]; static uint8_t idx 0; static uint8_t len 0; switch (state) { case STATE_HEAD1: if (byte 0xAA) state STATE_HEAD2; break; case STATE_HEAD2: state (byte 0x55) ? STATE_LEN : STATE_HEAD1; break; case STATE_LEN: len byte; if (len sizeof(buf)) { state STATE_HEAD1; break; } idx 0; state STATE_DATA; break; case STATE_DATA: buf[idx] byte; if (idx len) state STATE_CHECK; break; case STATE_CHECK: // 校验和 长度 所有数据字节取低8位 { uint8_t sum len; for (uint8_t i 0; i len; i) sum buf[i]; if (sum byte) { // 校验通过解析坐标 g_robot.vision_x (int16_t)(buf[0] 8 | buf[1]); g_robot.vision_y (int16_t)(buf[2] 8 | buf[3]); g_robot.vision_ready 1; } } state STATE_HEAD1; break; } }逻辑说明状态机每收一个字节只做一次判断不阻塞、不延时主循环该干嘛干嘛。参数上帧头用0xAA 0x55是因为这两个字节在数据里同时出现的概率低减少误同步。校验和用累加取低8位比CRC简单在短帧场景够用。注意buf大小要大于最大数据长度否则溢出会踩内存。4.2 像素坐标到机械臂坐标的转换视觉给的是像素坐标机械臂要的是毫米坐标中间差一个标定矩阵。常见做法是在工作平面放几个已知点记录像素坐标和实际坐标用最小二乘法拟合一个2x3的仿射矩阵。代码里就是三个系数a,b,c和d,e,f转换公式是x_mm a*px b*py cy_mm d*px e*py f。标定一次能用很久但相机动了或者换了镜头必须重标。我一般把标定系数存在Flash里开机读出来免得每次上电重新标。4.3 通信超时与数据有效性判断视觉模块可能掉线或者卡死STM32不能傻等。常见做法是每收到一帧有效数据就把一个vision_tick清零主循环里每毫秒加一超过200ms没收到新帧就认为视觉失效机械臂回安全位置。这个逻辑简单但救命比赛时视觉模块被阳光干扰丢帧没有超时保护机械臂会拿着旧坐标乱抓。5. 避坑与排查这份代码跑起来容易翻车的几个地方5.1 舵机抖动或不动现象下载后舵机要么纹丝不动要么高频抖动发出嗡嗡声。原因通常是PWM定时器没启动或者CCR值算错。先拿示波器看对应引脚有没有波形没有波形查HAL_TIM_PWM_Start有没有调用有波形但占空比不对查servo_angle_to_ccr里的脉宽范围是不是和你舵机匹配。还有一种情况是舵机电源和STM32共地了但电流不够舵机一动STM32就复位表现也是抖动。解决舵机单独供电共地但不共电源。5.2 串口收不到视觉数据现象视觉模块发数据STM32这边vision_ready永远是0。先确认波特率视觉模块常见115200STM32这边如果时钟配错实际波特率会偏用示波器测一个字节的时间115200下一位是8.68微秒。再确认中断优先级如果串口中断优先级低于定时器中断定时器里耗时太长会把串口字节丢掉。解决串口中断优先级设成最高定时器中断里别做浮点运算。5.3 逆解算出的角度让机械臂撞限位现象机械臂往一个方向猛转撞到限位还在使劲。原因是逆解输入坐标超出了工作空间acos的参数超出[-1,1]返回NaNNaN转成整数是个随机值。解决在逆解函数入口加工作空间判断坐标超出范围直接返回错误码机械臂保持原位。另外acos调用前把参数限幅到[-1,1]防止浮点异常。5.4 主循环卡死在某一个while里现象程序跑一会儿就不响应了LED也不闪。常见原因是某个while等待标志位没有超时退出比如等舵机到位、等串口发送完成。解决所有while等待都加超时计数超过阈值强制退出并置错误码。我一般写个宏WAIT_FLAG_TIMEOUT(flag, timeout_ms)展开就是带超时的循环。5.5 下载后第一次运行正常复位后不正常现象刚下载完能跑按复位键或者重新上电就死机。原因通常是全局变量没初始化或者外设初始化顺序依赖上电时序。检查SystemInit里有没有开看门狗看门狗没喂狗会在复位后立刻触发。解决看门狗初始化放在所有外设初始化之后主循环里定时喂狗。6. 进阶技巧把这份代码改成你自己的采摘机器人拿到这份代码最值钱的地方不是照抄而是把它的分层思想和状态机框架搬到你自己的项目里。我一般会先做一件事把modules里的逆解和舵机控制抽出来写一个简单的测试模式用串口输入目标角度看机械臂能不能平滑走到位。这一步能验证硬件和底层驱动没问题再往上叠视觉和任务调度。如果你用的不是草莓而是其他果蔬改的是视觉坐标转换系数和抓取时序逆解和舵机控制基本不动。如果机械臂自由度不一样比如三自由度或者五自由度逆解要重推但状态机和串口协议可以复用。下面是一个测试模式的代码骨架我习惯用它来快速验证// 串口命令测试模式输入J1 90表示关节1转到90度 void test_mode_loop(void) { char cmd[16]; if (uart_get_line(cmd, sizeof(cmd))) { // 非阻塞读一行 if (cmd[0] J) { uint8_t joint cmd[1] - 1; // J1对应索引0 float angle atof(cmd[3]); // 解析角度值 if (joint 4 angle 0 angle 180) { g_robot.target_angle[joint] angle; move_arm_sync(g_robot.target_angle, 500); // 500ms到位 } } } // 其他任务照常跑 }逻辑说明这个测试模式不依赖视觉手动发命令就能验证每个关节的映射关系和运动平滑度。参数上500ms是运动时间你可以改成1000ms看慢速下有没有卡顿。uart_get_line要自己实现成非阻塞的收满一行或者超时返回。还有一个习惯每次改完逆解或者舵机映射我强制走一遍全工作空间扫描让机械臂从(0,0)到最大半径逐点走观察有没有抖动、丢步、撞限位。这个流程花十分钟能省掉后面比赛现场翻车的后悔药。希望帮到你。本文还有配套的精品资源点击获取