【完全免费】水下管道智能巡检机器人完整源码:2021 国赛全国第八名,STM32+K210 双主控拆解与上手指南
【完全免费】水下管道智能巡检机器人完整源码:2021 国赛全国第八名,STM32+K210 双主控拆解与上手指南
这个仓库「水下管道智能巡检机器人完整源码(2021 全国第八名/国银)」来自 2021 年中国大学生工程实践与创新能力大赛"智能+"赛道的水下管道巡检赛项——参赛团队 ZS8434 拿下全国第八名。仓库里放的就是他们国赛提交版的完整工程:一个 7z 压缩包,里面是 STM32F411 主控固件 + K210 视觉程序的源码,外加 FreeRTOS 任务、PID 姿态控制和 YOLOv2 目标识别的完整实现。无论你是备赛选手还是嵌入式学习者,这都是一份难得的"完整水下 ROV 参考答卷"。
全国第八名是怎么做到的:先看懂这套系统在干什么
水下管道巡检赛的核心难点一句话:机器人在水底下,没有人手能扶它——它必须自己保持姿态、控制深度、沿管道线前进,并识别、反馈场地目标。
这套系统的实际能力比你想象的更完整:
- 6 路推进电机:4 个垂直向(控制俯仰/横滚/深度)+ 2 个水平向(控制偏航/沿线巡航),全部走 ESC 电调的 PWM 驱动
- 定深巡检:MS5837 气压计换算深度,按"起步 3cm、10 秒内加深到 20cm"的预设剖面执行,检测到大幅转向时还会自动加深躲避
- 视觉循线:K210 输出管线角度与横向偏差,PID 换算成左右电机的差速推力
- 目标识别与反馈:识别两类目标(代码中标签为
roll和REC),命中后 WS2812 灯珠对应颜色闪烁,供现场裁判和队员肉眼确认 - 状态全显示:OLED 实时刷 Pitch / Roll / Yaw / 深度,蜂鸣器提示,还带两路舵机控制的机械夹爪(抓放功能)
适合谁看:备赛同学可以直接以它为底改出自己的工程;做水下/陆地机器人的工程师能少踩很多坑——传感器融合、视觉伺服、多任务调度怎么落地,这里都有真实样例。
STM32 + K210 双主控分工:一个管手脚,一个管眼睛
架构思路很简单:把 K210 当成"专门看图的副驾"。主控 STM32F411CE 不去碰图像这种重活,专心干高频控制;K210(MaixCAM 开发板,跑 MicroPython + KPU 加速库)只负责看图像、吐结论。两边各干擅长的事,这是整套系统稳定跑完比赛的根基。
STM32 侧(FreeRTOS 多任务,采样/控制/显示互不阻塞):
MPU6050_Task:每 5ms 读一次 DMP 姿态四元数(MPU6050 + eMPL 驱动)MS5837_Read_Task:每 5ms 读一次气压,换算深度Move_Task:每 5ms 跑一轮控制——深度用压力 PID,姿态是"MPU6050 角度外环 + 陀螺仪内环"的双层 PID,循线则是把 K210 报来的线偏差和线角各过一个 PID,换算成左右电机差速- 接收视觉数据走 UART DMA + 空闲中断,不占 CPU 轮询时间
- 外设全齐:6 路 ESC(TIM3/TIM9 PWM)、2 路夹爪舵机(TIM2)、OLED(DMA 刷屏)、WS2812 状态灯、按键任务、蜂鸣器
K210 侧只做两件事:
- 用 KPU 跑
yolov2.kmodel(约 1.9MB 的 YOLOv2 模型)做目标检测 - 用
find_blobs颜色阈值追踪管线,算出角度和横向偏差
最后通过串口 115200 把一帧结论发给主控,格式是 0/1 线角 横向偏差 纵向位置 目标标志——一行数字讲完"看见什么"。STM32 收到后还会对目标标志过一遍卡尔曼滤波,防止识别闪烁乱跳。这种"视觉只出结论、控制留在主控"的分工,是你做类似双芯片系统时最值得抄的思路。
拆开压缩包:国赛提交版源码里都有什么
仓库顶层就三样东西:README.md、LICENSE(MIT 协议)、Keil_ROV 国赛初赛程序.7z。全部家当在 7z 里,解压后约 410 个文件:
| 目录 | 内容 | 回答你的什么疑问 |
|---|---|---|
Core/FreeRTOS_Task/ |
FreeRTOS_Task.c(各任务体)、Movement.c(控制主循环) |
多任务怎么分、PID 参数在哪改 |
Core/PID/ |
通用位置/增量式 PID(含积分限幅) | 姿态环怎么写 |
Core/MPU6050/、Core/MS5837/ |
姿态与气压传感器驱动(含 DMP) | 传感器怎么接、怎么读 |
Core/ESC/、Core/OLED_DMA/、Core/WS2812/、Core/UART_DMA/、Core/kalman/ 等 |
电机、显示、灯效、通信、滤波等外设层 | 每个外设的落地写法 |
K210/ |
main.py + yolov2.kmodel |
视觉算法全貌与模型本体 |
MDK-ARM/ |
Keil_ROV.uvprojx 工程、编译好的 Keil_ROV.hex 和 .map |
直接复现国赛烧录版本 |
| 根目录 | Keil_ROV.ioc(CubeMX 工程)、keilkilll.bat |
引脚配置一目了然 |
一个细节值得注意:包内 hex/map 的编译时间戳集中在 2021 年 9 月 12–17 日,正是国赛期间——你拿到的基本就是当年上赛场的最终提交版,而不是事后补作业。
从 Keil 编译到 K210 烧录:从零到跑通的完整路径
把源码拉到本地:
git clone https://gitcode.com/open-source-toolkit/91b5d
接着分两条线走。
STM32 线:解压 7z 后打开 MDK-ARM/Keil_ROV.uvprojx,确认芯片选型为 STM32F411CE(工程里已配好启动文件和 Keil 驱动包),重新编译即可得到和提交版一致的固件,再用 ST-Link/J-Link 烧录。引脚、外设、时钟怎么配,都可以直接对照 Keil_ROV.ioc 在 CubeMX 里复看,这是理解硬件连接最快的入口。
K210 线:准备一块 MaixCAM(K210 开发板),刷好 MicroPython 固件后,把 K210/main.py 拷进开发板,并将 yolov2.kmodel 放到代码中 kpu.load(0x300000) 指定的地址(0x300000 是板载 Flash 的分区起点)。摄像头参数在代码里已固定(QVGA、224×224 窗口、关闭自动增益和白平衡——颜色追踪必须关),照抄即可。
接线:按 .ioc 把 MPU6050(I2C1)、MS5837(I2C2)、6 路 ESC 与 2 路舵机(对应 TIM 通道)、OLED、WS2812 接好,K210 的 UART1(代码里映射的 FP9/FP10 脚)串接到 STM32 的 USART,115200 波特率。
调参:所有 PID 参数集中在 Core/FreeRTOS_Task/Movement.c 顶部的宏定义里(如 All_KP、Base_Speed),K210 侧的颜色阈值 tube_threshold 在 main.py 里。想改行为,先改这里。硬件不在手也没关系——纯读这套"传感器 → 滤波 → PID → 电机"的链路,本身值回票价。
二次开发前必看的避坑点:硬件依赖、模型与现场调参
⚠️ 硬件强绑定:代码默认 6 电机 + ESC 协议、MPU6050、MS5837、MaixCAM 这套硬件组合。你的电机数量、电调协议、传感器型号不同,Core/ESC/、Core/MPU6050/、Core/MS5837/ 和 PWM 通道映射都要重做,这是最大的工作量。
模型只为该赛项训练:yolov2.kmodel 只认识场地上的两类目标。换了场景就得自己采集数据、训练新模型并转换格式,别指望原模型通用。
留好现场调参空间:main.py 里注释掉了一串 tube_threshold 值,标注着"白天/晚上/水面初始化/场地白线/水中启动"——这就是团队当年现场逐场调出来的痕迹。水色和光照一变阈值就要动,你自己做也要预留同样的调试手段。
编码小坑:部分 .c 文件的中文注释是 GBK 编码,用 UTF-8 打开会乱码(如 Movement.c、FreeRTOS_Task.c)。这是 Keil 历史遗留,用 Notepad++ 等工具切到 GBK 即可,不是你的环境问题。
别照抄赛场地参数:Base_Speed、定深剖面(Start_Deep/End_Deep/Deep_Time)都是对着比赛水池调的,换水池、换船体就得整套重调。
另外注意:LICENSE 是 MIT,可自由学习和商用,但 README 的"注意事项"也提醒尊重原创,二次开发请保留原作者署名。
这套源码对你有什么用
一句话收束:它是少见的"双芯片 + RTOS + PID 姿态控制 + 视觉伺服 + 完整外设"在水下 ROV 上的端到端小样机,麻雀虽小五脏俱全。备赛同学把它跑通,等于白得一套可改的国赛底盘;普通开发者读完 Movement.c 和 K210/main.py 这两个文件,"传感器 → 滤波 → 控制 → 执行"的完整闭环就长在你脑子里了。这才是全国第八名开源出来最实在的价值。