【完全免费】水下管道智能巡检机器人完整源码:2021 国赛全国第八名,STM32+K210 双主控拆解与上手指南

原创2026-11-13 21:50:13441 阅读

【完全免费】水下管道智能巡检机器人完整源码: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 侧只做两件事:

  1. 用 KPU 跑 yolov2.kmodel(约 1.9MB 的 YOLOv2 模型)做目标检测
  2. 用 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 这两个文件,"传感器 → 滤波 → 控制 → 执行"的完整闭环就长在你脑子里了。这才是全国第八名开源出来最实在的价值。

登录后查看全文
水下管道智能巡检机器人完整源码2021全国第八名国银