The DOI matches its Crossref record; 52 of the 52 references it cites were found in a registry or an index.
Contact-aided invariant extended Kalman filtering for robot state estimation
Open accessAbstract
Legged robots require knowledge of pose and velocity in order to maintain stability and execute walking paths. Current solutions either rely on vision data, which is susceptible to environmental and lighting conditions, or fusion of kinematic and contact data with measurements from an inertial measurement unit (IMU). In this work, we develop a contact-aided invariant extended Kalman filter (InEKF) using the theory of Lie groups and invariant observer design. This filter combines contact-inertial dynamics with forward kinematic corrections to estimate pose and velocity along with all current contact points. We show that the error dynamics follows a log-linear autonomous differential equation with several important consequences: (a) the observable state variables can be rendered convergent with a domain of attraction that is independent of the system’s trajectory; (b) unlike the standard EKF, neither the linearized error dynamics nor the linearized observation model depend on the current state estimate, which (c) leads to improved convergence properties and (d) a local observability matrix that is consistent with the underlying nonlinear system. Furthermore, we demonstrate how to include IMU biases, add/remove contacts, and formulate both world-centric and robo-centric versions. We compare the convergence of the proposed InEKF with the commonly used quaternion-based extended Kalman filter (EKF) through both simulations and experiments on a Cassie-series bipedal robot. Filter accuracy is analyzed using motion capture, while a LiDAR mapping experiment provides a practical use case. Overall, the developed contact-aided InEKF provides better performance in comparison with the quaternion-based EKF as a result of exploiting symmetries present in system.
Overview
The claims and statistics of this paper haven’t been checked yet.
Free: it reads the open-access text and checks the first 5 claims that cite a source we can check. Create a free account to check every claim.
Integrity signals
Registry
Cites
Statistics
Verification
Claims the paper makes
The claims and statistics of this paper haven’t been checked yet.
Free: it reads the open-access text and checks the first 5 claims that cite a source we can check. Create a free account to check every claim.
Self-check
Percentages, sums and reported differences re-computed from the paper’s own numbers.
The self-check needs the paper’s full text.
Citations
Cites
A New Approach to Linear Filtering and Prediction Problems
Kalman, R. E. (1960) · Journal of Basic Engineering · doi:10.1115/1.3662552 · Cited by 31,751 · cited 1×
“When the process model and measurements are linear, and the noise is white and Gaussian, Kalman filtering (Kalman, 1960) provides an optimal method (minimum mean squared error) for state estimation.”
MethodEstimation with Applications to Tracking and Navigation: Theory, Algorithms and Software
Bar‐Shalom, Y., Li, X. ‐., & Kirubarajan, T. (2002) · doi:10.1002/0471221279 · Cited by 6,782
VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator
Qin, T., Li, P., & Shen, S. (2018) · IEEE Transactions on Robotics · doi:10.1109/tro.2018.2853729 · Cited by 4,669 · cited 14×
“Section 12 itemizes additional sensor measurements that fit within the InEKF framework and describes the relation between the developed filter and landmark-based SLAM.”
MethodInfluentialProceedings. 1985 IEEE International Conference on Robotics and Automation
(1985) · doi:10.1109/robot.1985 · Cited by 3,673
Strapdown Inertial Navigation Technology
Titterton, D., & Weston, J. (2004) · Institution of Engineering and Technology eBooks · doi:10.1049/pbra017e · Cited by 3,348
Stochastic models, estimation, and control
(1982) · Mathematics in Science and Engineering · doi:10.1016/s0076-5392(08)x6186-7 · Cited by 3,229
On-Manifold Preintegration for Real-Time Visual--Inertial Odometry
Forster, C., Carlone, L., Dellaert, F., & Scaramuzza, D. (2017) · IEEE Transactions on Robotics · doi:10.1109/tro.2016.2597321 · Cited by 1,502 · cited 12×
“The theory of invariant observer design is based on the estimation error being invariant under the action of a matrix Lie group (Aghannan and Rouchon, 2002; Bonnabel et al., 2009), which has recently led to the development of the InEKF1 (Barrau, 2015; Barrau and Bonnabel, 2017, 2018; Bonnabel, 2007) with successful ap…”
BackgroundMethodInfluentialKalman Filtering for Spacecraft Attitude Estimation
Lefferts, E. J., Markley, F. L., & Shuster, M. D. (1982) · Journal of Guidance, Control, and Dynamics · doi:10.2514/3.56190 · Cited by 1,344
Estimating Uncertain Spatial Relationships in Robotics
Smith, R., Self, M., & Cheeseman, P. (1990) · Autonomous Robot Vehicles · doi:10.1007/978-1-4613-8997-2_14 · Cited by 1,288
Optimization-based locomotion planning, estimation, and control design for the atlas humanoid robot
Kuindersma, S., Deits, R., Fallon, M., Valenzuela, A., Dai, H., Permenter, F., Koolen, T., Marion, P., & Tedrake, R. (2016) · Autonomous Robots · doi:10.1007/s10514-015-9479-3 · Cited by 835
Barfoot, T. D. (2017) · Cambridge University Press eBooks · doi:10.1017/9781316671528 · Cited by 724
Inertial navigation systems for mobile robots
Barshan, B., & Durrant-Whyte, H. F. (1995) · IEEE Transactions on Robotics and Automation · doi:10.1109/70.388775 · Cited by 723
Lie Groups, Lie Algebras, and Representations: An Elementary Introduction
Hall, B. C. (2015) · Graduate Texts in Mathematics · doi:10.1007/978-3-319-13467-3 · Cited by 691
The Invariant Extended Kalman Filter as a Stable Observer
Barrau, A., & Bonnabel, S. (2016) · IEEE Transactions on Automatic Control · doi:10.1109/tac.2016.2594085 · Cited by 631
Lupton, T., & Sukkarieh, S. (2012) · IEEE Transactions on Robotics · doi:10.1109/tro.2011.2170332 · Cited by 469
Oksanen, T., Tiusanen, J., & Kostamo, J. (2009) · Precision agriculture '09 · doi:10.3920/9789086866649_102 · Cited by 414
Approaches to Multisensor Data Fusion in Target Tracking: A Survey
Smith, D., & Singh, S. (2006) · IEEE Transactions on Knowledge and Data Engineering · doi:10.1109/tkde.2006.183 · Cited by 379
Associating Uncertainty With Three-Dimensional Poses for Use in Estimation Problems
Barfoot, T. D., & Furgale, P. T. (2014) · IEEE Transactions on Robotics · doi:10.1109/tro.2014.2298059 · Cited by 305
Yang, Z., & Shen, S. (2017) · IEEE Transactions on Automation Science and Engineering · doi:10.1109/tase.2016.2550621 · Cited by 274
Observability-based Rules for Designing Consistent EKF SLAM Estimators
Huang, G. P., Mourikis, A. I., & Roumeliotis, S. I. (2010) · The International Journal of Robotics Research · doi:10.1177/0278364909353640 · Cited by 272
Design Of Multi-sensor Attitude Determination Systems
Gebre-Egziabher, D., Hayward, R. C., & Powell, J. D. (2004) · IEEE Transactions on Aerospace and Electronic Systems · doi:10.1109/taes.2004.1310010 · Cited by 226
Barrau, A., & Bonnabel, S. (2018) · Annual Review of Control, Robotics, and Autonomous Systems · doi:10.1146/annurev-control-060117-105010 · Cited by 225
Feedback Control of a Cassie Bipedal Robot: Walking, Standing, and Riding a Segway
Gong, Y., Hartley, R., Da, X., Hereid, A., Harib, O., Huang, J.-K., & Grizzle, J. (2019) · 2019 American Control Conference (ACC) · doi:10.23919/acc.2019.8814833 · Cited by 221
Self-citationROBOT-CENTRIC ELEVATION MAPPING WITH UNCERTAINTY ESTIMATES
FANKHAUSER, P., BLOESCH, M., GEHRING, C., HUTTER, M., & SIEGWART, R. (2014) · Mobile Service Robotics · doi:10.1142/9789814623353_0051 · Cited by 192
Bonnabel, S., Martin, P., & Salaun, E. (2009) · Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference · doi:10.1109/cdc.2009.5400372 · Cited by 190
Roumeliotis, S. I., Sukhatme, G. S., & Bekey, G. A. (2003) · Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C) · doi:10.1109/robot.1999.772597 · Cited by 172
Convergence and Consistency Analysis for a 3-D Invariant-EKF SLAM
Zhang, T., Wu, K., Song, J., Huang, S., & Dissanayake, G. (2017) · IEEE Robotics and Automation Letters · doi:10.1109/lra.2017.2651376 · Cited by 158
Left-invariant extended Kalman filter and attitude estimation
Bonnabel, S. (2007) · IEEE Conference on Decision and Control (CDC) · doi:10.1109/cdc.2007.4434662 · Cited by 149
Extended Kalman Filter vs. Error State Kalman Filter for Aircraft Attitude Estimation
Madyastha, V., Ravindra, V. C., Mallikarjunan, S., & Goyal, A. (2011) · AIAA Guidance, Navigation, and Control Conference and Exhibit · doi:10.2514/6.2011-6615 · Cited by 139
A Real-Time Adaptive High-Gain EKF, Applied to a Quadcopter Inertial Navigation System
Sebesta, K. D., & Boizot, N. (2013) · IEEE Transactions on Industrial Electronics · doi:10.1109/tie.2013.2253063 · Cited by 137
Sensor data fusion for body state estimation in a hexapod robot with dynamical gaits
Lin, P., Komsuoḡlu, H., & Koditschek, D. E. (2006) · IEEE Transactions on Robotics · doi:10.1109/tro.2006.878954 · Cited by 136
State estimation for legged robots on unstable and slippery terrain
Bloesch, M., Gehring, C., Fankhauser, P., Hutter, M., Hoepflinger, M. A., & Siegwart, R. (2013) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2013.6697236 · Cited by 136
Error propagation on the Euclidean group with applications to manipulator kinematics
Wang, Y., & Chirikjian, G. S. (2006) · IEEE Transactions on Robotics · doi:10.1109/tro.2006.878978 · Cited by 136
An invariant-EKF VINS algorithm for improving consistency
Wu, K., Zhang, T. L., Su, D., Huang, S., & Dissanayake, G. (2017) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2017.8205965 · Cited by 135
Nonparametric Second-order Theory of Error Propagation on Motion Groups
Wang, Y., & Chirikjian, G. S. (2008) · The International Journal of Robotics Research · doi:10.1177/0278364908097583 · Cited by 131
Bourmaud, G., Mégret, R., Arnaudon, M., & Giremus, A. (2014) · Journal of Mathematical Imaging and Vision · doi:10.1007/s10851-014-0517-0 · Cited by 124
Closed-form preintegration methods for graph-based visual–inertial navigation
Eckenhoff, K., Geneva, P., & Huang, G. P. (2019) · The International Journal of Robotics Research · doi:10.1177/0278364919835021 · Cited by 118
Robocentric Visual-Inertial Odometry
Huai, Z., & Huang, G. P. (2018) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2018.8593643 · Cited by 115
From 2D Design of Underactuated Bipedal Gaits to 3D Implementation: Walking With Speed Tracking
Da, X., Harib, O., Hartley, R., Griffin, B., & Grizzle, J. W. (2016) · IEEE Access · doi:10.1109/access.2016.2582731 · Cited by 114
Self-citationState estimation for a humanoid robot
Rotella, N., Bloesch, M., Righetti, L., et al. (2014) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2014.6942674 · Cited by 111
Non-linear state error based extended Kalman filters with applications to navigation
Barrau, A. (2015) · doi:10.70675/18946260z2999z44c6z9291ze47126202fe7 · Cited by 100
Precision attitude determination for multimission spacecraft
MURRELL, J. (1978) · Guidance and Control Conference · doi:10.2514/6.1978-1248 · Cited by 85
A leg configuration measurement system for full-body pose estimates in a hexapod robot
Lin, P., Komsuoḡlu, H., & Koditschek, D. E. (2005) · IEEE Transactions on Robotics · doi:10.1109/tro.2004.840898 · Cited by 82
Hybrid Contact Preintegration for Visual-Inertial-Contact State Estimation Using Factor Graphs
Hartley, R., Jadidi, M. G., Gan, L., Huang, J.-K., Grizzle, J. W., & Eustice, R. M. (2018) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2018.8593801 · Cited by 70
Self-citationContact-Aided Invariant Extended Kalman Filtering for Legged Robot State Estimation
Hartley, R., Jadidi, M. G., Grizzle, J. W., & Eustice, R. M. (2018) · Robotics: Science and Systems · doi:10.15607/rss.2018.xiv.050 · Cited by 69
Self-citationHwangbo, J., Bellicoso, C. D., Fankhauser, P., & Hutter, M. (2016) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2016.7759570 · Cited by 66
Heterogeneous Sensor Fusion for Accurate State Estimation of Dynamic Legged Robots
Nobili, S., Camurri, M., Barasuol, V., Focchi, M., Caldwell, D. G., Semini, C., & Fallon, M. F. (2017) · Robotics: Science and Systems · doi:10.15607/rss.2017.xiii.007 · Cited by 63
Location of legged robots in outdoor environments
Cobano, J. A., Estremera, J., & de Santos, P. G. (2008) · Robotics and Autonomous Systems · doi:10.1016/j.robot.2007.12.003 · Cited by 43
Symmetries in Observer Design: Review of Some Recent Results and Applications to EKF-based SLAM
Bonnabel, S. (2012) · Lecture notes in control and information sciences · doi:10.1007/978-1-4471-2343-9_1 · Cited by 35
Invariant smoothing on Lie Groups
Chauchat, P., Barrau, A., & Bonnabel, S. (2018) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2018.8594068 · Cited by 32
Optical Flow Aided Motion Estimation for Legged Locomotion
Singh, S. P. N., Csonka, P. J., & Waldron, K. J. (2006) · IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) · doi:10.1109/iros.2006.282134 · Cited by 30
Extended Kalman Filtering With Nonlinear Equality Constraints: A Geometric Approach
Barrau, A., & Bonnabel, S. (2019) · IEEE Transactions on Automatic Control · doi:10.1109/tac.2019.2929112 · Cited by 30
Cited by
Brossard, M., Barrau, A., & Bonnabel, S. (2020) · IEEE Transactions on Intelligent Vehicles · doi:10.1109/tiv.2020.2980758 · Cited by 338
Metadata
- Authors
- Hartley, R., Ghaffari, M., Eustice, R. M., & Grizzle, J. W.
- Venue
- The International Journal of Robotics Research
- Publisher
- SAGE Publications
- Published
- 2020-01-16
- Volume
- 39
- Issue
- 4
- Pages
- 402-430
- ISSN
- 0278-3649 (ISSN-L)
- 1741-3176
- OpenAlex
- W3000625188
- Cited by
- 321
- References
- 52
- FWCI
- 22.07
- Type
- journal article
- Language
- en
- Open access
- green
About these checks
Registry, retraction, Cites and statistics results are computed, not judged, with one exception: a printed reference that no index lists is read once by a model before it counts as a citation error. Claims are extracted by a model and kept only when their quote appears verbatim in the text; each cited source is then checked, with a model’s help, for whether it says what the claim relies on. Those verdicts can be wrong — read the claim’s quote and the cited source before relying on one.
Statistics and arithmetic are recomputed, not judged.
Confidence bands are shown only for fields calibrated on our annotated test set. None is calibrated yet, so no band is shown.
What counts as a claim ›How we measure confidence ›How we check this ›
Are you an author, or do you see a problem with this page? Request a review
Data sources
Bibliographic data: Semantic Scholar, OpenAlex, Crossref.
Contains information from the Semantic Scholar Academic Graph Datasets, made available under the ODC Attribution License (ODC-BY 1.0).
Semantic Scholar’s data is described in: Kinney, R., et al. (2023). The Semantic Scholar Open Data Platform. arXiv:2301.10140.