【附下载链接】2021 国赛水下管道巡检机器人完整源码:STM32 + K210 双核架构一次搞懂
【附下载链接】2021 国赛水下管道巡检机器人完整源码:STM32 + K210 双核架构一次搞懂
跨海管廊、市政管网里的水下管道,长期泡在水中,人下去检查既危险又耗时,目视判断还容易漏检。水下管道巡检机器人要解决的就是:让机器人代替人到水里走管、看管,并把看到的目标和管道走向实时传回地面。下面这份水下机器人源码,来自一个拿过国赛成绩的完整工程,双芯片架构写得很直白,适合想拆明白"感知 + 控制"如何协作的读者。
出自哪场比赛
这套代码出自 2021 年中国大学生工程实践与创新能力大赛"智能+"赛道的"水下管道巡检"赛项,团队编号 ZS8434,最终成绩为全国第八名(国银)。开源内容是参赛时的完整工程代码:STM32 主控工程和 K210 视觉程序,协议采用 MIT。
STM32 和 K210 各管什么
整机是"双核分工"结构,两块芯片各干各的活:
| 芯片 | 角色 | 具体负责 |
|---|---|---|
| STM32F411CE | 主控 | 跑 FreeRTOS,管六路 ESC 电机 PWM、MPU6050 姿态(IMU + 卡尔曼滤波)、MS5837 深度计、OLED 显示,并执行 PID 姿态稳定与走线控制 |
| K210 | 视觉协处理 | 摄像头取图,跑 YOLOv2 模型检测目标,同时做颜色阈值追踪,算出管道线条角度与偏差 |
两者只靠一路串口通信(UART1,115200 波特率)。K210 每帧发一行五字节的短文本:
1 <线条角度> <x偏差> <y> <目标标志>
没检测到目标时首字段为 0。STM32 端解析后交给走线 PID;简单说,K210 只负责"看",STM32 只负责"开"。
仓库里有什么,先读哪部分
- Keil_ROV 国赛初赛程序.7z:全部代码,解压后是完整的 Keil MDK 工程,含 K210/main.py 和 K210/yolov2.kmodel
- LICENSE:MIT 协议
- README.md:项目说明
建议的阅读顺序由短到长:
K210/main.py:全文约 110 行,K210 侧感知逻辑(模型加载、YOLOv2 推理、颜色追踪、串口发送)都在里面,是最好的入口Core/FreeRTOS_Task/Movement.c:六电机分配和 PID 增益宏,看 STM32 怎么把"看到的偏差"变成"电机转速"Core/FreeRTOS_Task/FreeRTOS_Task.c:任务创建、传感器采集与系统上电流程MDK-ARM/Keil_ROV.uvprojx与工程根目录的.ioc:Keil 工程文件,以及 CubeMX 引脚配置依据
四步跑通这套源码
- 环境与代码:准备好 Keil MDK(STM32 侧)和 K210 开发环境(MaixPy),
git clone https://gitcode.com/open-source-toolkit/91b5d后用 7z 解压工程包 - 导入工程:Keil 打开
MDK-ARM/Keil_ROV.uvprojx,外设引脚以.ioc文件为准 - 接线:按工程里的引脚定义连接 K210 UART1 与 STM32 串口、ESC 电调、IMU 和压力传感器
- 烧录验证:Keil 编译产物烧进 STM32,
main.py烧进 K210;串口监视器收到连续的1 <角度> <x> <y> <标志>报文,说明双板链路已通
复用代码前先看这几点
FreeRTOS_Task.c、Movement.c等文件是 GBK 编码,编辑器若默认 UTF-8,注释会乱码,先切换编码再读Movement.c里的 PID 增益宏(如All_KP)是配合比赛底盘调好的,换底盘、换电调后必须重新整定,直接沿用会振荡或无力- YOLOv2 模型
yolov2.kmodel的标签类别是训练时固定的,换检测目标需重新训练并替换模型 main.py中的颜色阈值tube_threshold是按比赛水场光照调的,换水池或改光源后要重新调试 HSV 阈值- 改串口协议时,STM32 解析端和 K210 发送端要同步改,只改一边通信立刻断
这套源码把"谁感知、谁控制、怎么通信"分得很清:K210 出数据,STM32 出动作,中间只有一行短文本。想拆解双芯片水下机器人架构,或找一份"视觉 + 姿态稳定 + 多电机控制"的可运行样例,这个仓库能直接上手。
登录后查看全文