面向管道内检测机器人的IMU/ODO状态识别和约束定位算法

IMU/ODO State recognition and constrained localization agorithm for in-pipe inspection robots

  • 摘要: 随着全球能源管道网络规模的持续扩大,管道内检测机器人的高精度定位技术成为保障运营安全与效率的关键. 在缺乏卫星信号的封闭管道环境中,传统惯性导航系统(inertial navigation system,INS)/里程计(odometer, ODO)组合定位方法误差累积严重,难以满足长距离缺陷精确定位要求. 针对上述问题,本文提出一种面向管道场景的惯性测量单元(inertial measurement unit,IMU)/ODO状态识别与约束定位算法,以系统性地解决管道场景中特征识别与运动约束的有机融合问题. 通过融合IMU与ODO的数据,提出一种基于加速度模值和陀螺仪标准差分析的运动状态识别算法,实现了静止与直线运动状态的精确判别. 依据管道几何约束特性,根据不同运动状态引入零速约束、姿态约束等约束条件,抑制INS误差的发散. 实验结果表明,在64 m的模拟直线管道实验中,本文方法E向均方根误差(root mean square error,RMSE)降低70.5%,N向RMSE降低55.3%,高程RMSE降低40.0%;在64 m的模拟转弯管道实验中,E向RMSE差降低49.1%,N向RMSE降低57.1%,高程RMSE降低30.0%. 在96 m实测管道中,终点定位精度优于0.1 m,显著优于传统INS/ODO组合方法. 该方法无需外部辅助信息,为无GNSS环境下的管道定位提供了高精度解决方案.

     

    Abstract: With the continuous expansion of global energy pipeline networks, high-precision positioning technology for in-pipe inspection robots has become critical for ensuring operational safety and efficiency. In enclosed pipeline environments where satellite signals are absent, conventional inertial navigation system (INS)/odometer(ODO) integrated positioning methods exhibit significant error accumulation, failing to meet the requirement for accurate long-distance defect localization. To address this issue, this study proposes an IMU/ODO state recognition and constrained positioning algorithm designed for pipeline scenarios, aiming to systematically resolve the organic integration of feature recognition and motion constraints in such settings. By fusing data from the IMU and odometer, a motion state recognition algorithm based on acceleration magnitude and gyroscope standard deviation analysis is developed, enabling accurate discrimination of stationary and straight-line motion states. Leveraging the geometric constraint characteristics of pipelines, constraint conditions such as zero-velocity constraints and attitude constraints are introduced according to different motion states to suppress the divergence of INS errors. Experimental results demonstrate that in a 64 m simulated straight pipeline test, the proposed method reduces the eastward root mean square error (RMSE) by 70.5%, the northward RMSE by 55.3%, and the vertical RMSE by 40.0%. In a 64 m simulated curved pipeline test, the eastward RMSE decreases by 49.1%, the northward RMSE by 57.1%, and the vertical RMSE by 30.0%. In a 96 m field pipeline experiment, the terminal positioning accuracy is better than 0.1 m, significantly outperforming the traditional INS/ODO integration method. The proposed approach operates without external auxiliary information and provides a high-precision positioning solution for GNSS-denied pipeline environments.

     

/

返回文章
返回