{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,3,14]],"date-time":"2026-03-14T05:25:20Z","timestamp":1773465920875,"version":"3.50.1"},"reference-count":35,"publisher":"MDPI AG","issue":"3","license":[{"start":{"date-parts":[[2016,3,4]],"date-time":"2016-03-04T00:00:00Z","timestamp":1457049600000},"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>This article addresses the problems of online estimations of kinematic and dynamic states of a mechanism from a sequence of noisy measurements. In particular, we focus on a planar four-bar linkage equipped with inertial measurement units (IMUs). Firstly, we describe how the position, velocity, and acceleration of all parts of the mechanism can be derived from IMU signals by means of multibody kinematics. Next, we propose the novel idea of integrating the generic multibody dynamic equations into two variants of Kalman filtering, i.e., the extended Kalman filter (EKF) and the unscented Kalman filter (UKF), in a way that enables us to handle closed-loop, constrained mechanisms, whose state space variables are not independent and would normally prevent the direct use of such estimators. The proposal in this work is to apply those estimators over the manifolds of allowed positions and velocities, by means of estimating a subset of independent coordinates only. The proposed techniques are experimentally validated on a testbed equipped with encoders as a means of establishing the ground-truth. Estimators are run online in real-time, a feature not matched by any previous procedure of those reported in the literature on multibody dynamics.<\/jats:p>","DOI":"10.3390\/s16030333","type":"journal-article","created":{"date-parts":[[2016,3,4]],"date-time":"2016-03-04T10:53:34Z","timestamp":1457088814000},"page":"333","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":14,"title":["Online Kinematic and Dynamic-State Estimation for Constrained Multibody Systems Based on IMUs"],"prefix":"10.3390","volume":"16","author":[{"ORCID":"https:\/\/orcid.org\/0000-0002-0147-9231","authenticated-orcid":false,"given":"Jos\u00e9","family":"Torres-Moreno","sequence":"first","affiliation":[{"name":"Department of Engineering, Automatic Control, Robotics and Mechatronics Research Group, University of Almer\u00eda, Agrifood Campus of International Excellence (ceiA3), CIESOL, Joint Center University of Almer\u00eda-CIEMAT, Almer\u00eda 04120, Spain"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-9745-285X","authenticated-orcid":false,"given":"Jos\u00e9","family":"Blanco-Claraco","sequence":"additional","affiliation":[{"name":"Department of Engineering, Automatic Control, Robotics and Mechatronics Research Group, University of Almer\u00eda, Agrifood Campus of International Excellence (ceiA3), CIESOL, Joint Center University of Almer\u00eda-CIEMAT, Almer\u00eda 04120, Spain"}]},{"given":"Antonio","family":"Gim\u00e9nez-Fern\u00e1ndez","sequence":"additional","affiliation":[{"name":"Department of Engineering, Automatic Control, Robotics and Mechatronics Research Group, University of Almer\u00eda, Agrifood Campus of International Excellence (ceiA3), CIESOL, Joint Center University of Almer\u00eda-CIEMAT, Almer\u00eda 04120, Spain"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-3024-911X","authenticated-orcid":false,"given":"Emilio","family":"Sanjurjo","sequence":"additional","affiliation":[{"name":"Mechanical Engineering Laboratory, University of A Coru\u00f1a, Escuela Polit\u00e9cnica Superior, Mendiz\u00e1bal s\/n, Ferrol 15403, Spain"}]},{"ORCID":"https:\/\/orcid.org\/0000-0001-7901-8278","authenticated-orcid":false,"given":"Miguel","family":"Naya","sequence":"additional","affiliation":[{"name":"Mechanical Engineering Laboratory, University of A Coru\u00f1a, Escuela Polit\u00e9cnica Superior, Mendiz\u00e1bal s\/n, Ferrol 15403, Spain"}]}],"member":"1968","published-online":{"date-parts":[[2016,3,4]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"1530","DOI":"10.1016\/j.mechmachtheory.2008.01.001","article-title":"Renaissance of machines in Italy: From Brunelleschi to Galilei through Francesco di Giorgio and Leonardo","volume":"43","author":"Ceccarelli","year":"2008","journal-title":"Mech. Mach. Theory"},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"072301","DOI":"10.1115\/1.2918911","article-title":"Burmester and Allievi: A Theory and Its Application for Mechanism Design at the End of 19th Century","volume":"130","author":"Ceccarelli","year":"2008","journal-title":"J. Mech. Design"},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Garc\u00eda de Jal\u00f3n, J., and Bayo, E. (1994). Kinematic and Dynamic Simulation of Multibody Systems: The Real Time Challenge, Springer-Verlag.","DOI":"10.1007\/978-1-4612-2600-0"},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"259","DOI":"10.1023\/A:1009754006096","article-title":"Modeling and Solution Methods for Efficient Real-Time Simulation of Multibody Dynamics","volume":"1","author":"Cuadrado","year":"1997","journal-title":"Multibody Syst. Dyn."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"149","DOI":"10.1023\/A:1009745432698","article-title":"Multibody system dynamics: Roots and perspectives","volume":"1","author":"Schiehlen","year":"1997","journal-title":"Multibody Syst. Dyn."},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"189","DOI":"10.1023\/A:1009773505418","article-title":"Flexible multibody dynamics: Review of past and recent developments","volume":"1","author":"Shabana","year":"1997","journal-title":"Multibody Syst. Dyn."},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Ulrich, S., and Sasiadek, J.Z. (July, January 29). Extended Kalman filtering for flexible joint space robot control. Proceedings of the 2011 American Control Conference, San Francisco, CA, USA.","DOI":"10.1109\/ACC.2011.5990848"},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"011005","DOI":"10.1115\/1.2803258","article-title":"Review of contemporary approaches for constraint enforcement in multibody systems","volume":"3","author":"Bauchau","year":"2008","journal-title":"J. Comput. Nonlinear Dyn."},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"99","DOI":"10.1016\/j.mechmachtheory.2012.02.010","article-title":"Compliant contact force models in multibody dynamics: Evolution of the Hertz contact theory","volume":"53","author":"Machado","year":"2012","journal-title":"Mech. Mach. Theory"},{"key":"ref_10","first-page":"607","article-title":"On the effect of linear algebra implementations in real-time multibody system dynamics","volume":"41","author":"Dopico","year":"2008","journal-title":"Comput. Mech."},{"key":"ref_11","unstructured":"Torres-Moreno, J.L., Blanco-Claraco, J.L., Gim\u00e9nez, A., and L\u00f3pez-Mart\u00ednez, J. (July, January 29). A comparison of Algorithms for Sparse Matrix Factoring and Variable Reordering aimed at Real-time Multibody Dynamic Simulation. Proceedings of the ECCOMAS Thematic Conference on Multibody Dynamics, Catalonia, Spain."},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"371","DOI":"10.1007\/s11044-013-9397-0","article-title":"On the Gr\u00f6bner basis triangularization of constraint equations in natural coordinates","volume":"31","author":"Uchida","year":"2014","journal-title":"Multibody Syst. Dyn."},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"147","DOI":"10.1023\/B:MUBO.0000025413.13130.2b","article-title":"Experimental Validation of a Flexible MBS Dynamic Formulation through Comparison between Measured and Calculated Stresses on a Prototype Car","volume":"11","author":"Cuadrado","year":"2004","journal-title":"Multibody Syst. Dyn."},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"3","DOI":"10.1007\/s11044-011-9251-1","article-title":"Automotive observers based on multibody models and the extended Kalman filter","volume":"27","author":"Cuadrado","year":"2012","journal-title":"Multibody Syst. Dyn."},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"331","DOI":"10.1007\/s11044-011-9299-y","article-title":"Driving simulator with double-wishbone suspension using efficient block-triangularized kinematic equations","volume":"28","author":"Uchida","year":"2012","journal-title":"Multibody Syst. Dyn."},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"531","DOI":"10.2514\/3.20672","article-title":"Unified formulation of dynamics for serial rigid multibody systems","volume":"14","author":"Jain","year":"1991","journal-title":"J. Guid. Control Dyn."},{"key":"ref_17","first-page":"11003-1","article-title":"A Flexible Multibody Model of a Safety Robot Arm for Experimental Validation and Analysis of Design Parameters","volume":"9","year":"2013","journal-title":"J. Comput. Nonlinear Dyn."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"241","DOI":"10.1016\/j.piutam.2011.04.023","article-title":"Simbody: Multibody dynamics for biomedical research","volume":"2","author":"Sherman","year":"2011","journal-title":"Procedia IUTAM"},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"247","DOI":"10.1007\/s11044-013-9363-x","article-title":"Solution methods for the double-support indeterminacy in human gait","volume":"30","author":"Cuadrado","year":"2013","journal-title":"Multibody Syst. Dyn."},{"key":"ref_20","doi-asserted-by":"crossref","first-page":"1330","DOI":"10.1109\/34.888718","article-title":"A flexible new technique for camera calibration","volume":"22","author":"Zhang","year":"2000","journal-title":"IEEE Trans. Pattern Anal. Mach. Intell."},{"key":"ref_21","unstructured":"Palomba, I., Richiedei, D., and Trevisani, A. (2015, January 25\u201327). Simultaneous estimation of kinematic state and unknown input forces in rigid-link multibody systems. Proceedings of the ECCOMAS Thematic Conference on Multibody Dynamics, Lisbon, Portugal."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"18813","DOI":"10.3390\/s150818813","article-title":"Upper Limb Kinematics Using Inertial and Magnetic Sensors: Comparison of Sensor-to-Segment Calibrations","volume":"15","author":"Bouvier","year":"2015","journal-title":"Sensors"},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"6891","DOI":"10.3390\/s140406891","article-title":"IMU-Based Joint Angle Measurement for Gait Analysis","volume":"14","author":"Seel","year":"2014","journal-title":"Sensors"},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Young, A. (2009, January 3\u20135). Comparison of Orientation Filter Algorithms for Realtime Wireless Inertial Posture Tracking. Proceedings of the 2009 Sixth International Workshop on Wearable and Implantable Body Sensor Networks, Berkeley, CA, USA.","DOI":"10.1109\/BSN.2009.25"},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"2678","DOI":"10.1016\/j.jbiomech.2009.08.004","article-title":"Inertial sensor-based knee flexion\/extension angle estimation","volume":"42","author":"Cooper","year":"2009","journal-title":"J. Biomech."},{"key":"ref_26","doi-asserted-by":"crossref","unstructured":"Wittmann, R., Hildebrandt, A.C., Wahrmann, D., Rixen, D., and Buschmann, T. (October, January 28). State Estimation for Biped Robots Using Multibody Dynamics. Proceedings of the 2015 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Hamburg, Germany.","DOI":"10.1109\/IROS.2015.7353667"},{"key":"ref_27","doi-asserted-by":"crossref","first-page":"83","DOI":"10.1016\/j.ijnonlinmec.2013.01.016","article-title":"State estimation using multibody models and non-linear Kalman filters","volume":"53","author":"Pastorino","year":"2013","journal-title":"Int. J. Non-Linear Mech."},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"397","DOI":"10.1016\/0094-114X(82)90032-5","article-title":"Dynamic analysis of plane mechanisms with lower pairs in basic coordinates","volume":"17","author":"Serna","year":"1982","journal-title":"Mech. Mach. Theory"},{"key":"ref_29","unstructured":"Wheeler, J.A., and Taylor, E.F. (1966). Spacetime Physics, WH Freeman."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1115\/1.4011678","article-title":"Velocity and acceleration analysis of plane and space mechanisms by independent-position equations","volume":"80","author":"Raven","year":"1958","journal-title":"J. Appl. Mech. Trans. ASME"},{"key":"ref_31","unstructured":"Sanjurjo, E., Blanco, J.L., Torres, J.L., and Naya, M.\u00c1. (2015, January 25\u201327). Testing the efficiency and accuracy of multibody-based state observers. Proceedings of the ECCOMAS Thematic Conference on Multibody Dynamics, Lisbon, Portugal."},{"key":"ref_32","unstructured":"Wan, E., and van Der Merwe, R. (2000, January 1\u20134). The unscented Kalman filter for nonlinear estimation. Proceedings of the IEEE Adaptive Systems for Signal Processing, Communications, and Control Symposium, Lake Louise, AB, Canada."},{"key":"ref_33","unstructured":"MAPIR Lab (University of M\u00e1laga), ARM Group (University of Almer\u00eda) Open Mobile Robot Arquitecture (OpenMORA). Available online: http:\/\/sourceforge.net\/projects\/openmora."},{"key":"ref_34","unstructured":"Gonzalez-Monroy, J., Blanco, J.L., and Gonz\u00e1lez-Jim\u00e9nez, J. (2013, January 2\u20135). An Open Source Framework for Simulating Mobile Robotics Olfaction. Proceedings of the 15th International Symposium on Olfaction and Electronic Nose (ISOEN) ISOCS (International Society for Olfaction and Chemical Sensing), Daegu, Korea."},{"key":"ref_35","doi-asserted-by":"crossref","unstructured":"Torres-Moreno, J.L., Blanco, J.L., Bellone, M., Rodriguez, F., Gim\u00e9nez-Fern\u00e1ndez, A., and Reina, G. (2014, January 20\u201323). A proposed software framework aimed at energy-efficient autonomous driving of electric vehicles. Proceedings of the International Conference on Simulation, Modelling, and Programming for Autonomous Robots (SIMPAR 2014), Bergamo, Italy.","DOI":"10.1007\/978-3-319-11900-7_19"}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/16\/3\/333\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T19:20:11Z","timestamp":1760210411000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/16\/3\/333"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2016,3,4]]},"references-count":35,"journal-issue":{"issue":"3","published-online":{"date-parts":[[2016,3]]}},"alternative-id":["s16030333"],"URL":"https:\/\/doi.org\/10.3390\/s16030333","relation":{},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2016,3,4]]}}}