{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,10,12]],"date-time":"2025-10-12T04:25:52Z","timestamp":1760243152103,"version":"build-2065373602"},"reference-count":42,"publisher":"MDPI AG","issue":"8","license":[{"start":{"date-parts":[[2015,8,13]],"date-time":"2015-08-13T00:00:00Z","timestamp":1439424000000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>In this paper, a novel iterative sparse extended information filter (ISEIF) was proposed to solve the simultaneous localization and mapping problem (SLAM), which is very crucial for autonomous vehicles. The proposed algorithm solves the measurement update equations with iterative methods adaptively to reduce linearization errors. With the scalability advantage being kept, the consistency and accuracy of SEIF is improved. Simulations and practical experiments were carried out with both a land car benchmark and an autonomous underwater vehicle. Comparisons between iterative SEIF (ISEIF), standard EKF and SEIF are presented. All of the results convincingly show that ISEIF yields more consistent and accurate estimates compared to SEIF and preserves the scalability advantage over EKF, as well.<\/jats:p>","DOI":"10.3390\/s150819852","type":"journal-article","created":{"date-parts":[[2015,8,13]],"date-time":"2015-08-13T11:13:57Z","timestamp":1439464437000},"page":"19852-19879","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":9,"title":["Simultaneous Localization and Mapping with Iterative Sparse Extended Information Filter for Autonomous Vehicles"],"prefix":"10.3390","volume":"15","author":[{"given":"Bo","family":"He","sequence":"first","affiliation":[{"name":"School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Yang","family":"Liu","sequence":"additional","affiliation":[{"name":"School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Diya","family":"Dong","sequence":"additional","affiliation":[{"name":"School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-2792-9509","authenticated-orcid":false,"given":"Yue","family":"Shen","sequence":"additional","affiliation":[{"name":"School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Tianhong","family":"Yan","sequence":"additional","affiliation":[{"name":"School of Mechanical and Electrical Engineering, China Jiliang University, 258 Xueyuan Street, Xiasha High-Edu Park, Hangzhou 310018, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Rui","family":"Nian","sequence":"additional","affiliation":[{"name":"School of Information Science and Engineering, Ocean University of China, 238 Songling Road, Qingdao 266100, China"}],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"1968","published-online":{"date-parts":[[2015,8,13]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"131","DOI":"10.1109\/JOE.2013.2278891","article-title":"AUV Navigation and Localization: A Review","volume":"39","author":"Paull","year":"2014","journal-title":"IEEE J. Ocean. Eng."},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Kharchenko, V., Kondratyuk, V., Ilnytska, S., Kutsenko, O., and Larin, V. (2013, January 15\u201317). Urgent problems of UAV navigation system development and practical implementation. Proceedings of the 2013 IEEE 2nd International Conference on Actual Problems of Unmanned Air Vehicles Developments Proceedings (APUAVD), Kiev, Ukraine.","DOI":"10.1109\/APUAVD.2013.6705313"},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"540","DOI":"10.1109\/TVT.2013.2281199","article-title":"A Sensor-Fusion Drivable-Region and Lane-Detection System for Autonomous Vehicle Navigation in Challenging Road Scenarios","volume":"63","author":"Li","year":"2014","journal-title":"IEEE Trans. Veh. Technol."},{"key":"ref_4","unstructured":"Smith, R., Self, M., and Cheeseman, P. (1990). Autonomous Robot Vehicles, Springer-Verlag New York, Inc."},{"key":"ref_5","unstructured":"Matsebe, O. (2008). EKF-SLAM Based Navigation System for an AUV, CSIR."},{"key":"ref_6","unstructured":"Vazquez-Martin, R., Nu\u00f1ez, P., del Toro, J., Bandera, A., and Sandoval, F. (2006, January 16\u201319). Adaptive observation covariance for EKF-SLAM in indoor environments using laser data. Proceedings of the Electrotechnical Conference 2006 (MELECON 2006), Malaga, Spain."},{"key":"ref_7","unstructured":"Thrun, S., Burgard, W., and Fox, D. (2005). Probabilistic Robotics, MIT Press."},{"key":"ref_8","unstructured":"Maybeck, P.S. (1982). Stochastic Models, Estimation, and Control, Academic Press."},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"693","DOI":"10.1177\/0278364904045479","article-title":"Simultaneous localization and mapping with sparse extended information filters","volume":"23","author":"Thrun","year":"2004","journal-title":"Int. J. Robot. Res."},{"key":"ref_10","unstructured":"Frese, U., and Hirzinger, G. (2001, January 4\u201310). Simultaneous localization and mapping\u2014A discussion. Proceedings of the IJCAI Workshop on Reasoning with Uncertainty in Robotics, Seattle, WA, USA."},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"99","DOI":"10.1109\/MRA.2006.1678144","article-title":"Simultaneous localization and mapping: Part I","volume":"13","author":"Bailey","year":"2006","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"108","DOI":"10.1109\/MRA.2006.1678144","article-title":"Simultaneous localization and mapping (SLAM): Part II","volume":"13","author":"Bailey","year":"2006","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_13","unstructured":"Montemerlo, M., Thrun, S., Koller, D., and Wegbreit, B. (2002). FastSLAM: A Factored Solution to the Simultaneous Localization and Mapping Problem, AAAI\/IAAI."},{"key":"ref_14","unstructured":"Montemerlo, M., and Thrun, S. (2007). FastSLAM: A Scalable Method for the Simultaneous Localization and Mapping Problem in Robotics, Springer."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Bailey, T., Nieto, J., Guivant, J., Stevens, M., and Nebot, E. (2006, January 9\u201315). Consistency of the EKF-SLAM algorithm. Proceedings of the 2006 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Beijing, China.","DOI":"10.1109\/IROS.2006.281644"},{"key":"ref_16","unstructured":"Liu, Y., and Thrun, S. (2003). Results for Outdoor-SLAM Using Sparse Extended Information Filters, ICRA."},{"key":"ref_17","unstructured":"Thrun, S., and Liu, Y. (2005). Robotics Research, Springer."},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Eustice, R., Walter, M., and Leonard, J. (2005, January 2\u20136). Sparse extended information filters: Insights into sparsification. Proceedings of the 2005 IEEE\/RSJ International Conference on Intelligent Robots and Systems 2005 (IROS 2005), Edmonton, AB, Canada.","DOI":"10.1109\/IROS.2005.1545053"},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"335","DOI":"10.1177\/0278364906075026","article-title":"Exactly sparse extended information filters for feature-based SLAM","volume":"26","author":"Walter","year":"2007","journal-title":"Int. J. Robot. Res."},{"key":"ref_20","doi-asserted-by":"crossref","unstructured":"Walter, M., Hover, F., and Leonard, J. (2008, January 19\u201323). SLAM for ship hull inspection using exactly sparse extended information filters. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA 2008), Pasadena, CA, USA.","DOI":"10.1109\/ROBOT.2008.4543408"},{"key":"ref_21","unstructured":"Gutmann, J.S., Eade, E., Fong, P., and Munich, M.E. (2010). Robotics: Science and Systems, The MIT Press."},{"key":"ref_22","unstructured":"Eustice, R.M., Singh, H., and Leonard, J.J. (2005, January 18\u201322). Exactly sparse delayed-state filters. Proceedings of the 2005 IEEE International Conference on Robotics and Automation (ICRA 2005), Barcelona, Spain."},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Simon, D. (2006). Optimal State Estimation: Kalman, H infinity, and Nonlinear Approaches, John Wiley & Sons.","DOI":"10.1002\/0470045345"},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"575","DOI":"10.1007\/s10846-010-9495-7","article-title":"Experimental study of iterated Kalman filters for simultaneous localization and mapping of autonomous mobile robots","volume":"63","author":"Shojaei","year":"2011","journal-title":"J. Intell. Robot. Syst."},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"543","DOI":"10.1007\/s10846-009-9327-9","article-title":"The study of improving Kalman filters family for nonlinear SLAM","volume":"56","author":"Zhou","year":"2009","journal-title":"J. Intell. Robot. Syst."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"639","DOI":"10.1080\/00207170410001704998","article-title":"Kalman filters for non-linear systems: A comparison of performance","volume":"77","author":"Lefebvre","year":"2004","journal-title":"Int. J. Control"},{"key":"ref_27","unstructured":"Guivant, J. Victoria Park. Available online: http:\/\/www-personal.acfr.usyd.edu.au\/nebot\/victoria_park.htm."},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"236","DOI":"10.1080\/15397734.2012.726847","article-title":"A Distributed Parallel Motion Control for the Multi-Thruster Autonomous Underwater Vehicle","volume":"41","author":"He","year":"2013","journal-title":"Mech. Based Des. Struct. Mach."},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"9386","DOI":"10.3390\/s120709386","article-title":"AUV SLAM and experiments using a mechanical scanning forward-looking sonar","volume":"12","author":"He","year":"2012","journal-title":"Sensors"},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"72","DOI":"10.1016\/j.oceaneng.2013.01.029","article-title":"A static output feedback control design for path following of autonomous underwater vehicle in vertical plane","volume":"63","author":"Subudhi","year":"2013","journal-title":"Ocean Eng."},{"key":"ref_31","doi-asserted-by":"crossref","unstructured":"Kuwata, Y., Wolf, M.T., Zarzhitsky, D., and Huntsberger, T.L. Safe Maritime Autonomous Navigation with COLREGS, Using Velocity Obstacles. IEEE J. Ocean. Eng., 39, 110\u2013119.","DOI":"10.1109\/JOE.2013.2254214"},{"key":"ref_32","unstructured":"Bar-Shalom, Y., Li, X.R., and Kirubarajan, T. (2004). Estimation with Applications to Tracking and Navigation: Theory Algorithms and Software, John Wiley & Sons."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"749","DOI":"10.1109\/TRA.2003.814500","article-title":"Solving computational and memory requirements of feature-based simultaneous localization and mapping algorithms","volume":"19","author":"Guivant","year":"2003","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"1226","DOI":"10.1109\/TRO.2013.2267991","article-title":"A Quadratic-Complexity Observability-Constrained Unscented Kalman Filter for SLAM","volume":"29","author":"Huang","year":"2013","journal-title":"IEEE Trans. Robot."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"158","DOI":"10.1109\/TRO.2013.2277549","article-title":"Consistency Analysis and Improvement of Vision-aided Inertial Navigation","volume":"30","author":"Hesch","year":"2014","journal-title":"IEEE Trans. Robot."},{"key":"ref_36","doi-asserted-by":"crossref","first-page":"719","DOI":"10.1109\/TRO.2012.2235699","article-title":"Real-Time Visual SLAM for Autonomous Underwater Hull Inspection Using Visual Saliency","volume":"29","author":"Kim","year":"2013","journal-title":"IEEE Trans. Robot."},{"key":"ref_37","doi-asserted-by":"crossref","first-page":"1181","DOI":"10.1177\/0278364906072768","article-title":"Square Root SAM: Simultaneous localization and mapping via square root information smoothing","volume":"25","author":"Dellaert","year":"2006","journal-title":"Int. J. Robot. Res."},{"key":"ref_38","unstructured":"Kummerle, R., Grisetti, G., Strasdat, H., Konolige, K., and Burgard, W. (2011, January 9\u201313). g2o: A general framework for graph optimization. Proceedings of the 2011 IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China."},{"key":"ref_39","doi-asserted-by":"crossref","unstructured":"Sunderhauf, N., and Protzel, P. (2013, January 6\u201310). Switchable constraints vs. max-mixture models vs. RRR\u2014A comparison of three approaches to robust pose graph SLAM. Proceedings of the 2013 IEEE International Conference on Robotics and Automation (ICRA), Karlsruhe, Germany.","DOI":"10.1109\/ICRA.2013.6631320"},{"key":"ref_40","doi-asserted-by":"crossref","first-page":"500","DOI":"10.1109\/JOE.2012.2235664","article-title":"Relocating Underwater Features Autonomously Using Sonar-Based SLAM","volume":"38","author":"Fallon","year":"2013","journal-title":"IEEE J. Ocean. Eng."},{"key":"ref_41","doi-asserted-by":"crossref","first-page":"83","DOI":"10.1109\/MRA.2013.2283642","article-title":"Embedded Visual SLAM: Applications for Low-Cost Consumer Robots","volume":"20","author":"Lee","year":"2013","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"1246","DOI":"10.1109\/TITS.2014.2298492","article-title":"Vision-Only Localization","volume":"15","author":"Lategahn","year":"2014","journal-title":"IEEE Trans. Intell. Transp. Syst."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/15\/8\/19852\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T20:50:38Z","timestamp":1760215838000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/15\/8\/19852"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2015,8,13]]},"references-count":42,"journal-issue":{"issue":"8","published-online":{"date-parts":[[2015,8]]}},"alternative-id":["s150819852"],"URL":"https:\/\/doi.org\/10.3390\/s150819852","relation":{},"ISSN":["1424-8220"],"issn-type":[{"type":"electronic","value":"1424-8220"}],"subject":[],"published":{"date-parts":[[2015,8,13]]}}}