Compensation Algorithm Based on Estimation State for Transmission Delay in Cooperative Localization

In order to maximize the utilization of the observation information in the cooperative localization,a compensation algorithm based on the estimation state is presented for transmission delay.Under the framework of the Kalman filter,two different processes of state estimating with and without transmission delay are investigated and contrasted.The expression of difference quantity caused by transmission delay is derived.It is used to compensate the present estimation state instead of the observed information compensation.According to the characteristics of state transition matrix,an equivalent expression of which successively impacts on the covariance factor in delay time is obtained.The simulation results show that the present estimated state is effectively corrected by transmission information and the relevance among agents is accurately updated.As a result,a higher positioning accuracy is achieved.Meanwhile,the consumption of recording and multiplication of the state transition matrix is saved.