Research on Navigation Method for Subsea Drilling Robot Based on Inertial Navigation and Odometry

This paper proposes a robust navigation method based on a robust square-root cubature Kalman filter (RSRCKF) to address the accuracy divergence of integrated navigation systems caused by drilling-induced slippage and the mismatch between the tail-cable encoder and the robot motion during operations of a seafloor drilling robot in deep-sea soft sedimentary layers. Considering the large-deformation mechanical characteristics of the seabed under drilling conditions, a unified state-space model incorporating a time-varying odometer scale-factor error is first established. To alleviate the numerical instability of the nonlinear system in the presence of non-Gaussian noise, a square-root cubature Kalman filter (SRCKF) framework is employed, in which the positive definiteness of the error covariance matrix is dynamically preserved via QR decomposition. Subsequently, an online fault detection mechanism based on a modified chi-square test is developed. By introducing a two-segment IGG (a classical robust weighting scheme) weighting function, an adaptive variance inflation factor is constructed to enable real-time identification and down-weighting of abnormal observations induced by slippage. Field experiments, including drilling and turning tests conducted on tidal mudflats off the coast of Zhoushan, demonstrate that the proposed method can effectively mitigate the impact of "false displacement" disturbances caused by typical soft clay slippage conditions through enhanced statistical robustness. Taking the conventional SINS/OD integration scheme as the baseline, the proposed method achieves an approximate 82.4% reduction in positioning error. These results verify the robustness and engineering applicability of the proposed algorithm in complex seabed environments.