Bearings-only cooperative localization algorithm of multi-mobile robots based on square-root unscented Kalman filter

Bixia Wang,Yinya Li,Guoqing Qi,Andong Sheng
DOI: https://doi.org/10.14177/j.cnki.32-1397n.2015.39.04.010
2015-01-01
Abstract:In order to solve the trade-offs between localization accuracy and real-time in the multi-mobile robots localization, a bearings-only cooperative localization algorithm of multi-mobile robots based on square-root unscented Kalman filter ( SR-UKF ) is presented. The dynamic model of the multi-mobile robots self-localization system is proposed according to the kinematics equation and the measurement equation. The method uses the relative bearings as measured values,and the square root of covariance matrix is delivered directly in the filtering to update the system state. The distributed self-localization is realized. The simulation results show that, under the same conditions, compared with the existing algorithms,the localization accuracy of the proposed SR-UKF algorithm is increased by nearly one time,and the single average execution time is reduced by 2/3.
What problem does this paper attempt to address?