In the vector tracking loop, there is a great error in the output of discriminator owing to the disturbance of noise. Cubature Kalman filter is proposed to replace the discriminator to process I/Q data and generate code phase error and the carrier frequency error in this paper. The present algorithm not only can avoid the nonlinear problem of discriminator, but also can reduce the bad effect of noise. Moreover, using cubature Kalman filter to deal with the nonlinear I/Q data is beneficial to preserve the accuracy of data processing. Because noise is unknown or time-varying, the filter should have the ability to respond to the changes of environmental noise. The innovation of measurements is used to estimate the covariance matrix of measurement noise in real time. Finally, a comparison is carried out between the present algorithm and the vector tracking algorithm based on discriminator. The test results show that the code phase error and the carrier frequency error are smaller, and the accuracy of navigation solution is also higher.
In multipath-assisted simultaneous localization and mapping (SLAM), position-related information (delays and angles) in multipath components of radio signals is used to simultaneously localize user equipment (UE) and map the environment. Multipath-assisted SLAM often involves unknown parameters that are potentially time varying, such as measurement noise. Knowledge of the measurement noise is of critical importance to multipath-assisted SLAM, and uncertainty in such knowledge will seriously affect estimation accuracy. We address this challenge by improving the belief propagation (BP)-based SLAM algorithm and proposing an adaptive multipath-assisted SLAM algorithm in a Bayesian tracking framework, which enables accommodation of a model mismatch of the measurement noise online. Specifically, we describe the evolution of the measurement noise standard deviation via a Markov chain and integrate it into the factor graph representing the Bayesian model of the multipath-assisted SLAM. Then, the BP message passing algorithm is leveraged to calculate the marginal posterior distributions of the UE, environmental features and the measurement noise standard deviation to achieve SLAM and the adaptive adjustment of the measurement noise. Finally, the experimental results verify the robustness of the proposed adaptive multipath-assisted SLAM algorithm against the uncertainty of the measurement noise.
scite is a Brooklyn-based organization that helps researchers better discover and understand research articles through Smart Citations–citations that display the context of the citation and describe whether the article provides supporting or contrasting evidence. scite is used by students and researchers from around the world and is funded in part by the National Science Foundation and the National Institute on Drug Abuse of the National Institutes of Health.