Simulation Modeling
Simulation Modelling Practice and Theory 18 (2010) 712–731
Contents lists available at ScienceDirect
Simulation Modelling Practice and Theory journal homepage: www.elsevier.com/locate/simpat
Singularity-free dynamic equations of vehicle–manipulator systems
Pål J. From a,*, Vincent Duindam b, Kristin Y. Pettersen a, Jan T. Gravdahl a, Shankar Sastry b a b
Department of Engineering Cybernetics, Norwegian University of Science and Technology, Norway Department of EECS, University of California, 253 Cory Hall, Berkeley, CA 94720-1770, USA
a r t i c l e
i n f o
a b s t r a c t
In this paper we derive the singularity-free dynamic equations of vehicle–manipulator systems using a minimal representation. These systems are normally modeled using Euler angles, which leads to singularities, or Euler parameters, which is not a minimal representation and thus not suited for Lagrange’s equations. We circumvent these issues by introducing quasi-coordinates which allows us to derive the dynamics using minimal and globally valid non-Euclidean configuration coordinates. This is a great advantage as the configuration space of the vehicle in general is non-Euclidean. We thus obtain a computationally efficient and singularity-free formulation of the dynamic equations with the same complexity as the conventional Lagrangian approach. The closed form formulation makes the proposed approach well suited for system analysis and model-based control. This paper focuses on the dynamic properties of vehicle–manipulator systems and we present the explicit matrices needed for implementation together with several mathematical relations that can be used to speed up the algorithms. We also show how to calculate the inertia and Coriolis matrices and present these for several different vehicle–manipulator systems in such a way that this can be implemented for simulation and control purposes without extensive knowledge of the mathematical background. By presenting the explicit
Contents lists available at ScienceDirect
Simulation Modelling Practice and Theory journal homepage: www.elsevier.com/locate/simpat
Singularity-free dynamic equations of vehicle–manipulator systems
Pål J. From a,*, Vincent Duindam b, Kristin Y. Pettersen a, Jan T. Gravdahl a, Shankar Sastry b a b
Department of Engineering Cybernetics, Norwegian University of Science and Technology, Norway Department of EECS, University of California, 253 Cory Hall, Berkeley, CA 94720-1770, USA
a r t i c l e
i n f o
a b s t r a c t
In this paper we derive the singularity-free dynamic equations of vehicle–manipulator systems using a minimal representation. These systems are normally modeled using Euler angles, which leads to singularities, or Euler parameters, which is not a minimal representation and thus not suited for Lagrange’s equations. We circumvent these issues by introducing quasi-coordinates which allows us to derive the dynamics using minimal and globally valid non-Euclidean configuration coordinates. This is a great advantage as the configuration space of the vehicle in general is non-Euclidean. We thus obtain a computationally efficient and singularity-free formulation of the dynamic equations with the same complexity as the conventional Lagrangian approach. The closed form formulation makes the proposed approach well suited for system analysis and model-based control. This paper focuses on the dynamic properties of vehicle–manipulator systems and we present the explicit matrices needed for implementation together with several mathematical relations that can be used to speed up the algorithms. We also show how to calculate the inertia and Coriolis matrices and present these for several different vehicle–manipulator systems in such a way that this can be implemented for simulation and control purposes without extensive knowledge of the mathematical background. By presenting the explicit
References: [1] O. Egeland, J.R. Sagli, Coordination of motion in a spacecraft/manipulator system, International Journal of Robotics Research 12 (4) (1993) 366–379. [2] S. Dubowsky, E. Papadopoulos, The kinematics, dynamics and control of free-flying and free-floating space robotic systems, IEEE Transactions on Robotics and Automation 9 (5) (1993). [3] P.C. Hughes, Spacecraft Attitude Dynamics, Dover Publications, 2002. [4] S.A.A. Moosavian, E. Papadopoulos, Explicit dynamics of space free-flyers with multiple manipulators via space maple, Advanced Robotics 18 (2) (2004). [5] S.A.A. Moosavian, E. Papadopoulos, Free-flying robots in space: an overview of dynamics modeling, planning and control, Robotica 25 (2007). [6] B. Liang, Y. Xu, M. Bergerman, Mapping a space manipulator to a dynamically equivalent manipulator, ASME Journal of Dynamic Systems, Measurement, and Control 120 (1998). [7] O. Parlaktuna, M. Ozkan, Adaptive control of free-floating space manipulators using dynamically equivalent manipulator model, Robotics and Autonomous Systems 46 (3) (2004). [8] L.J. Love, J.F. Jansen, F.G. Pin, On the modeling of robots operating on ships, in: IEEE International Conference on Robotics and Automation, Louisiana, USA, vol. 3, 2004, pp. 2436–2443. [9] J. Kitarovic, V. Tomas, D. Cisic, The electronic and informatics age - a new stage in developing highly effective ships, in: 47th International ELMAR Symposium, Zadar, Croatia, 2005, pp. 385–388. [10] G. Antonelli, Underwater Robots. Motion and Force Control of Vehicle–Manipulator Systems, Springer-Verlag, 2006. [11] S. McMillan, D.E. Orin, R.B. McGhee, Efficient dynamic simulation of an underwater vehicle with a robotic manipulator, IEEE Transactions on Systems, Man and Cybernetics 25 (8) (1995) 1194–1206. [12] S.-R. Oh, K. Mankala, S. Agrawal, J. Albus, Dynamic modeling and robust controller design of a two-stage parallel cable robot, in: IEEE International Conference on Robotics and Automation, Louisiana, USA, vol. 4, 2004, pp. 3678–3683. [13] P.J. From, V. Duindam, J.T. Gravdahl, S. Sastry, Modeling and motion planning for mechanisms on a non-inertial base, in: International Conference of Robotics and Automation, Kobe, Japan, 2009. [14] D.C. Salzmann, Ampelmann prototype – developing a motion compensating platform for offshore access, European Wind Energy Conference, Milan, Italy, 2007. [15] G. Lebans, K. Wilkie, R. Dubay, D. Crabtree, T. Edmonds, Telerobotic shipboard handling system, OCEANS, Nova Scotia, Canada, vol. 2, 1997, pp. 1237– 1241. [16] K. Kosuge, M. Okuda, T. Fukuda, Motion control of manipulator/vehicle system floating on water, in: Proceedings of 2nd IEEE International Workshop on Advanced Motion Control, Nagoya, Japan, 1992, pp. 1261–1268. [17] H. Kajita, K. Kosuge, Force control of robot floating on the water utilizing vehicle restoring force, in: IEEE/RSJ International Conference on Intelligent Robot and Systems, Grenoble, France, vol. 11, 1997, pp. 162–167. [18] T. Yoshikawa, K. Harada, A. Matsumoto, Hybrid position/force control of flexible-macro/rigid-micro manipulator systems, IEEE Transactions on Robotics and Automation 12 (4) (1996) 633–640. [19] A. Bowling, O. Khatib, Design of macro/mini manipulators for optimal dynamic performance, in: Proceedings of the IEEE International Conference on Robotics and Automation, New Mexico, USA, vol. 1, 1997, pp. 449–454. [20] S.P. Bhat, D.S. Bernstein, A topological obstruction to continuous global stabilization of rotational motion and the unwinding phenomenon, Systems and Control Letters 39 (4) (2000) 63–70. [21] J.M. Selig, Geometric Fundamentals of Robotics, Springer, 2000. [22] F.C. Park, J.E. Bobrow, S.R. Ploen, A lie group formulation of robot dynamics, International Journal of Robotics Research 14 (6) (1995). [23] F. Bullo, A.D. Lewis, Geometric Control of Mechanical Systems: Modeling Analysis and Design for Simple Mechanical Control Systems, Springer, 2004. [24] H.G. Kwatny, G. Blankenship, Nonlinear Control and Analytical Mechanics A Computational Approach, Birkhauser, Boston, 2000. [25] K. Kozlowski, P. Herman, Control of robot manipulators in terms of quasi-velocities, Journal of Intelligent and Robotic Systems 53 (3) (2008). [26] P. Herman, K. Kozlowski, A survey of equations of motion in terms of inertial quasi-velocities for serial manipulators, Archive of Applied Mechanics 76 (9-10) (2006). [27] V. Duindam, S. Stramigioli, Lagrangian dynamics of open multibody systems with generalized holonomic and nonholonomic joints, in: Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, California, USA, October 2007, pp. 3342–3347. [28] V. Duindam, S. Stramigioli, Singularity-free dynamic equations of open-chain mechanisms with general holonomic and nonholonomic joints, IEEE Transactions on Robotics 24 (3) (2008) 517–526. June. [29] T.I. Fossen, Marine Control Systems, 3rd printing, Marine Cybernetics, 2002. [30] R.M. Murray, Z. Li, S.S. Sastry, A Mathematical Introduction to Robotic Manipulation, CRC Press, 1994. [31] V. Duindam, Port-based modeling and control for efficient bipedal walking robots, Ph.D. Dissertation, University of Twente, March 2006. [Online]. Available: . [32] H. Goldstein, C.P. Poole, J.L. Safko, Classical Mechanics, Addison Wesley, 2001. [33] O. Egeland, J.T. Gravdahl, Modeling and simulation for automatic control, Marine Cybernetics AS (2003). [34] T.I. Fossen, Marine Control Systems - Guidance, Navigation and Control of Ships, Rigs, and Underwater Vehicles, Marine Cybernetics, first ed., 2002, pp. 586. [35] L. Meirovich, M.K. Kwak, State equations for a spacecraft with flexible appendages in terms of quasi-coordinates, Applied Mechanics Reviews 42 (11) (1989). [36] Z. Vafa, S. Dubowsky, On the dynamics of manipulators in space using the virtual manipulator approach, in: IEEE International Conference on Robotics and Automation, North Carolina, USA, 1987. [37] E. Papadopoulos, S. Dubowsky, On the nature of control algorithms for free-floating space manipulators, IEEE Transactions on Robotics and Automation 7 (6) (1991). [38] R.I. McLachlan, G.R.W. Quispel, Geometric integrators for odes, Journal of Physics A: Mathematical and General 39 (19) (2006). [39] H. Munthe-Kaas, Runge–Kutta methods on lie groups, BIT Numerical Mathematics 38 (1) (1998).