2025 广东省工科大学生实验综合技能竞赛省级一等奖:排爆反恐救援机器人开源工程
Loading README and project media…
面向复杂赛场任务的全自主移动机器人,集成四轮驱动底盘、五自由度机械臂、嵌入式运动控制、多视觉协同识别与自研 PCB。
2025 年广东省工科大学生实验综合技能竞赛 · 省一等奖
项目概览 · 系统架构 · 技术方案 · 快速开始 · 工程资料 · 实物展示
“探索者”是团队自主设计、制作并完成整车联调的排爆反恐救援机器人。机器人以 STM32F407VET6 为实时控制核心,配合 OpenMV 与 K230 视觉模块,在无无线通信、全自主运行的条件下完成二维码任务解析、稳定行驶、越障、目标识别、机械臂抓取、激光打靶和目标救援。
项目不是单一功能模块的拼接,而是一套完整的“感知 - 决策 - 控制 - 执行”机器人系统:
仓库完整收录本项目的主控源码、Keil 工程、双 OpenMV 视觉脚本、K230 视觉部署文件、EasyEDA PCB 工程、SolidWorks 模型、设计报告、实物照片和演示视频。
赛题要求机器人在 3500 mm × 3500 mm 场地内完全自主运行,通过二维码获取随机任务,并依次完成越障、排爆、反恐和救援。机器人最大外形尺寸不得超过 250 mm × 250 mm × 300 mm。
二维码由三位数字组成:
| 位数 | 任务含义 | 编码规则 |
|---|---|---|
| 第 1 位 | 排爆物颜色 | 1 红色、2 绿色、3 蓝色 |
| 第 2 位 | 反恐靶颜色 | 1 红色、2 绿色、3 蓝色 |
| 第 3 位 | 救援目标形状 | 1 圆柱、2 圆锥/圆台、3 腰鼓 |
例如二维码 211 表示:抓取绿色模拟爆炸物、击中红色反恐靶、救援圆柱形目标。
完整赛题见 docs/competition/problem-statement.pdf。
| 功能模块 | 实现方式 | 对应资料 |
|---|---|---|
| 二维码任务解析 | 前端 OpenMV 调用二维码解码接口,将三位任务码封装后发送给 STM32 | 前端摄像头.py |
| 红/绿/蓝目标识别 | 双 OpenMV 分工:前端输出三色目标 X 坐标,机械臂端输出三色目标 X/Y 坐标 | vision/openmv |
| 人质类别识别 | K230 运行三分类量化检测模型,识别圆柱、圆锥和腰鼓并输出目标中心 | vision/k230/hostage-detection |
| 直线与转向控制 | HWT101 航向角/角速度反馈,外环角度 PID 与内环角速度 PID 调整底盘输出 | hwt101.c |
| 里程与分段运动控制 | GMR 编码器测速,结合轮径、编码器精度和减速比换算累计路程,并按任务阶段的距离阈值控制运行 | encoder.c |
| 减速带越障 | 速度状态触发越障控制,结合航向归位、后退复检和里程重置降低累计误差 | main.c |
| 排爆抓取 | 视觉定位目标,步进电机控制机械臂基座,舵机调整姿态,柔性夹爪完成抓取 | Robotarm.c |
| 反恐打靶 | 识别指定颜色靶标,舵机调整瞄准方向,三极管开关控制 650 nm 红色激光 | laser.c |
| 救援搬运 | K230 输出指定类别的位置,机械臂抓取并将目标带回安全区 | K230 部署说明 |
| 人机交互与自检 | OLED 显示状态与数据,按键选择整车/单项测试,蜂鸣器进行状态提示 |
flowchart LR
subgraph perception[感知层]
front[OpenMV 前端视觉<br/>二维码 / 反恐靶]
arm_cam[OpenMV 机械臂视觉<br/>排爆物 X/Y 定位]
k230[K230 视觉协处理器<br/>圆柱 / 圆锥 / 腰鼓]
imu[HWT101<br/>航向角 / 角速度]
enc[双路 GMR 编码器<br/>速度 / 路程]
adc[电压检测]
end
subgraph controller[决策与控制层]
stm[STM32F407VET6]
task[任务阶段状态机]
motion[运动控制<br/>角度环 / 角速度环 / 里程分段]
arm[机械臂动作控制<br/>步进位置 + 舵机增量调节]
end
subgraph actuator[执行层]
drive[TB6612FNG × 2<br/>四轮直流电机]
manipulator[五自由度机械臂<br/>步进电机 + 4 路舵机]
laser[650 nm 激光瞄准]
ui[OLED / 按键 / 蜂鸣器]
end
front -->|UART3 / USART2<br/>6 字节帧| stm
arm_cam -->|UART3 / USART1<br/>9 字节帧| stm
k230 -->|UART2 / USART6<br/>9 字节帧| stm
imu -->|UART| stm
enc -->|TIM Encoder| stm
adc -->|ADC| stm
stm --> task
task --> motion
task --> arm
motion --> drive
arm --> manipulator
task --> laser
stm --> ui
系统以 STM32 为任务中枢。视觉端只输出任务码、类别和目标坐标,实时运动控制、阶段切换和执行机构管理均在主控端完成,使视觉识别与底盘控制保持清晰边界。
主控程序位于 firmware/stm32f407/app/main.c。系统启动后依次初始化:
软件采用任务阶段变量与事件标志组织完整比赛流程,同时保留二维码、减速带、排爆物、反恐靶和救援目标等单项测试入口,便于现场逐模块调试。
关键周期任务:
| 周期任务 | 主要职责 |
|---|---|
TIM7 1 ms | 读取电压、编码器速度并累计行驶距离 |
TIM6 1 ms | 执行航向角/角速度串级控制并更新底盘电机输出 |
TIM3 1 ms | 对机械臂、夹爪和瞄准舵机进行渐进式位置更新 |
| UART 中断 | 接收 OpenMV、K230 和 HWT101 数据,解析固定帧格式 |
机器人采用四轮驱动结构,电机由两块 TB6612FNG 驱动。主控输出四路 PWM,并分别控制每个电机的方向。
运动控制由三类信息共同构成:
在减速带区域,程序结合轮速变化判断接触状态。控制方案通过前轮接触完成航向归位,并在越障后执行后退复检与路程基准重置,减少轮胎打滑和累计里程误差对后续任务的影响。
视觉部分采用“传统视觉 + 端侧神经网络”的组合方案:简单、确定性强的任务交给 OpenMV,形状分类任务交给 K230。
OpenMV 视觉系统由两台摄像头组成,分别安装在前端瞄准机构和机械臂末端。两台设备均使用 QVGA + RGB565 图像格式,并关闭自动增益与自动白平衡;结合可调补光灯,降低比赛现场光照变化对 LAB 阈值分割的影响。
前端瞄准 OpenMV 使用 前端摄像头.py:
find_qrcodes() 识别三位任务二维码;0x01 后切换至颜色识别模式;A3 B3 DATA_1 DATA_2 DATA_3 C3 发送二维码任务码或三色目标中心 X 坐标。机械臂末端 OpenMV 使用 识别靶心坐标.py:
A3 B3 RED_X GREEN_X BLUE_X RED_Y GREEN_Y BLUE_Y C3 发送给 STM32 USART1;机械臂脚本原始版本已经包含三色 X/Y 计算逻辑;本次仓库整理将发送打包格式对齐到主控现有的 9 字节接收结构,便于双设备按主控接口直接部署。
K230 部署包使用 320 × 320 推理输入,模型类别为:
cylinder:圆柱;cone:圆锥/圆台;waist drum:腰鼓。推理程序完成图像预处理、KPU 推理、目标框后处理和中心点计算,再以固定顺序向 STM32 发送三类目标的中心 X 坐标。模型、配置和完整部署脚本均已包含在仓库中。
机械臂由一个 42 步进电机和四个 180° 舵机构成:
STM32 通过串口向步进驱动器发送位置、速度和加速度命令;舵机由硬件定时器产生 PWM。机械臂动作采用渐进式脉宽更新,并依据视觉目标位置对抓取姿态进行补偿,避免舵机瞬间跳变造成机械冲击。
项目包含三块 EasyEDA 工程:
| PCB | 主要功能 | 工程文件 |
|---|---|---|
| 机器人主控板 | STM32 核心板、电机驱动、传感器、视觉串口、OLED、按键、蜂鸣器、激光及步进电机接口 | 机器人主控板.epro |
| 机械臂电源供电板 | 机械臂独立降压、电源分配与电压检测 | 机械臂电源供电板.epro |
| OpenMV 串口通信转接板 | OpenMV 供电与串口通信转接 | openmv串口通信转接板.epro |
整车使用 12.6 V 锂电池供电,MP1584EN 降压模块提供 5 V 电源;主控板集成电压检测、双 TB6612FNG 电机驱动、HWT101、OpenMV/K230 通信和执行机构接口,降低现场飞线数量并方便模块化维护。
机器人采用底盘层与功能层组合的分层结构:
设计报告中的整车尺寸为 245.6 mm × 171.6 mm × 296.4 mm,满足赛题 250 mm × 250 mm × 300 mm 的外形限制。
机械结构源文件位于 hardware/mechanical,包含车体底板、二层板、机械臂各段和柔性夹爪装配体。
视觉模块与 STM32 使用带帧头和帧尾的二进制协议,避免直接传输字符串带来的解析歧义。当前系统包含两套 OpenMV 协议,以及一套 K230 目标检测协议。
vision/openmv/前端摄像头.py115200UART3USART2A3 B3 DATA_1 DATA_2 DATA_3 C3
| 工作模式 | DATA_1 | DATA_2 | DATA_3 |
|---|---|---|---|
| 二维码模式 | 排爆物颜色码 | 反恐靶颜色码 | 救援目标形状码 |
| 颜色模式 | 红色目标 X | 绿色目标 X | 蓝色目标 X |
STM32 在 USART2_IRQHandler() 中接收并校验该帧;当任务码被正确识别后,主流程在排爆和反恐阶段按任务颜色使用对应坐标。
vision/openmv/识别靶心坐标.py115200UART3USART1A3 B3 RED_X GREEN_X BLUE_X RED_Y GREEN_Y BLUE_Y C3
RED_X/RED_Y、GREEN_X/GREEN_Y 和 BLUE_X/BLUE_Y 分别表示三种排爆物的图像中心坐标;未检测到目标时对应坐标为 0。STM32 在 USART1_IRQHandler() 中接收该帧,并将 OpenMV_data4..9 用于排爆目标横向对准、目标距离判断和机械臂姿态补偿。
115200UART2,Pin 11 为 TX,Pin 12 为 RXUSART6uint16A3 B3 CYLINDER_X_L CYLINDER_X_H
CONE_X_L CONE_X_H
WAIST_X_L WAIST_X_H C3
STM32 接收端先校验 0xA3 0xB3 帧头和 0xC3 帧尾,再组合三个 16 位目标坐标。
协议实现分别见:
flowchart TD
boot[系统初始化与传感器校准] --> qr[识别二维码并解析任务]
qr --> move1[航向闭环直行]
move1 --> obstacle[检测减速带并进入越障模式]
obstacle --> relocalize[航向归位 / 后退复检 / 路程重置]
relocalize --> eod[排爆区识别指定颜色目标]
eod --> grasp1[机械臂定位、抓取并放入排爆桶]
grasp1 --> target[反恐区识别指定颜色靶标]
target --> laser[调整瞄准舵机并触发激光]
laser --> rescue[救援区识别指定形状目标]
rescue --> grasp2[抓取目标并搬运至安全区]
grasp2 --> finish[完成任务]
| 类别 | 选型 / 设计 |
|---|---|
| 主控 | STM32F407VET6 |
| 底盘 | 四轮驱动、85 mm 越野轮胎 |
| 电机 | MG513 直流减速电机,带 GMR 编码器 |
| 电机驱动 | TB6612FNG × 2 |
| 航向传感器 | HWT101 单 Z 轴陀螺仪 |
| 视觉模块 | OpenMV × 2、K230 视觉协处理器 |
| 机械臂 | 42 步进电机 + 4 路 180° 舵机,五自由度 |
| 夹爪 | 柔性鱼鳍式夹爪,防滑接触面 |
| 激光装置 | 650 nm、10 mW 红色激光,三极管开关控制 |
| 供电 | 12.6 V 锂电池,MP1584EN 降压至 5 V |
| 人机交互 | OLED、按键、蜂鸣器 |
| 电压检测 | LM358P 检测电路 + STM32 ADC |
| 整车尺寸 | 245.6 mm × 171.6 mm × 296.4 mm |
.
├─ firmware/
│ └─ stm32f407/
│ ├─ app/ # 整车任务流程与中断控制
│ ├─ board/ # 板级初始化与基础延时
│ ├─ bsp/ # 电机、编码器、机械臂、姿态、串口等驱动
│ ├─ module/ # STM32 中断与外设配置
│ ├─ libraries/ # STM32F4 标准外设库与 CMSIS
│ └─ project/MDK(V5)/ # Keil MDK 5 工程
├─ vision/
│ ├─ openmv/ # 双 OpenMV:前端瞄准 + 机械臂末端定位
│ └─ k230/hostage-detection/ # K230 三类目标检测与模型
├─ hardware/
│ ├─ pcb/
│ │ ├─ easyeda/ # 三块 EasyEDA PCB 工程
│ │ └─ images/ # PCB 展示图片
│ └─ mechanical/ # SolidWorks 零件与装配体
├─ docs/
│ ├─ competition/ # 赛题原文
│ ├─ reports/ # 控制系统与结构设计报告
│ └─ BUILD.md # STM32 工程构建说明
├─ media/
│ ├─ photos/ # 整车、底盘与机械臂照片
│ └─ demo.mp4 # 比赛功能演示视频
└─ README.md
git clone https://github.com/SakuraHop/explorer-eod-rescue-robot.git
cd explorer-eod-rescue-robot
firmware/stm32f407/project/MDK(V5)/Project.uvprojx;STM32F407VE;Rebuild 并生成固件;更详细的工程说明见 docs/BUILD.md。
vflip 与 hmirror;UART3 TX/RX 与 STM32 USART2 对应引脚交叉连接,并与主控共地;0x01 后进入颜色识别模式。UART3 TX/RX 与 STM32 USART1 对应引脚交叉连接,并与主控共地;A3 B3 X_X_X Y_Y_Y C3。两台 OpenMV 均使用 115200 8N1。实际部署时,前端摄像头和机械臂摄像头应连接到主控的不同串口,不能将两路 TX 直接并联。
将下列目录完整复制到 K230:
vision/k230/hostage-detection/mp_deployment_source/
设备端目录应为:
/sdcard/mp_deployment_source/
├─ deploy_config.json
└─ best_AnchorBaseDet_can2_5_s_20250930174631.kmodel
随后使用与设备固件匹配的 CanMV/K230 IDE 运行:
vision/k230/hostage-detection/工科赛人质完整代码.py
hardware/pcb/easyedahardware/pcb/imageshardware/mechanical| 资料 | 在线查看 | 原始文件 |
|---|---|---|
| 赛项命题 | PDF | DOC |
| 控制系统设计报告 | PDF | DOC |
| 结构设计报告 | PDF | DOC |
| STM32 构建说明 | docs/BUILD.md | - |
| OpenMV 部署说明 | vision/openmv/README.md | - |
| K230 部署说明 | vision/k230/hostage-detection/README.md | - |
| 演示视频 | media/demo.mp4 | MP4 |
点击查看完整演示:media/demo.mp4
这个项目记录了团队从赛题分析、方案设计、器件选型、结构加工、PCB 设计、算法实现到现场联调的完整工程过程。仓库中的每一部分资料都对应机器人上的真实模块,可用于学习多传感器移动机器人、嵌入式闭环控制、端侧视觉部署和机电系统集成。
感谢团队所有成员在机械、电控、视觉、算法、加工装配和现场调试中的共同投入,也感谢指导教师和赛事组织方提供的专业指导与实践平台。
bsp