Research on underwater sonar-inertial positioning system
To address the issue of low positioning accuracy of traditional sonar inertial systems in weakly textured un-derwater environments,it is proposed to apply sonar inertial filtering odometry to underwater sonar inertial system position-ing.Based on the principle of sonar imaging,feature extraction is performed on sonar images,and iterative nearest point al-gorithm(ICP)is used for feature matching.By fusing the point cloud matching results with IMU data,the stability of state estimation is improved.This method uses IMU data for state prediction and updates the state based on sonar ICP matching results as observations.Finally,the filtered odometer and ICP sequential matching results will be incorporated into the graph optimization framework for pose optimization.The lake experiment shows that compared to traditional methods,this meth-od has higher positioning accuracy and can adapt to weak texture environments.
sonar inertial positioningfilter odometeriterative nearest point algorithmpoint cloud matching