Abstract
In this paper, we investigate the consistency of extended Kalman filter (EKF)-based cooperative localization (CL) from the perspective of observability. We analytically show that the error-state system model employed in the standard EKF-based CL always has an observable subspace of higher dimension than that of the actual nonlinear CL system. This results in unjustified reduction of the EKF covariance estimates in directions of the state space where no information is available, and thus leads to inconsistency. To address this problem, we adopt an observability-based methodology for designing consistent estimators in which the linearization points are selected to ensure a linearized system model with observable subspace of correct dimension. In particular, we propose two novel observability-constrained (OC)-EKF estimators that are instances of this paradigm. In the first, termed OC-EKF 1.0, the filter Jacobians are calculated using the prior state estimates as the linearization points. In the second, termed OC-EKF 2.0, the linearization points are selected so as to minimize their expected errors (i.e., the difference between the linearization point and the true state) under the observability constraints. The proposed OC-EKFs have been tested in simulation and experimentally, and have been shown to significantly outperform the standard EKF in terms of both accuracy and consistency.
Talk to us
Join us for a 30 min session where you can share your feedback and ask us any queries you have
Disclaimer: All third-party content on this website/platform is and will remain the property of their respective owners and is provided on "as is" basis without any warranties, express or implied. Use of third-party content does not indicate any affiliation, sponsorship with or endorsement by them. Any references to third-party content is to identify the corresponding services and shall be considered fair use under The CopyrightLaw.