水下探测小型机器人ROS嵌入式控制系统设计与试验分析

水下环境探测、水质监测、水下结构巡检、水底残骸排查等作业场景，普遍存在水体扰动复杂、光照条件弱、人工作业风险高的特点，传统人工潜水探测、大型水下设备巡检模式存在成本偏高、灵活性不足、作业范围受限等问题。小型水下探测机器人凭借体积小巧、机动灵活、部署便捷的优势，可适配浅水域、密闭水体、近岸复杂水环境的精细化探测任务。嵌入式ROS机器人开发框架具备模块化开发、多传感器兼容、算法迭代便捷、实时调度稳定的特性，能够有效解决水下机器人多源感知融合、姿态解算、轨迹控制、数据回传等核心问题。本文针对小型水下探测机器人的作业特性，完成基于ROS嵌入式平台的控制系统整体设计、软硬件搭建、控制算法适配与多场景水池试验，通过实测数据分析系统运行性能，为轻量化水下探测机器人的工程落地提供可行的技术方案。

一、研究背景与系统设计需求

1.1 水下探测作业技术现状

现阶段大中型水下机器人多用于深海探测、海洋资源勘探等大型场景，设备体积大、部署流程繁琐、运维成本较高，难以适配城市河道、景观水域、水库、浅层近海等小型水域的常态化探测需求。市面上部分简易水下设备采用封闭式控制逻辑，感知能力单一、拓展性较弱，无法实现自主巡航、环境建模与数据智能分析。同时水下水流扰动、水压变化、光照衰减、水体浑浊等干扰因素，会对机器人姿态控制、环境感知精度造成影响，普通陆地机器人控制方案难以直接复用。

依托嵌入式ROS架构开发小型水下探测机器人控制系统，可实现硬件模块化适配、软件功能可迭代、控制算法可优化的开发优势，能够针对性适配浅水域复杂干扰环境，满足轻量化、低成本、高灵活度的水下探测作业需求。

1.2 控制系统核心设计需求

结合小型水下探测机器人的作业场景，控制系统需要满足多维度功能与性能需求。在感知层面，需支持水下姿态、水深、水温、图像环境、运动状态的多维度数据采集，实现多传感器数据融合，抵抗水体扰动带来的感知误差；在控制层面，需具备精准姿态调节、定深悬浮、匀速巡航、轨迹跟踪能力，适配水流波动环境的稳定运动需求；在功能层面，支持手动遥控与自主巡航模式切换，可完成水下图像采集、环境数据记录、轨迹存储与数据回传；在工程层面，嵌入式设备需低功耗、高稳定性，适配长时间水下无人探测作业，同时预留功能拓展接口，便于后续算法与硬件迭代升级。

二、控制系统总体架构设计

本次设计采用嵌入式上位机决策+底层执行驱动的分层控制架构，基于ROS系统实现模块化功能拆分，整体分为环境感知层、决策控制层、运动执行层、数据交互层四大模块，各模块通过ROS话题、串口通信实现数据联动，模块耦合度低，便于单独调试与功能优化。

环境感知层集成水下专用传感器阵列，负责采集机器人姿态角度、潜水深度、水体温度、水下图像、推进器状态等原始数据，完成数据滤波、畸变矫正与时空对齐，为上层控制决策提供精准数据源；决策控制层依托ROS核心节点运行姿态解算、路径规划、抗干扰控制算法，根据感知数据输出运动控制指令，实现自主巡航、定点探测、姿态矫正功能；运动执行层通过底层驱动电路接收控制指令，调节多通道推进器转速与转向，完成机器人升降、平移、转向、悬浮等运动动作；数据交互层实现人机遥控、实时数据回传、作业日志存储、异常状态告警，支持地面终端实时监测水下机器人运行状态。

三、系统软硬件平台搭建

3.1 嵌入式硬件选型与架构

主控单元选用轻量化ARM嵌入式开发板作为ROS上位机，负责算法运算、数据处理、任务调度与指令输出，设备功耗低、体积小巧，可适配密闭防水舱内部安装环境，能够稳定承载多传感器数据融合与控制节点并发运行。底层执行控制器采用STM32单片机，承担实时运动控制、电机闭环调节、传感器原始数据采集任务，弥补嵌入式系统实时性短板，保障推进器控制响应速度。

感知硬件配置适配水下作业特性，搭载六轴IMU惯性测量单元采集机器人角速度与姿态数据，搭配水深压力传感器实现精准定深检测，配备防水广角摄像头完成水下环境图像采集，辅以温度传感器监测水体环境参数。运动执行部分采用多通道防水无刷推进器，分布于机身不同位置，配合防水驱动模块，实现六自由度运动调节，满足水下悬浮、平移、俯仰、转向的运动需求。整机硬件集成于密封防水舱内部，具备水压防护、防水防潮能力，适配浅层水下作业环境。

3.2 软件环境与ROS功能配置

软件端基于ARM架构Ubuntu系统搭配对应ROS版本搭建开发环境，预装机器人控制、传感器驱动、数据处理相关核心功能包。感知模块搭载IMU数据解算、图像预处理、水深数据滤波功能包，实现水下多源数据降噪与标准化输出；定位控制模块配置姿态解算、卡尔曼滤波、轨迹规划功能包，完成机器人位姿实时求解；通信模块配置串口通信、话题转发、远程数据传输功能包，保障上下位机数据稳定交互。

同时搭建自定义ROS功能包，封装水下定深控制、姿态自适应调节、巡航路径管理、异常防护、数据存储等专属功能，适配水下探测专属作业逻辑，支持手动遥控、定点探测、路径巡航三种作业模式自由切换。

四、ROS控制系统核心功能设计

4.1 水下多传感器感知融合模块

水下环境存在水流扰动、光线昏暗、水体浑浊等干扰，单一传感器数据误差较大，系统采用多传感器融合策略提升感知稳定性。IMU单元实时采集机器人三轴姿态、角速度与加速度数据，通过均值滤波与姿态解算算法，输出机器人俯仰角、横滚角、偏航角参数；水深压力传感器通过压力-深度换算公式，实时更新潜水深度数据，消除水压波动带来的数值抖动；防水相机采集的水下图像经过灰度矫正、去雾增强处理，改善昏暗浑浊环境下的图像质量。

ROS系统通过时间戳同步机制对齐多源数据，采用扩展卡尔曼滤波算法融合姿态、深度、位置信息，修正单一传感器的随机误差与漂移问题，输出稳定可靠的机器人位姿与环境数据，为精准控制提供数据支撑。

4.2 自适应抗干扰姿态与定深控制

针对水下水流扰动导致的姿态偏移、深度漂移问题，系统设计PID+自抗扰复合控制策略。常规水域环境采用PID闭环控制，根据姿态误差、深度误差动态调节推进器输出功率，实现姿态矫正与定深悬浮；水流波动较大的复杂水域，启用自抗扰控制机制，通过扩张状态观测器实时估计外部水流扰动与系统未知误差，动态补偿控制输出，抑制扰动对机器人运动状态的影响。

ROS节点实时读取融合后的位姿数据，对比目标姿态与预设深度，持续输出调节指令，保障机器人在动态水流环境中保持平稳姿态，减少晃动、偏移、沉浮现象，提升水下探测作业的稳定性。

4.3 自主巡航与轨迹跟踪模块

系统支持自定义水下巡航路径，操作人员可通过地面终端预设多个探测点位、巡航速度与作业时长，ROS路径规划节点根据点位坐标生成连续平滑的巡航轨迹。机器人运行过程中，实时对比实际位姿与目标轨迹的偏差，通过动态调节推进器转速，完成轨迹修正与路径跟踪，自动完成多点位遍历探测、定点悬停采样、连续环境扫描等作业任务。

同时设计速度自适应逻辑，浑浊水域、复杂障碍物区域自动降低巡航速度，开阔平稳水域适度提升运行速度，在保障探测精度的同时优化作业效率。

4.4 数据记录与异常防护模块

作业过程中，ROS系统实时记录水下图像、水温、水深、机器人姿态、运行轨迹等数据，自动存储至本地存储卡，支持作业完成后数据导出与分析。针对水下作业的高风险特性，设计多重异常防护逻辑，当检测到姿态倾角超限、深度异常、信号断连、低电量等故障状态时，系统自动触发应急策略，执行悬停稳姿、缓慢上浮、定点待机等动作，规避设备失联、磕碰损坏等风险，提升水下作业安全性。

五、整机试验方案与测试环境

为验证控制系统的稳定性、控制精度与环境适应性，搭建室内水池模拟水下作业场景，开展多组专项性能试验，涵盖静态定深试验、姿态稳定性试验、轨迹跟踪试验、抗水流扰动试验与长时间续航作业试验。试验水体深度控制在1至3米，通过水流发生装置模拟不同强度的水流扰动，模拟自然河道、水库的常规水环境工况，记录机器人各项运行参数与作业效果。

六、试验结果与性能分析

6.1 定深与姿态稳定性试验分析

静态无扰动水环境下，机器人定点悬停定深误差维持在较小区间，深度数值波动平缓，无明显持续漂移现象；机身俯仰、横滚姿态角度保持稳定，机身无大幅晃动。在轻度水流扰动环境中，复合抗干扰控制算法可快速补偿水流冲击带来的姿态偏差，短时间内完成姿态回正与深度校准，机身稳定性相较于单一PID控制方案有明显提升，能够满足水下定点探测、静态环境采样的精度需求。

6.2 轨迹跟踪与巡航性能分析

直线、矩形、多点位巡航轨迹测试中，机器人可精准跟随预设路径运行，轨迹偏差处于合理范围，转弯、变速过程平稳顺滑，无急停、偏移、脱轨等问题。复杂水流工况下，系统可实时修正轨迹误差，维持巡航路线完整性，自主遍历探测点位的完成度较高，能够实现自动化全覆盖水下探测作业。

6.3 长时间作业稳定性分析

连续数小时水下通电运行测试中，ROS各功能节点运行稳定，无节点闪退、数据断连、内存异常堆积等问题，传感器数据采集连续完整，控制指令输出响应及时。设备整机功耗平稳，防水结构与硬件运行状态正常，长时间作业下控制精度无明显衰减，具备常态化无人值守探测作业能力。

6.4 现存问题与性能短板

试验过程中发现系统存在部分优化空间，强水流冲击场景下，机器人轨迹偏差会小幅增大，姿态矫正耗时有所增加；高浑浊水体环境中，视觉图像清晰度下降，环境细节识别能力减弱；远距离水下无线通信存在轻微延迟，数据回传实时性略有下降，可通过后续算法优化与硬件升级进一步改善。

七、系统优化与拓展展望

结合试验测试结果，可从算法、硬件、功能三个维度完成系统优化。算法层面，进一步优化抗扰控制参数，强化强水流工况下的动态补偿能力，引入图像去雾增强算法提升浑浊水体视觉感知效果；硬件层面，优化通信模块配置，降低远距离数据传输延迟，提升传感器采集精度；功能层面，可新增水质传感器、障碍物超声探测模块，丰富环境探测维度，结合SLAM算法实现水下环境三维建模，提升智能化探测水平。

八、总结

本文完成了基于ROS嵌入式平台的小型水下探测机器人控制系统设计、软硬件搭建、功能开发与多场景水池试验分析，构建了感知融合、抗扰控制、自主巡航、安全防护一体化的水下机器人控制系统。通过分层模块化设计，有效适配水下复杂扰动环境，解决了传统简易水下设备稳定性弱、智能化程度低、抗干扰能力不足的问题。试验结果表明，该控制系统运行稳定、控制精度良好、环境适配性较强，可满足浅层水域环境探测、水质监测、水下结构巡检等轻量化作业需求，为小型水下探测机器人的嵌入式智能化开发与工程应用提供可靠的技术参考。