Singularity-free time integration of rotational quaternions using non-redundant ordinary differential equations

Springer Science and Business Media LLC - Tập 38 - Trang 201-225 - 2016
Zdravko Terze1, Andreas Müller2, Dario Zlatar1
1Department of Aeronautical Engineering, Faculty of Mechanical Engineering and Naval Architecture, University of Zagreb, Zagreb, Croatia
2Institute of Robotics, Johannes Kepler University, Linz, Austria

Tóm tắt

A novel ODE time stepping scheme for solving rotational kinematics in terms of unit quaternions is presented in the paper. This scheme inherently respects the unit-length condition without including it explicitly as a constraint equation, as it is common practice. In the standard algorithms, the unit-length condition is included as an additional equation leading to kinematical equations in the form of a system of differential-algebraic equations (DAEs). On the contrary, the proposed method is based on numerical integration of the kinematic relations in terms of the instantaneous rotation vector that form a system of ordinary differential equations (ODEs) on the Lie algebra $\mathit{so}(3)$ of the rotation group $\mathit{SO}(3)$ . This rotation vector defines an incremental rotation (and thus the associated incremental unit quaternion), and the rotation update is determined by the exponential mapping on the quaternion group. Since the kinematic ODE on $\mathit{so}(3)$ can be solved by using any standard (possibly higher-order) ODE integration scheme, the proposed method yields a non-redundant integration algorithm for the rotational kinematics in terms of unit quaternions, avoiding integration of DAE equations. Besides being ‘more elegant’—in the opinion of the authors—this integration procedure also exhibits numerical advantages in terms of better accuracy when longer integration steps are applied during simulation. As presented in the paper, the numerical integration of three non-linear ODEs in terms of the rotation vector as canonical coordinates achieves a higher accuracy compared to integrating the four (linear in ODE part) standard-quaternion DAE system. In summary, this paper solves the long-standing problem of the necessity of imposing the unit-length constraint equation during integration of quaternions, i.e. the need to deal with DAE’s in the context of such kinematical model, which has been a major drawback of using quaternions, and a numerical scheme is presented that also allows for longer integration steps during kinematic reconstruction of large three-dimensional rotations.

Tài liệu tham khảo

Betsch, P., Siebert, R.: Rigid body dynamics in terms of quaternions: Hamiltonian formulation and conserving numerical integration. Int. J. Numer. Methods Eng. 79, 444–473 (2009) Nikravesh, P.E.: Spatial kinematic and dynamic analysis with Euler parameters. In: Haug, E.J. (ed.) Computer Aided Analysis and Optimization of Mechanical System Dynamics, pp. 261–281. Springer, Heidelberg (1984) Altmann, S.L.: Rotations, Quaternions, and Double Groups. Oxford University Press, Oxford (1986) Holm, D.D.: Geometric Mechanics. Part II: Rotating, Translating and Rolling. Imperial College Press, London (2008) Barker, L.E., Bowles, R.L., Williams, L.H.: Development and application of a local linearization of quaternion rate equations in real-time flight simulation problems. NASA tech. note, TN D-7347 (1973) Nikravesh, P.E.: Computer-Aided Analysis of Mechanical Systems. Prentice Hall, Englewood Hills (1988) Bauchau, O.A.: Flexible Multibody Dynamics. Springer, Dordrecht (2011) Hamilton, W.R.: Lectures on Quaternions. Hodges and Smith, Dublin (1853) Hamilton, W.R.: Elements of Quaternions, 3rd edn. Chelsea, New York (1969) Tait, P.G.: An Elementary Treatise on Quaternions. MacMillan, London (1867) Kelland, P., Tait, P.G.: Introduction to Quaternions, with Numerous Examples. MacMillan, London (1882) Cayley, A.: On certain results relating to quaternions. In: The Collected Mathematical Papers of Arthur Cayley, vol. 1, pp. 123–126 (1889) Altmann, S.L.: Hamilton, Rodrigues, and the quaternion scandal. Math. Mag. 62, 306 (1989) Vince, J.: Quaternions for Computer Graphics. Springer, London (2011) Robinson, A.C.: On the use of quaternions in simulation of rigid-body motion. Tech. rep., Aeronautical Research Lab., Wright Air Development Center, Dayton, OH, pp. 58–17 (1958) Taylor, R.H.: Planning and execution of straight line manipulator trajectories. IBM J. Res. Dev. 23, 424–436 (1979) Huston, R.L., Kelly, F.A.: The development of equations of motion of single-arm robots. IEEE Trans. Syst. Man Cybern. 12, 259–266 (1982) Meyer, G.: Design and global analysis of spacecraft attitude control systems. NASA tech. rep., R-361 (1971) Junkins, J.L., Turner, J.D.: Optimal continuous torque attitude maneuvers. J. Guid. Control 3, 210–217 (1980) Shoemake, K.: Animating rotation with quaternion curves. Comput. Graph. 19, 245–254 (1985) Horn, B.K.P.: Closed-form solution of absolute orientation using unit quaternions. J. Opt. Soc. Am. 4, 629–642 (1987) Morawiec, A.: Orientations and Rotations. Springer, Berlin (2004) D’Souza, A.F., Garg, V.K.: Advanced Dynamics, Modeling and Analysis. Prentice–Hall, Englewood Cliffs (1984) Goldstein, H.: Classical Mechanics. Addison–Wesley, Reading (1980) Hairer, E., Lubich, C., Wanner, G.: Geometric Numerical Integration. Springer, Berlin (2006) Iserles, A., Munthe-Kaas, H.Z., Norsett, S.P., Zanna, A.: Lie group methods. Acta Numer. 9, 215–365 (2000) Munthe-Kaas, H.Z.: Runge–Kutta methods on Lie groups. BIT Numer. Math. 38, 92–111 (1998) Engø, K., Marthinsen, A.: Modeling and solutions of some mechanical problems on Lie groups. Multibody Syst. Dyn. 2, 71–88 (1998) Marthinsen, A., Munthe-Kaas, H., Owren, B.: Simulation of ordin differential equations on manifolds: some numerical experiments and verifications. Model. Identif. Control 18, 75–88 (1997) Bottasso, C.L., Borri, M.: Integrating finite rotations. Comput. Methods Appl. Mech. Eng. 164, 307–331 (1998) Celledoni, E., Owren, B.: Lie group methods for rigid body dynamics and time integration on manifolds. Comput. Methods Appl. Mech. Eng. 192, 421–438 (2003) Curtis, M.L.: Matrix Groups. Springer, Berlin (1984) Müller, A.: Group theoretical approaches to vector parameterization of rotations. J. Geom. Symmetry Phys. 19, 243–272 (2010) Terze, Z., Mueller, A., Zlatar, D.: Lie Group integration method for constrained multibody systems in state space. Multibody Syst. Dyn. 34, 275–305 (2015) Mueller, A., Terze, Z.: On the choice of configuration space for numerical Lie group integration of constrained rigid body systems. J. Comput. Appl. Math. 262, 3–13 (2013) Fukushima, T.: Simple, regular, and efficient numerical integration of rotational motion. Astron. J. 135, 2298–2322 (2008) Müller, A.: Approximation of finite rigid body motions from velocity fields. Z. Angew. Math. Mech. 90, 514–521 (2010) Becker, C., Betsch, P.: Application of a gyrostatic rigid body formulation in the context of a direct transcription method for optimal control in multibody dynamics. In: Terze, Z. (ed.) Multibody Dynamics: Computational Methods and Applications. Computational Methods in Applied Sciences, pp. 237–254. Springer, Berlin (2014) Budd, C.J., Iserles, A.: Geometric integration: numerical solution of differential equations on manifolds. Philos. Trans. R. Soc., Math. Phys. Eng. Sci. 357, 945–956 (1999) Munthe-Kaas, H.: High order Runge–Kutta methods on manifolds. Appl. Numer. Math. 29, 115–127 (1999)