{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,2,13]],"date-time":"2026-02-13T23:40:10Z","timestamp":1771026010999,"version":"3.50.1"},"reference-count":62,"publisher":"Cambridge University Press (CUP)","issue":"6","license":[{"start":{"date-parts":[[2014,4,1]],"date-time":"2014-04-01T00:00:00Z","timestamp":1396310400000},"content-version":"unspecified","delay-in-days":0,"URL":"https:\/\/www.cambridge.org\/core\/terms"}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Robotica"],"published-print":{"date-parts":[[2015,7]]},"abstract":"<jats:title>SUMMARY<\/jats:title><jats:p>In this work, we investigate a quaternion-based formulation of 3D Simultaneous Localization and Mapping with Extended Kalman Filter (EKF-SLAM) using relative pose measurements. We introduce a discrete-time derivation that avoids the<jats:italic>normalization problem<\/jats:italic>that often arises when using unit quaternions in Kalman filter and we study its observability properties. The consistency of the estimation errors with the corresponding covariance matrices is also evaluated. The approach is further tested on real data from the<jats:italic>Rawseeds dataset<\/jats:italic>and it is applied within a delayed-state EKF architecture for estimating a dense 3D map of an unknown environment. The contribution is motivated by the possibility of abstracting multi-sensorial information in terms of relative pose measurements and for its straightforward extensions to the multi robot case.<\/jats:p>","DOI":"10.1017\/s0263574714000678","type":"journal-article","created":{"date-parts":[[2014,4,1]],"date-time":"2014-04-01T12:41:03Z","timestamp":1396356063000},"page":"1250-1280","source":"Crossref","is-referenced-by-count":5,"title":["Quaternion-based EKF-SLAM from relative pose measurements: observability analysis and applications"],"prefix":"10.1017","volume":"33","author":[{"given":"Luca","family":"Carlone","sequence":"first","affiliation":[],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Vito","family":"Macchia","sequence":"additional","affiliation":[],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Federico","family":"Tibaldi","sequence":"additional","affiliation":[],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Basilio","family":"Bona","sequence":"additional","affiliation":[],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"56","published-online":{"date-parts":[[2014,4,1]]},"reference":[{"key":"S0263574714000678_ref1","doi-asserted-by":"publisher","DOI":"10.1017\/S0263574710000809"},{"key":"S0263574714000678_ref36","doi-asserted-by":"publisher","DOI":"10.1109\/TRO.2009.2034435"},{"key":"S0263574714000678_ref4","unstructured":"T. Bailey , J. Nieto , J. Guivant , M. Stevens and E. Nebot , \u201cConsistency of the EKF-SLAM Algorithm,\u201d Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (2006) pp. 3562\u20133568."},{"key":"S0263574714000678_ref8","unstructured":"W. G. Breckenridge , \u201cQuaternions - proposed standard conventions,\u201d In\u201d JPL, Tech. Rep. INTEROFFICE MEMORANDUM IOM 343-79-1199 (1999)."},{"key":"S0263574714000678_ref51","doi-asserted-by":"crossref","unstructured":"P. Pini\u00e9s and J. D. Tard\u00f3s , \u201cScalable SLAM Building Conditionally Independent Local Maps,\u201d IEEE-RSJ International Conference on Intelligent Robots and Systems (2007).","DOI":"10.1109\/IROS.2007.4399302"},{"key":"S0263574714000678_ref19","doi-asserted-by":"crossref","unstructured":"D. M. Cole and P. M. Newman , \u201cUsing Laser Range Data for 3D SLAM in Outdoor Environments,\u201d IEEE International Conference on Robotics and Automation (2006) pp. 1556\u20131563.","DOI":"10.1109\/ROBOT.2006.1641929"},{"key":"S0263574714000678_ref6","doi-asserted-by":"publisher","DOI":"10.1017\/S0263574705001657"},{"key":"S0263574714000678_ref7","volume-title":"Mobile Robots: Perception and Navigation","author":"Bayro-Corrochano","year":"2007"},{"key":"S0263574714000678_ref49","unstructured":"A. N\u00fcchter , H. Surmann , K. Lingemann , J. Hertzberg and S. Thrun , \u201c6D SLAM with an Application in Autonomous Mine Mapping,\u201d IEEE International Conference on Robotics and Automation (2004) pp. 1998\u20132003."},{"key":"S0263574714000678_ref52","doi-asserted-by":"publisher","DOI":"10.1109\/TBME.2006.875664"},{"key":"S0263574714000678_ref14","unstructured":"H. Casarrubias-Vargas , A. H. Petrilli-Barcel\u00f3 and E. Bayro-Corrochano , \u201cEKF-SLAM and Machine Learning Techniques for Visual Robot Navigation,\u201d Proceedings of the 20th International Conference on Pattern Recognition (2010) pp. 396\u2013399."},{"key":"S0263574714000678_ref21","doi-asserted-by":"publisher","DOI":"10.1007\/BF01450852"},{"key":"S0263574714000678_ref40","doi-asserted-by":"crossref","DOI":"10.1515\/9780691211701","volume-title":"Quaternions and Rotation Sequences: A Primer with Applications to Orbits, Aerospace, and Virtual Reality","author":"Kuipers","year":"1999"},{"key":"S0263574714000678_ref56","doi-asserted-by":"publisher","DOI":"10.1007\/978-3-540-30301-5"},{"key":"S0263574714000678_ref25","first-page":"22","article-title":"Uncertain geometry in robotics","volume":"4","author":"Durrant-Whyte","year":"1988","journal-title":"IEEE Trans. Robot. Automat."},{"key":"S0263574714000678_ref18","doi-asserted-by":"crossref","unstructured":"H. Chiu , S. Williams , F. Dellaert , S. Samarasekera and R. Kumar , \u201cRobust Vision-Aided Navigation Using Sliding-Window Factor Graphs,\u201d Proceedings of the IEEE International Conference on Robotics and Automation (2013).","DOI":"10.1109\/ICRA.2013.6630555"},{"key":"S0263574714000678_ref61","doi-asserted-by":"publisher","DOI":"10.1177\/0278364906075026"},{"key":"S0263574714000678_ref9","doi-asserted-by":"publisher","DOI":"10.1109\/TAES.2008.4517003"},{"key":"S0263574714000678_ref12","doi-asserted-by":"crossref","unstructured":"L. Carlone and B. Bona , \u201cOn registration of Uncertain Three-Dimensional Vectors with Application to Robotics,\u201d Proceedings of the IFAC World Congress (2011).","DOI":"10.3182\/20110828-6-IT-1002.01163"},{"key":"S0263574714000678_ref2","doi-asserted-by":"publisher","DOI":"10.1007\/s10846-008-9304-8"},{"key":"S0263574714000678_ref3","unstructured":"P. Azad , T. Asfour and R. Dillmann , \u201cStereo-Based 6D Object Localization for Grasping with Humanoid Robot Systems,\u201d Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (2007) pp. 919\u2013924."},{"key":"S0263574714000678_ref62","doi-asserted-by":"crossref","unstructured":"J. Weingarten and R. Siegwart , \u201cEKF-Based 3D SLAM for Structured Environment Reconstruction,\u201d Proceedings of the International Conference on Intelligent Robots and Systems (2005) pp. 2\u20136.","DOI":"10.1109\/IROS.2005.1545285"},{"key":"S0263574714000678_ref50","doi-asserted-by":"publisher","DOI":"10.1002\/rob.20355"},{"key":"S0263574714000678_ref13","unstructured":"L. Carlone , V. Macchia , F. Tibaldi and B. Bona , \u201cRobot Localization and 3D Mapping: Observability Analysis and Applications,\u201d Proceedings of the Int. Symposium on Artificial Intelligence, Robotics and Automation in Space (2012)."},{"key":"S0263574714000678_ref45","unstructured":"J. L. Marins , X. Yun , E. R. Bachman and R. B. McGhee , \u201cAn Extended Kalman Filter for Quaternion-Based Orientation Estimation using MARG Sensors,\u201d Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (2001) pp. 2003\u20132011."},{"key":"S0263574714000678_ref20","unstructured":"A. Cristofaro , A. Renzaglia and A. Martinelli , \u201cDistributed Information Filters for MAV Cooperative Localization,\u201d Proceedings of the 10th International Symposium on Distributed Autonomous Robotics Systems (2010) pp. 287\u2013293."},{"key":"S0263574714000678_ref55","first-page":"439","article-title":"A survey of attitude representations","volume":"41","author":"Shuster","year":"1993","journal-title":"J. Astronaut. Sci."},{"key":"S0263574714000678_ref16","unstructured":"J. A. Castellanos , J. Neira and J. D. Tard\u00f3s , \u201cLimits to the Consistency of EKF-Based SLAM,\u201d 5th IFAC Symp. on Intelligent Autonomous Vehicles (2004) pp. 1244\u20131249."},{"key":"S0263574714000678_ref22","unstructured":"A. Doucet , N. de Freitas , K. Murphy and S. Russel , \u201cRao-Blackwellized Particle Filtering for Dynamic Bayesian Networks,\u201d Proceedings of the Conf. on Uncertainty in Artificial Intelligence (2000) pp. 176\u2013183."},{"key":"S0263574714000678_ref48","unstructured":"D. Nister and H. Stewenius , \u201cScalable Recognition with a Vocabulary Tree,\u201d Proceedings of the 2006 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (2005) pp. 2161\u20132168."},{"key":"S0263574714000678_ref23","doi-asserted-by":"publisher","DOI":"10.1109\/MRA.2006.1638022"},{"key":"S0263574714000678_ref27","unstructured":"D. Sorrenti , W. Burgard , G. Grisetti , M. Ruhnke , C. Stachniss , G. Fontana , M. Matteucci , D. Marzorati , J. D. Tard\u00f3s , et al. \u201cRawseed Project: Deliverable D4.1, Benchmark problems\u201d, Technical Report, available online at: http:\/\/www.rawseeds.org\/home\/category\/documents\/deliverables\/, 2009."},{"key":"S0263574714000678_ref28","first-page":"1100","article-title":"Exactly sparse delayed-state filters for view-based SLAM","volume":"22","author":"Eustice","year":"2006","journal-title":"Int. J. Robot. Res."},{"key":"S0263574714000678_ref29","doi-asserted-by":"crossref","unstructured":"M. A. Garcia and A. Solanas , \u201c3D Simultaneous Localization and Modeling from Stereo Vision,\u201d IEEE International Conference on Robotics and Automation (2004) pp. 847\u2013853.","DOI":"10.1109\/ROBOT.2004.1307255"},{"key":"S0263574714000678_ref11","doi-asserted-by":"publisher","DOI":"10.1109\/70.720361"},{"key":"S0263574714000678_ref24","doi-asserted-by":"publisher","DOI":"10.1109\/MRA.2006.1638022"},{"key":"S0263574714000678_ref31","doi-asserted-by":"publisher","DOI":"10.1109\/7.165368"},{"key":"S0263574714000678_ref32","volume-title":"Multiple View Geometry in Computer Vision","author":"Hartley","year":"2000"},{"key":"S0263574714000678_ref43","doi-asserted-by":"publisher","DOI":"10.1177\/0278364902021010889"},{"key":"S0263574714000678_ref33","doi-asserted-by":"publisher","DOI":"10.1017\/CBO9780511810817"},{"key":"S0263574714000678_ref34","doi-asserted-by":"publisher","DOI":"10.1177\/0278364909353640"},{"key":"S0263574714000678_ref42","doi-asserted-by":"publisher","DOI":"10.1007\/s11263-007-0042-3"},{"key":"S0263574714000678_ref58","unstructured":"C. Stachniss , G. Grisetti , D. Hahnel and W. Burgard , \u201cImproved Rao-Blackwellized Mapping by Adaptive Sampling and Active Loop-Closure,\u201d Proceedings of the Workshop on Self-Organization of AdaptiVE behavior (2004) pp. 1\u201315."},{"key":"S0263574714000678_ref30","doi-asserted-by":"publisher","DOI":"10.1109\/7.165367"},{"key":"S0263574714000678_ref41","doi-asserted-by":"publisher","DOI":"10.2514\/3.56190"},{"key":"S0263574714000678_ref35","doi-asserted-by":"publisher","DOI":"10.1109\/TRO.2007.903811"},{"key":"S0263574714000678_ref37","doi-asserted-by":"crossref","unstructured":"S. Julier and J. Uhlmann , \u201cA Counter Example to the Theory of Simultaneous Localization and Map Building,\u201d Proceedings of the IEEE International Conference on Robotics and Automation (2001) pp. 4238\u20134243.","DOI":"10.1109\/ROBOT.2001.933280"},{"key":"S0263574714000678_ref38","doi-asserted-by":"publisher","DOI":"10.1177\/0278364911430419"},{"key":"S0263574714000678_ref54","doi-asserted-by":"publisher","DOI":"10.1109\/TRO.2008.2004490"},{"key":"S0263574714000678_ref39","unstructured":"J. H. Kim and S. Sukkarieh , \u201cImproving the real-time efficiency of inertial SLAM and understanding its observability,\u201d IEEE International Conference on Intelligent RObots and Systems, pp. 1264\u20131269 (2004)."},{"key":"S0263574714000678_ref44","doi-asserted-by":"publisher","DOI":"10.1023\/A:1008854305733"},{"key":"S0263574714000678_ref46","doi-asserted-by":"publisher","DOI":"10.1109\/TRO.2009.2012342"},{"key":"S0263574714000678_ref47","unstructured":"P. Newman , On the Structures and Solution of Simultaneous Localization and Mapping Problem, Ph.D. thesis (Department of Mathematical Sciences, Division of Mathematics, Chalmers University of Technology and Goteborg University, 2007)."},{"key":"S0263574714000678_ref53","doi-asserted-by":"crossref","unstructured":"D. Sabatta , D. Scaramuzza and R. Siegwart , \u201cImproved Appearance-Based Matching in Similar and Dynamic Environments using a Vocabulary Tree,\u201d Proceedings of the IEEE International Conference on Robotics and Automation (2010) pp. 2262\u20132269.","DOI":"10.1109\/ROBOT.2010.5509382"},{"key":"S0263574714000678_ref26","doi-asserted-by":"publisher","DOI":"10.1109\/TRO.2005.844673"},{"key":"S0263574714000678_ref57","doi-asserted-by":"publisher","DOI":"10.1177\/027836498600500404"},{"key":"S0263574714000678_ref59","unstructured":"S. Thrun , D. Koller , Z. Ghahramani , H. Durrant-Whyte and A. Y. Ng , \u201cSimultaneous Mapping and Localization with Sparse Extended Information Filters,\u201d Proceedings of the 5th Int. Workshop on Algorithmic Foundations of Robotics (2002)."},{"key":"S0263574714000678_ref60","volume-title":"Tech. Rep.","author":"Trawny","year":"2005"},{"key":"S0263574714000678_ref10","doi-asserted-by":"crossref","unstructured":"C. Cadena , D. Galvez-Lopez , F. Ramos , J. D. Tard\u00f3s and J. Neira , \u201cRobust Place Recognition With Stereo Cameras,\u201d IEEE\/RSJ International Conference on Intelligent Robots and Systems (2010) pp. 5182\u20135189.","DOI":"10.1109\/IROS.2010.5650234"},{"key":"S0263574714000678_ref15","doi-asserted-by":"publisher","DOI":"10.1016\/j.robot.2006.06.005"},{"key":"S0263574714000678_ref17","doi-asserted-by":"publisher","DOI":"10.1007\/s10514-009-9156-5"},{"key":"S0263574714000678_ref5","doi-asserted-by":"publisher","DOI":"10.1002\/0471221279"}],"container-title":["Robotica"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.cambridge.org\/core\/services\/aop-cambridge-core\/content\/view\/S0263574714000678","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2020,8,17]],"date-time":"2020-08-17T02:50:00Z","timestamp":1597632600000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.cambridge.org\/core\/product\/identifier\/S0263574714000678\/type\/journal_article"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2014,4,1]]},"references-count":62,"journal-issue":{"issue":"6","published-print":{"date-parts":[[2015,7]]}},"alternative-id":["S0263574714000678"],"URL":"https:\/\/doi.org\/10.1017\/s0263574714000678","relation":{},"ISSN":["0263-5747","1469-8668"],"issn-type":[{"value":"0263-5747","type":"print"},{"value":"1469-8668","type":"electronic"}],"subject":[],"published":{"date-parts":[[2014,4,1]]}}}