Text this: Trajectory Estimation Filtering Algorithm for Underwater Equipment Based on UKF