
-
Previous Article
Atmospheric Ekman flows with uniform density in ellipsoidal coordinates: Explicit solution and dynamical properties
- JGM Home
- This Issue
-
Next Article
Infinite lifting of an action of symplectomorphism group on the set of bi-Lagrangian structures
Online First articles are published articles within a journal that have not yet been assigned to a formal issue. This means they do not yet have a volume number, issue number, or page numbers assigned to them, however, they can still be found and cited using their DOI (Digital Object Identifier). Online First publication benefits the research community by making new scientific discoveries known as quickly as possible.
Readers can access Online First articles via the “Online First” tab for the selected journal.
Efficient geometric linearization of moving-base rigid robot dynamics
1. | Smart Robotics, De Maas 8, 5684 PL Best, the Netherlands |
2. | Artificial Mechanical Intelligence research line, Istituto Italiano di Tecnologia, Via S. Quirico 19D, 16163 Genoa, Italy |
3. | Department of Mechanical Engineering, Eindhoven University of Technology, Groene Loper 3, PO Box 513, 5600 MB Eindhoven, the Netherlands |
The linearization of the equations of motion of a robotics system about a given state-input trajectory, including a controlled equilibrium state, is a valuable tool for model-based planning, closed-loop control, gain tuning, and state estimation. Contrary to the case of fixed based manipulators with prismatic or revolute joints, the state space of moving-base robotic systems such as humanoids, quadruped robots, or aerial manipulators cannot be globally parametrized by a finite number of independent coordinates. This impossibility is a direct consequence of the fact that the state of these systems includes the system's global orientation, formally described as an element of the special orthogonal group SO(3). As a consequence, obtaining the linearization of the equations of motion for these systems is typically resolved, from a practical perspective, by locally parameterizing the system's attitude by means of, e.g., Euler or Cardan angles. This has the drawback, however, of introducing artificial parameterization singularities and extra derivative computations. In this contribution, we show that it is actually possible to define a notion of linearization that does not require the use of a local parameterization for the system's orientation, obtaining a mathematically elegant, recursive, and singularity-free linearization for moving-based robot systems. Recursiveness, in particular, is obtained by proposing a nontrivial modification of existing recursive algorithms to allow for computations of the geometric derivatives of the inverse dynamics and the inverse of the mass matrix of the robotic system. The correctness of the proposed algorithm is validated by means of a numerical comparison with the result obtained via geometric finite difference.
References:
[1] |
K. S. Anderson and Y. Hsu,
Analytical fully-recursive sensitivity analysis for multibody dynamic chain systems, Multibody Syst. Dyn., 8 (2002), 1-27.
doi: 10.1023/A:1015867515213. |
[2] |
M. H. Ang and V. D. Tourassis,
Singularities of Euler and roll-pitch-yaw representations, IEEE Transactions on Aerospace and Electronic Systems, 23 (1987), 317-324.
doi: 10.1109/TAES.1987.310828. |
[3] |
K. Ayusawa, G. Venture and Y. Nakamura, Identification of humanoid robots dynamics using floating-base motion dynamics, IEEE/RSJ International Conference on Intelligent Robots and Systems, (2008), 2854–2859.
doi: 10.1109/IROS.2008.4650614. |
[4] |
A. Barrau and S. Bonnabel,
Intrinsic filtering on lie groups with applications to attitude estimation, IEEE Trans. Automat. Control, 60 (2015), 436-449.
doi: 10.1109/TAC.2014.2342911. |
[5] |
M. P. Bos, Efficient geometric sensitivity analysis of moving-base multibody dynamics, Master's Thesis, Eindhoven University of Technology, 2019. |
[6] |
O. Brüls and P. Eberhard,
Sensitivity analysis for dynamic mechanical systems with finite rotations, Int. J. Numer. Methods Eng., 74 (2008), 1897-1927.
doi: 10.1002/nme.2232. |
[7] |
J. Carpentier, Analytical inverse of the joint space inertia matrix, Available Online at Hal. Laas. Fr, 2018. |
[8] |
J. Carpentier and N. Mansard, Analytical derivatives of rigid body dynamics algorithms, Robotics: Science and Systems (RSS), 2018.
doi: 10.15607/RSS.2018.XIV.038. |
[9] |
J. Deray and J. Solà,
Manif: A micro lie theory library for state estimation in robotics applications, J. Open Source Software, 5 (2020), 1371.
doi: 10.21105/joss.01371. |
[10] |
J. Diebel,
Representing attitude: Euler angles, unit quaternions, and rotation vectors, Matrix, 58 (2006), 1-35.
|
[11] |
Q. Docquier, O. Brüls and P. Fisette,
Comparison and analysis of multibody dynamics formalisms for solving optimal control problem, IUTAM Symposium on Intelligent Multibody Systems - Dynamics, Control, Simulation, 33 (2019), 55-77.
doi: 10.1007/978-3-030-00527-6_3. |
[12] |
T. Fan and T. Murphey, Structured linearization of discrete mechanical systems on lie groups: A synthesis of analysis and control, In 2015 54th IEEE Conference on Decision and Control (CDC), (2015), 1092–1099.
doi: 10.1109/CDC.2015.7402357. |
[13] |
F. Farshidian, E. Jelavic, A. Satapathy, M. Giftthaler and J. Buchli, Real-time motion planning of legged robots: A model predictive control approach, IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids), (2017), 577–584.
doi: 10.1109/HUMANOIDS.2017.8246930. |
[14] |
R. Featherstone, Rigid Body Dynamics Algorithms, Springer, 2008. |
[15] |
P. J. From, V. Duindam, K. Y. Pettersen, J. T. Gravdahl and S. Sastry,
Singularity-free dynamic equations of vehicle–manipulator systems, Simulation Modelling Practice and Theory, 18 (2010), 712-731.
|
[16] |
G. Garofalo, C. Ott and A. Albu-Schäffer, On the closed form computation of the dynamic matrices and their differentiations, IEEE/RSJ International Conference on Intelligent Robots and Systems, (2013), 2364–2359.
doi: 10.1109/IROS.2013.6696688. |
[17] |
P. Geoffroy, N. Mansard, M. Raison, S. Achiche and E. Todorov, From inverse kinematics to optimal control, In Advances in Robot Kinematics, Springer, Cham, (2014), 409–418. |
[18] |
M. Giftthaler, M. Neunert, M. Stäuble, M. Frigerio, C. Semini and J. Buchli,
Automatic differentiation of rigid body dynamics for optimal control and estimation, Advanced Robotics, 31 (2017), 1225-1237.
doi: 10.1080/01691864.2017.1395361. |
[19] | |
[20] |
A. Kheddar, S. Caron, P. Gergondet, A. Comport, A. Tanguy, C. Ott, B. Henze, G. Mesesan, J. Englsberger, M. A. Roa, P. Wieber, F. Chaumette, F. Spindler, G. Oriolo, L. Lanari, A. Escande, K. Chappellet, F. Kanehiro and P. Rabaté,
Humanoid robots in aircraft manufacturing: The airbus use cases., IEEE Robotics Automation Magazine, 26 (2019), 30-45.
|
[21] |
J. Koenemann, A. Del Prete, Y. Tassa, E. Todorov, O. Stasse, M. Bennewitz and N. Mansard, Whole-body model-predictive control applied to the HRP-2 humanoid, IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), (2015), 3346–3351.
doi: 10.1109/IROS.2015.7353843. |
[22] |
J. M. Lee,
Smooth manifolds, Introduction to Smooth Manifolds, 218 (2013), 1-31.
doi: 10.1007/978-1-4419-9982-5_1. |
[23] |
T. Lee, M. Leok and N. H. McClamroch,
Computational geometric optimal control of rigid bodies, Commun. Inf. Syst., 8 (2008), 445-472.
doi: 10.4310/CIS.2008.v8.n4.a5. |
[24] |
T. Lee, M. Leok and N. H. McClamroch, Global Formulations of Lagrangian and Hamiltonian Dynamics on Embedded Manifolds, Springer, 2017.
doi: 10.1007/978-3-319-56953-6. |
[25] |
M. Leok, An overview of lie group variational integrators and their applications to optimal control, In International Conference on Scientific Computation and Differential Equations, The French National Institute for Research in Computer Science and Control, (2007), 1 pp. |
[26] |
J. Y. S. Luh, M. W. Walker and R. P. C. Paul,
On-line computational scheme for mechanical manipulators, J. Dynam. Systems Measurement Control, 102 (1980), 69-76.
doi: 10.1115/1.3149599. |
[27] |
A. Marco, P. Hennig, J. Bohg, S. Schaal and S. Trimpe, Automatic LQR tuning based on Gaussian process global optimization, IEEE International Conference on Robotics and Automation (ICRA), 2016.
doi: 10.1109/ICRA.2016.7487144. |
[28] |
S. Mason, L. Righetti and S. Schaal, Full dynamics LQR control of a humanoid robot: An experimental study on balancing and squatting, IEEE-RAS International Conference on Humanoid Robots, (2014), 374–379.
doi: 10.1109/HUMANOIDS.2014.7041387. |
[29] |
R. M. Murray, A Mathematical Introduction to Robotic Manipulation, CRC press, 2017.
![]() |
[30] |
D. Negrut and J. Ortiz,
A practical approach for the linearization of the constrained multibody dynamics equations, J. Comput. Nonlinear Dynam., 1 (2006), 230-239.
doi: 10.1115/1.2198876. |
[31] |
M. Neunert, M. Giftthaler, M. Frigerio, C. Semini and J. Buchli, Fast derivatives of rigid body dynamics for control, optimization and estimation, IEEE International Conference on Simulation, Modeling, and Programming for Autonomous Robots (SIMPAR), (2016), 91–97.
doi: 10.1109/SIMPAR.2016.7862380. |
[32] |
F. C. Park, B. Kim, C. Jang and J. Hong,
Geometric algorithms for robot dynamics: A tutorial review, Appl. Mech. Rev., 70 (2018), 010803.
doi: 10.1115/1.4039078. |
[33] |
M. Posa, C. Cantu and R. Tedrake,
A direct method for trajectory optimization of rigid bodies through contact, The International Journal of Robotics Research, 33 (2014), 69-81.
doi: 10.1177/0278364913506757. |
[34] |
D. Pucci, G. Nava and F. Nori, Automatic gain tuning of a momentum based balancing controller for humanoid robots, In 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids), IEEE, (2016), 158–164.
doi: 10.1109/HUMANOIDS.2016.7803272. |
[35] |
D. Pucci, S. Traversaro and F. Nori,
Momentum control of an underactuated flying humanoid robot, IEEE Robotics and Automation Letters, 3 (2018), 195-202.
doi: 10.1109/LRA.2017.2734245. |
[36] |
W. Rossmann, Lie Groups: An Introduction Through Linear Groups, volume 5., Oxford University Press, 2002.
![]() ![]() |
[37] |
A. Saccon, A. P. Aguiar and J. Hauser, Lie group projection operator approach: Optimal control on T SO (3), IEEE Decision and Control and European Control Conference (CDC-ECC), (2011), 6973–6978. |
[38] |
A. Saccon, J. Hauser and A. P. Aguiar, Optimal control on non-compact lie groups: A projection operator approach, In 49th IEEE Conference on Decision and Control (CDC), (2010), 7111–7116 |
[39] |
A. Saccon, J. Hauser and A. P. Aguiar,
Optimal control on Lie groups: The projection operator approach, IEEE Trans. Automat. Control, 58 (2013), 2230-2245.
doi: 10.1109/TAC.2013.2258817. |
[40] |
A. Saccon, J. Hauser and A. Beghi,
Trajectory exploration of a rigid motorcycle model, IEEE Transactions on Control Systems Technology, 20 (2012), 424-437.
doi: 10.1109/TCST.2011.2116788. |
[41] |
A. Saccon, S. Traversaro, F. Nori and H. Nijmeijer,
On centroidal dynamics and integrability of average angular velocity, IEEE Robotics and Automation Letter, 2 (2017), 943-950.
doi: 10.1109/LRA.2017.2655560. |
[42] |
A. K. Sanyal, T. Lee, M. Leok and N. H. McClamroch,
Global optimal attitude estimation using uncertainty ellipsoids, Systems Control Lett., 57 (2008), 236-245.
doi: 10.1016/j.sysconle.2007.08.014. |
[43] |
G. A. Sohl and J. E. Bobrow,
A recursive multibody dynamics and sensitivity algorithm for branched kinematic chains, J. Dynamic Systems, Measurement, and Control, 123 (2001), 391-399.
|
[44] |
J. Solà, J. Deray and D. Atchuthan, A micro Lie theory for state estimation in robotics, arXiv preprint, arXiv: 1812.01537, 2018. |
[45] |
V. Sonneville and O. Brüls,
Sensitivity analysis for multibody systems formulated on a Lie group, Multibody Syst. Dyn., 31 (2014), 47-67.
doi: 10.1007/s11044-013-9345-z. |
[46] |
Y. Tassa, T. Erez and E. Todorov, Synthesis and stabilization of complex behaviors through online trajectory optimization, IEEE/RSJ International Conference on Intelligent Robots and Systems, (2012), 4906–4913.
doi: 10.1109/IROS.2012.6386025. |
[47] |
S. Traversaro and A. Saccon, Multibody dynamics notation, revision 2, Available Online at Tue. Research. Nl, 2019. |
[48] |
V. S. Varadarajan, Lie Groups, Lie Algebras, and Their Representations, Reprint of the 1974 edition. Graduate Texts in Mathematics, 102. Springer-Verlag, New York, 1984.
doi: 10.1007/978-1-4612-1126-6. |
[49] |
M. W. Walker and D. E. Orin,
Efficient dynamic computer simulation of robotic mechanisms, J. Dyn. Sys., Meas., Control., 104 (1982), 205-211.
doi: 10.1115/1.3139699. |
show all references
References:
[1] |
K. S. Anderson and Y. Hsu,
Analytical fully-recursive sensitivity analysis for multibody dynamic chain systems, Multibody Syst. Dyn., 8 (2002), 1-27.
doi: 10.1023/A:1015867515213. |
[2] |
M. H. Ang and V. D. Tourassis,
Singularities of Euler and roll-pitch-yaw representations, IEEE Transactions on Aerospace and Electronic Systems, 23 (1987), 317-324.
doi: 10.1109/TAES.1987.310828. |
[3] |
K. Ayusawa, G. Venture and Y. Nakamura, Identification of humanoid robots dynamics using floating-base motion dynamics, IEEE/RSJ International Conference on Intelligent Robots and Systems, (2008), 2854–2859.
doi: 10.1109/IROS.2008.4650614. |
[4] |
A. Barrau and S. Bonnabel,
Intrinsic filtering on lie groups with applications to attitude estimation, IEEE Trans. Automat. Control, 60 (2015), 436-449.
doi: 10.1109/TAC.2014.2342911. |
[5] |
M. P. Bos, Efficient geometric sensitivity analysis of moving-base multibody dynamics, Master's Thesis, Eindhoven University of Technology, 2019. |
[6] |
O. Brüls and P. Eberhard,
Sensitivity analysis for dynamic mechanical systems with finite rotations, Int. J. Numer. Methods Eng., 74 (2008), 1897-1927.
doi: 10.1002/nme.2232. |
[7] |
J. Carpentier, Analytical inverse of the joint space inertia matrix, Available Online at Hal. Laas. Fr, 2018. |
[8] |
J. Carpentier and N. Mansard, Analytical derivatives of rigid body dynamics algorithms, Robotics: Science and Systems (RSS), 2018.
doi: 10.15607/RSS.2018.XIV.038. |
[9] |
J. Deray and J. Solà,
Manif: A micro lie theory library for state estimation in robotics applications, J. Open Source Software, 5 (2020), 1371.
doi: 10.21105/joss.01371. |
[10] |
J. Diebel,
Representing attitude: Euler angles, unit quaternions, and rotation vectors, Matrix, 58 (2006), 1-35.
|
[11] |
Q. Docquier, O. Brüls and P. Fisette,
Comparison and analysis of multibody dynamics formalisms for solving optimal control problem, IUTAM Symposium on Intelligent Multibody Systems - Dynamics, Control, Simulation, 33 (2019), 55-77.
doi: 10.1007/978-3-030-00527-6_3. |
[12] |
T. Fan and T. Murphey, Structured linearization of discrete mechanical systems on lie groups: A synthesis of analysis and control, In 2015 54th IEEE Conference on Decision and Control (CDC), (2015), 1092–1099.
doi: 10.1109/CDC.2015.7402357. |
[13] |
F. Farshidian, E. Jelavic, A. Satapathy, M. Giftthaler and J. Buchli, Real-time motion planning of legged robots: A model predictive control approach, IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids), (2017), 577–584.
doi: 10.1109/HUMANOIDS.2017.8246930. |
[14] |
R. Featherstone, Rigid Body Dynamics Algorithms, Springer, 2008. |
[15] |
P. J. From, V. Duindam, K. Y. Pettersen, J. T. Gravdahl and S. Sastry,
Singularity-free dynamic equations of vehicle–manipulator systems, Simulation Modelling Practice and Theory, 18 (2010), 712-731.
|
[16] |
G. Garofalo, C. Ott and A. Albu-Schäffer, On the closed form computation of the dynamic matrices and their differentiations, IEEE/RSJ International Conference on Intelligent Robots and Systems, (2013), 2364–2359.
doi: 10.1109/IROS.2013.6696688. |
[17] |
P. Geoffroy, N. Mansard, M. Raison, S. Achiche and E. Todorov, From inverse kinematics to optimal control, In Advances in Robot Kinematics, Springer, Cham, (2014), 409–418. |
[18] |
M. Giftthaler, M. Neunert, M. Stäuble, M. Frigerio, C. Semini and J. Buchli,
Automatic differentiation of rigid body dynamics for optimal control and estimation, Advanced Robotics, 31 (2017), 1225-1237.
doi: 10.1080/01691864.2017.1395361. |
[19] | |
[20] |
A. Kheddar, S. Caron, P. Gergondet, A. Comport, A. Tanguy, C. Ott, B. Henze, G. Mesesan, J. Englsberger, M. A. Roa, P. Wieber, F. Chaumette, F. Spindler, G. Oriolo, L. Lanari, A. Escande, K. Chappellet, F. Kanehiro and P. Rabaté,
Humanoid robots in aircraft manufacturing: The airbus use cases., IEEE Robotics Automation Magazine, 26 (2019), 30-45.
|
[21] |
J. Koenemann, A. Del Prete, Y. Tassa, E. Todorov, O. Stasse, M. Bennewitz and N. Mansard, Whole-body model-predictive control applied to the HRP-2 humanoid, IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), (2015), 3346–3351.
doi: 10.1109/IROS.2015.7353843. |
[22] |
J. M. Lee,
Smooth manifolds, Introduction to Smooth Manifolds, 218 (2013), 1-31.
doi: 10.1007/978-1-4419-9982-5_1. |
[23] |
T. Lee, M. Leok and N. H. McClamroch,
Computational geometric optimal control of rigid bodies, Commun. Inf. Syst., 8 (2008), 445-472.
doi: 10.4310/CIS.2008.v8.n4.a5. |
[24] |
T. Lee, M. Leok and N. H. McClamroch, Global Formulations of Lagrangian and Hamiltonian Dynamics on Embedded Manifolds, Springer, 2017.
doi: 10.1007/978-3-319-56953-6. |
[25] |
M. Leok, An overview of lie group variational integrators and their applications to optimal control, In International Conference on Scientific Computation and Differential Equations, The French National Institute for Research in Computer Science and Control, (2007), 1 pp. |
[26] |
J. Y. S. Luh, M. W. Walker and R. P. C. Paul,
On-line computational scheme for mechanical manipulators, J. Dynam. Systems Measurement Control, 102 (1980), 69-76.
doi: 10.1115/1.3149599. |
[27] |
A. Marco, P. Hennig, J. Bohg, S. Schaal and S. Trimpe, Automatic LQR tuning based on Gaussian process global optimization, IEEE International Conference on Robotics and Automation (ICRA), 2016.
doi: 10.1109/ICRA.2016.7487144. |
[28] |
S. Mason, L. Righetti and S. Schaal, Full dynamics LQR control of a humanoid robot: An experimental study on balancing and squatting, IEEE-RAS International Conference on Humanoid Robots, (2014), 374–379.
doi: 10.1109/HUMANOIDS.2014.7041387. |
[29] |
R. M. Murray, A Mathematical Introduction to Robotic Manipulation, CRC press, 2017.
![]() |
[30] |
D. Negrut and J. Ortiz,
A practical approach for the linearization of the constrained multibody dynamics equations, J. Comput. Nonlinear Dynam., 1 (2006), 230-239.
doi: 10.1115/1.2198876. |
[31] |
M. Neunert, M. Giftthaler, M. Frigerio, C. Semini and J. Buchli, Fast derivatives of rigid body dynamics for control, optimization and estimation, IEEE International Conference on Simulation, Modeling, and Programming for Autonomous Robots (SIMPAR), (2016), 91–97.
doi: 10.1109/SIMPAR.2016.7862380. |
[32] |
F. C. Park, B. Kim, C. Jang and J. Hong,
Geometric algorithms for robot dynamics: A tutorial review, Appl. Mech. Rev., 70 (2018), 010803.
doi: 10.1115/1.4039078. |
[33] |
M. Posa, C. Cantu and R. Tedrake,
A direct method for trajectory optimization of rigid bodies through contact, The International Journal of Robotics Research, 33 (2014), 69-81.
doi: 10.1177/0278364913506757. |
[34] |
D. Pucci, G. Nava and F. Nori, Automatic gain tuning of a momentum based balancing controller for humanoid robots, In 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids), IEEE, (2016), 158–164.
doi: 10.1109/HUMANOIDS.2016.7803272. |
[35] |
D. Pucci, S. Traversaro and F. Nori,
Momentum control of an underactuated flying humanoid robot, IEEE Robotics and Automation Letters, 3 (2018), 195-202.
doi: 10.1109/LRA.2017.2734245. |
[36] |
W. Rossmann, Lie Groups: An Introduction Through Linear Groups, volume 5., Oxford University Press, 2002.
![]() ![]() |
[37] |
A. Saccon, A. P. Aguiar and J. Hauser, Lie group projection operator approach: Optimal control on T SO (3), IEEE Decision and Control and European Control Conference (CDC-ECC), (2011), 6973–6978. |
[38] |
A. Saccon, J. Hauser and A. P. Aguiar, Optimal control on non-compact lie groups: A projection operator approach, In 49th IEEE Conference on Decision and Control (CDC), (2010), 7111–7116 |
[39] |
A. Saccon, J. Hauser and A. P. Aguiar,
Optimal control on Lie groups: The projection operator approach, IEEE Trans. Automat. Control, 58 (2013), 2230-2245.
doi: 10.1109/TAC.2013.2258817. |
[40] |
A. Saccon, J. Hauser and A. Beghi,
Trajectory exploration of a rigid motorcycle model, IEEE Transactions on Control Systems Technology, 20 (2012), 424-437.
doi: 10.1109/TCST.2011.2116788. |
[41] |
A. Saccon, S. Traversaro, F. Nori and H. Nijmeijer,
On centroidal dynamics and integrability of average angular velocity, IEEE Robotics and Automation Letter, 2 (2017), 943-950.
doi: 10.1109/LRA.2017.2655560. |
[42] |
A. K. Sanyal, T. Lee, M. Leok and N. H. McClamroch,
Global optimal attitude estimation using uncertainty ellipsoids, Systems Control Lett., 57 (2008), 236-245.
doi: 10.1016/j.sysconle.2007.08.014. |
[43] |
G. A. Sohl and J. E. Bobrow,
A recursive multibody dynamics and sensitivity algorithm for branched kinematic chains, J. Dynamic Systems, Measurement, and Control, 123 (2001), 391-399.
|
[44] |
J. Solà, J. Deray and D. Atchuthan, A micro Lie theory for state estimation in robotics, arXiv preprint, arXiv: 1812.01537, 2018. |
[45] |
V. Sonneville and O. Brüls,
Sensitivity analysis for multibody systems formulated on a Lie group, Multibody Syst. Dyn., 31 (2014), 47-67.
doi: 10.1007/s11044-013-9345-z. |
[46] |
Y. Tassa, T. Erez and E. Todorov, Synthesis and stabilization of complex behaviors through online trajectory optimization, IEEE/RSJ International Conference on Intelligent Robots and Systems, (2012), 4906–4913.
doi: 10.1109/IROS.2012.6386025. |
[47] |
S. Traversaro and A. Saccon, Multibody dynamics notation, revision 2, Available Online at Tue. Research. Nl, 2019. |
[48] |
V. S. Varadarajan, Lie Groups, Lie Algebras, and Their Representations, Reprint of the 1974 edition. Graduate Texts in Mathematics, 102. Springer-Verlag, New York, 1984.
doi: 10.1007/978-1-4612-1126-6. |
[49] |
M. W. Walker and D. E. Orin,
Efficient dynamic computer simulation of robotic mechanisms, J. Dyn. Sys., Meas., Control., 104 (1982), 205-211.
doi: 10.1115/1.3139699. |





Approach | SF | MB | RF | ED |
Geometric linearization [42,4,39,37,12,25,23,44] | √ | √ | ||
Sensitivity for multibody systems on Lie groups [45,11] | √ | √ | √ | |
Recursive algorithms [14,26,49] | √ | √ | √ | |
Finite differences [46,28] | √ | √ | ||
Lagrangian derivation [16] | √ | √ | ||
Automatic differentiation [18,31] | √ | √ | √ | |
Analytical derivation [8,43,32] | √ | √ | √ | |
This manuscript | √ | √ | √ | √ |
Approach | SF | MB | RF | ED |
Geometric linearization [42,4,39,37,12,25,23,44] | √ | √ | ||
Sensitivity for multibody systems on Lie groups [45,11] | √ | √ | √ | |
Recursive algorithms [14,26,49] | √ | √ | √ | |
Finite differences [46,28] | √ | √ | ||
Lagrangian derivation [16] | √ | √ | ||
Automatic differentiation [18,31] | √ | √ | √ | |
Analytical derivation [8,43,32] | √ | √ | √ | |
This manuscript | √ | √ | √ | √ |
EG | Dimension | Explanation |
Transformation matrix of frame |
||
Rotation matrix of frame |
||
Origin of frame |
||
Twist of frame |
||
Intrinsic [47,Section 5.1] acceleration of frame |
||
Wrench w.r.t. frame |
||
Velocity transformation of frame |
||
Wrench transformation of frame |
||
Generalized position vector or system shape | ||
Generalized velocity vector | ||
Joint torques or generalized forces vector | ||
6D twist cross product on |
||
6D twist/wrench cross product on |
EG | Dimension | Explanation |
Transformation matrix of frame |
||
Rotation matrix of frame |
||
Origin of frame |
||
Twist of frame |
||
Intrinsic [47,Section 5.1] acceleration of frame |
||
Wrench w.r.t. frame |
||
Velocity transformation of frame |
||
Wrench transformation of frame |
||
Generalized position vector or system shape | ||
Generalized velocity vector | ||
Joint torques or generalized forces vector | ||
6D twist cross product on |
||
6D twist/wrench cross product on |
EG | Dim. | Explanation |
Inertia matrix of body |
||
Articulated-body inertia matrix of body |
||
Apparent articulated-body inertia matrix of body |
||
Composite rigid body inertia matrix of body |
||
Twist or spatial velocity of frame |
||
Apparent acceleration of frame |
||
Intrinsic acceleration of frame |
||
Intrinsic gravitational acceleration | ||
Intrinsic acceleration relative to the moving-base acceleration, plus the gravitational acceleration of body |
||
Intrinsic acceleration that only accounts for the velocity product terms of body |
||
Spatial momentum of body |
||
Joint velocity subspace matrix of joint |
||
Velocity of joint |
||
Bias wrench acting on body |
||
Composite rigid body bias wrench acting on body |
||
Bias wrench of the moving-base with zero joint acceleration | ||
Velocity transformation from frame |
||
Wrench transformation from frame |
||
Subexpression used in ABA | ||
Subexpression used in ABA | ||
Subexpression used in ABA | ||
Required wrench to support unit acceleration of joint |
||
Wrench set collecting the contributions of the supporting tree rooted at |
||
Motion set which contains the contributions of all parents of joint |
EG | Dim. | Explanation |
Inertia matrix of body |
||
Articulated-body inertia matrix of body |
||
Apparent articulated-body inertia matrix of body |
||
Composite rigid body inertia matrix of body |
||
Twist or spatial velocity of frame |
||
Apparent acceleration of frame |
||
Intrinsic acceleration of frame |
||
Intrinsic gravitational acceleration | ||
Intrinsic acceleration relative to the moving-base acceleration, plus the gravitational acceleration of body |
||
Intrinsic acceleration that only accounts for the velocity product terms of body |
||
Spatial momentum of body |
||
Joint velocity subspace matrix of joint |
||
Velocity of joint |
||
Bias wrench acting on body |
||
Composite rigid body bias wrench acting on body |
||
Bias wrench of the moving-base with zero joint acceleration | ||
Velocity transformation from frame |
||
Wrench transformation from frame |
||
Subexpression used in ABA | ||
Subexpression used in ABA | ||
Subexpression used in ABA | ||
Required wrench to support unit acceleration of joint |
||
Wrench set collecting the contributions of the supporting tree rooted at |
||
Motion set which contains the contributions of all parents of joint |
Inputs: model, |
|
Line | EIDAmb |
1 | |
2 | |
3 | |
4 | |
5 | |
6 | |
7* | |
8 | |
9 | |
10 | |
11* | |
12 | |
13 | |
14 | |
15 | |
16 | |
17 | |
18* | |
19 | |
20 | |
21 | |
22* | |
23 | |
24 | |
25 | |
26 | |
27* | |
28 | |
29 | |
30 | |
31 | |
32** | |
33** | |
34** | |
35** | |
36** | |
37** | |
38** | |
39 | |
40*** | |
Output: |
Inputs: model, |
|
Line | EIDAmb |
1 | |
2 | |
3 | |
4 | |
5 | |
6 | |
7* | |
8 | |
9 | |
10 | |
11* | |
12 | |
13 | |
14 | |
15 | |
16 | |
17 | |
18* | |
19 | |
20 | |
21 | |
22* | |
23 | |
24 | |
25 | |
26 | |
27* | |
28 | |
29 | |
30 | |
31 | |
32** | |
33** | |
34** | |
35** | |
36** | |
37** | |
38** | |
39 | |
40*** | |
Output: |
Inputs: All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 5 | |
2 | 6 | |
3 | 9 | |
4 | 10 | |
5 | 12 | |
6 | 16 | |
7 | 17 | |
8 | 20 | |
9 | 21 | |
10 | 23 | |
11 | 25 | |
12 | 26 | |
13 | 28 | |
14 | 29 | |
15 | 31 | |
16 | 39 | |
17 | 40 | |
Outputs: |
Inputs: All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 5 | |
2 | 6 | |
3 | 9 | |
4 | 10 | |
5 | 12 | |
6 | 16 | |
7 | 17 | |
8 | 20 | |
9 | 21 | |
10 | 23 | |
11 | 25 | |
12 | 26 | |
13 | 28 | |
14 | 29 | |
15 | 31 | |
16 | 39 | |
17 | 40 | |
Outputs: |
Inputs:All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 12 | |
2 | 13 | |
3 | 15 | |
4 | 16 | |
5 | 16 | |
6 | 17 | |
7 | 17 | |
8 | 18 | |
9 | 18 | |
10 | 20 | |
11 | 21 | |
12 | 22 | |
13 | 23 | |
14 | |
24 |
15 | |
25 |
16 | |
25 |
17 | |
25 |
18 | |
25 |
19 | |
26 |
20 | |
26 |
21 | |
27 |
22 | |
27 |
23 | |
28 |
24 | |
- |
25 | |
- |
26 | |
- |
27 | |
29 |
28 | |
30 |
29 | |
30 |
30 | |
- |
31 | |
- |
32 | |
32 |
33 | |
- |
34 | |
32 |
35 | |
33 |
36 | |
34 |
37 | |
35 |
38 | |
35 |
39 | |
35 |
40 | |
35 |
41 | |
36 |
42 | |
37 |
43 | |
38 |
44 | |
38 |
45 | |
38 |
46 | |
38 |
47 | |
- |
48 | |
39 |
49 | |
40 |
Outputs: |
Inputs:All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 12 | |
2 | 13 | |
3 | 15 | |
4 | 16 | |
5 | 16 | |
6 | 17 | |
7 | 17 | |
8 | 18 | |
9 | 18 | |
10 | 20 | |
11 | 21 | |
12 | 22 | |
13 | 23 | |
14 | |
24 |
15 | |
25 |
16 | |
25 |
17 | |
25 |
18 | |
25 |
19 | |
26 |
20 | |
26 |
21 | |
27 |
22 | |
27 |
23 | |
28 |
24 | |
- |
25 | |
- |
26 | |
- |
27 | |
29 |
28 | |
30 |
29 | |
30 |
30 | |
- |
31 | |
- |
32 | |
32 |
33 | |
- |
34 | |
32 |
35 | |
33 |
36 | |
34 |
37 | |
35 |
38 | |
35 |
39 | |
35 |
40 | |
35 |
41 | |
36 |
42 | |
37 |
43 | |
38 |
44 | |
38 |
45 | |
38 |
46 | |
38 |
47 | |
- |
48 | |
39 |
49 | |
40 |
Outputs: |
Inputs: All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 5 | |
2 | 9 | |
3 | 10 | |
4 | 12 | |
5 | 16 | |
6 | 17 | |
7 | |
20 |
8 | |
21 |
9 | |
23 |
10 | |
24 |
11 | |
26 |
12 | |
28 |
13 | |
29 |
14 | |
31 |
15 | |
39 |
16 | |
40 |
Outputs: |
Inputs: All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 5 | |
2 | 9 | |
3 | 10 | |
4 | 12 | |
5 | 16 | |
6 | 17 | |
7 | |
20 |
8 | |
21 |
9 | |
23 |
10 | |
24 |
11 | |
26 |
12 | |
28 |
13 | |
29 |
14 | |
31 |
15 | |
39 |
16 | |
40 |
Outputs: |
Inputs: All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 12 | |
2 | 14 | |
3 | 16 | |
4 | 16 | |
5 | 17 | |
6 | 17 | |
7 | |
20 |
8 | |
21 |
9 | |
23 |
10 | |
24 |
11 | |
26 |
12 | |
28 |
13 | |
29 |
14 | |
31 |
15 | |
39 |
16 | |
40 |
Outputs: |
Inputs: All outputs and intermediate variables of EIDAmb | ||
Line | Algorithm | Line in EIDAmb |
1 | 12 | |
2 | 14 | |
3 | 16 | |
4 | 16 | |
5 | 17 | |
6 | 17 | |
7 | |
20 |
8 | |
21 |
9 | |
23 |
10 | |
24 |
11 | |
26 |
12 | |
28 |
13 | |
29 |
14 | |
31 |
15 | |
39 |
16 | |
40 |
Outputs: |
Inputs | model, |
Line | IMMAmb |
1 | |
2 | |
3 | |
4 | |
5 | |
6 | |
7 | |
8 | |
9 | |
10 | |
11 | |
12 | |
13 | |
14 | |
15 | |
16 | |
17 | |
18 | |
19 | |
20 | |
21 | |
22 | |
23 | |
24 | |
25 | |
26 | |
Outputs |
Inputs | model, |
Line | IMMAmb |
1 | |
2 | |
3 | |
4 | |
5 | |
6 | |
7 | |
8 | |
9 | |
10 | |
11 | |
12 | |
13 | |
14 | |
15 | |
16 | |
17 | |
18 | |
19 | |
20 | |
21 | |
22 | |
23 | |
24 | |
25 | |
26 | |
Outputs |
[1] |
Răzvan M. Tudoran, Anania Gîrban. On the Hamiltonian dynamics and geometry of the Rabinovich system. Discrete and Continuous Dynamical Systems - B, 2011, 15 (3) : 789-823. doi: 10.3934/dcdsb.2011.15.789 |
[2] |
Janina Kotus, Mariusz Urbański. The dynamics and geometry of the Fatou functions. Discrete and Continuous Dynamical Systems, 2005, 13 (2) : 291-338. doi: 10.3934/dcds.2005.13.291 |
[3] |
Steven T. Piantadosi. Symbolic dynamics on free groups. Discrete and Continuous Dynamical Systems, 2008, 20 (3) : 725-738. doi: 10.3934/dcds.2008.20.725 |
[4] |
Hua Shi, Xiang Zhang, Yuyan Zhang. Complex planar Hamiltonian systems: Linearization and dynamics. Discrete and Continuous Dynamical Systems, 2021, 41 (7) : 3295-3317. doi: 10.3934/dcds.2020406 |
[5] |
Jan Prüss, Laurent Pujo-Menjouet, G.F. Webb, Rico Zacher. Analysis of a model for the dynamics of prions. Discrete and Continuous Dynamical Systems - B, 2006, 6 (1) : 225-235. doi: 10.3934/dcdsb.2006.6.225 |
[6] |
Laetitia Paoli. A velocity-based time-stepping scheme for multibody dynamics with unilateral constraints. Discrete and Continuous Dynamical Systems - S, 2013, 6 (6) : 1609-1619. doi: 10.3934/dcdss.2013.6.1609 |
[7] |
Qi Wang, Huilian Peng, Fangfang Zhuang. A constraint-stabilized method for multibody dynamics with friction-affected translational joints based on HLCP. Discrete and Continuous Dynamical Systems - B, 2011, 16 (2) : 589-605. doi: 10.3934/dcdsb.2011.16.589 |
[8] |
Michael Hochman. Lectures on dynamics, fractal geometry, and metric number theory. Journal of Modern Dynamics, 2014, 8 (3&4) : 437-497. doi: 10.3934/jmd.2014.8.437 |
[9] |
Janusz Grabowski, Katarzyna Grabowska, Paweł Urbański. Geometry of Lagrangian and Hamiltonian formalisms in the dynamics of strings. Journal of Geometric Mechanics, 2014, 6 (4) : 503-526. doi: 10.3934/jgm.2014.6.503 |
[10] |
Joris Vankerschaver, Eva Kanso, Jerrold E. Marsden. The geometry and dynamics of interacting rigid bodies and point vortices. Journal of Geometric Mechanics, 2009, 1 (2) : 223-266. doi: 10.3934/jgm.2009.1.223 |
[11] |
Xin Zhao, Tao Feng, Liang Wang, Zhipeng Qiu. Threshold dynamics and sensitivity analysis of a stochastic semi-Markov switched SIRS epidemic model with nonlinear incidence and vaccination. Discrete and Continuous Dynamical Systems - B, 2021, 26 (12) : 6131-6154. doi: 10.3934/dcdsb.2021010 |
[12] |
Eugenii Shustin. Dynamics of oscillations in a multi-dimensional delay differential system. Discrete and Continuous Dynamical Systems, 2004, 11 (2&3) : 557-576. doi: 10.3934/dcds.2004.11.557 |
[13] |
Jia-Feng Cao, Wan-Tong Li, Fei-Ying Yang. Dynamics of a nonlocal SIS epidemic model with free boundary. Discrete and Continuous Dynamical Systems - B, 2017, 22 (2) : 247-266. doi: 10.3934/dcdsb.2017013 |
[14] |
Lei Li, Jianping Wang, Mingxin Wang. The dynamics of nonlocal diffusion systems with different free boundaries. Communications on Pure and Applied Analysis, 2020, 19 (7) : 3651-3672. doi: 10.3934/cpaa.2020161 |
[15] |
Lianzhang Bao, Zhengfang Zhou. Traveling wave in backward and forward parabolic equations from population dynamics. Discrete and Continuous Dynamical Systems - B, 2014, 19 (6) : 1507-1522. doi: 10.3934/dcdsb.2014.19.1507 |
[16] |
Xiaoying Han, Peter E. Kloeden. Pullback and forward dynamics of nonautonomous Laplacian lattice systems on weighted spaces. Discrete and Continuous Dynamical Systems - S, 2021 doi: 10.3934/dcdss.2021143 |
[17] |
Claudia Valls. The Boussinesq system:dynamics on the center manifold. Communications on Pure and Applied Analysis, 2005, 4 (4) : 839-860. doi: 10.3934/cpaa.2005.4.839 |
[18] |
Shikun Wang. Dynamics of a chemostat system with two patches. Discrete and Continuous Dynamical Systems - B, 2019, 24 (11) : 6261-6278. doi: 10.3934/dcdsb.2019138 |
[19] |
Jaroslaw Smieja, Marzena Dolbniak. Sensitivity of signaling pathway dynamics to plasmid transfection and its consequences. Mathematical Biosciences & Engineering, 2016, 13 (6) : 1207-1222. doi: 10.3934/mbe.2016039 |
[20] |
Youshan Tao. Global dynamics in a higher-dimensional repulsion chemotaxis model with nonlinear sensitivity. Discrete and Continuous Dynamical Systems - B, 2013, 18 (10) : 2705-2722. doi: 10.3934/dcdsb.2013.18.2705 |
2021 Impact Factor: 0.737
Tools
Metrics
Other articles
by authors
[Back to Top]