Generalized Comprehensive Motion Theory for High-Order Differential Dynamics

We address the problem of calculating complex Jacobian matrices that can arise from optimization problems. An example is the inverse optimal control in human motion analysis which has a cost function that depends on the second order time-derivative of torque τ̈ . Thus, its gradient decomposed to, among other, the Jacobian δτ̈/δq. We propose a new concept called N -order Comprehensive Motion Transformation Matrix (N -CMTM) to provide an exact analytical solution of several Jacobians. The computational complexity of the basic Jacobian and its N -order time-derivatives computed from the N -CMTM is experimentally shown to be linear to the number of joints Nj . The N -CMTM is based on well-known spatial algebra which makes it available for any type of robots. Moreover, it can be used along classical algorithms. The computational complexity of the construction of the N -CMTM itself is experimentally shown to be N.

[1]  Shuuji Kajita,et al.  Constraint-based dynamics simulator for humanoid robots with shock absorbing mechanisms , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  장윤희,et al.  Y. , 2003, Industrial and Labor Relations Terms.

[3]  Nicolas Mansard,et al.  Analytical Derivatives of Rigid Body Dynamics Algorithms , 2018, Robotics: Science and Systems.

[4]  M. A. Chace,et al.  A Sparsity-Oriented Approach to the Dynamic Analysis and Design of Mechanical Systems—Part 1 , 1977 .

[5]  Eiichi Yoshida,et al.  Predictive Inverse Kinematics: optimizing Future Trajectory through Implicit Time Integration and Future Jacobian Estimation , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  J. Y. S. Luh,et al.  Resolved-acceleration control of mechanical manipulators , 1980 .

[7]  Katsu Yamane,et al.  Musculoskeletal-see-through mirror: computational modeling and algorithm for whole-body muscle activity visualization in real time. , 2010, Progress in biophysics and molecular biology.

[8]  Michael Damsgaard,et al.  Analysis of musculoskeletal systems in the AnyBody Modeling System , 2006, Simul. Model. Pract. Theory.

[9]  Alessandro De Luca,et al.  A recursive Newton-Euler algorithm for robots with elastic joints and its application to control , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Eiichi Yoshida,et al.  Humanoid motion planning for dynamic tasks , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[11]  Subir Kumar Saha,et al.  Recursive dynamics simulator (ReDySim): A multibody dynamics solver , 2012 .

[12]  Jian S. Dai,et al.  Analytical Expressions of Serial Manipulator Jacobians and their High-Order Derivatives based on Lie Theory* , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Y. Nakamura,et al.  Somatosensory computation for man-machine interface from motion-capture data and musculoskeletal human model , 2005, IEEE Transactions on Robotics.

[14]  Roy Featherstone,et al.  Rigid Body Dynamics Algorithms , 2007 .

[15]  David E. Orin,et al.  Efficient Dynamic Computer Simulation of Robotic Mechanisms , 1982 .

[16]  Corrado Guarino Lo Bianco,et al.  Evaluation of Generalized Force Derivatives by Means of a Recursive Newton–Euler Approach , 2009, IEEE Transactions on Robotics.

[17]  Pierre-Brice Wieber,et al.  Hierarchical quadratic programming: Fast online humanoid-robot motion generation , 2014, Int. J. Robotics Res..

[18]  Qingsong Xu,et al.  Kinematics and inverse dynamics analysis for a general 3-PRS spatial parallel mechanism , 2005, Robotica.

[19]  Dana Kulic,et al.  Human motion segmentation using cost weights recovered from inverse optimal control , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[20]  D. Eager,et al.  Beyond velocity and acceleration: jerk, snap and higher derivatives , 2016 .

[21]  Christopher G. Atkeson,et al.  Adapting human motion for the control of a humanoid robot , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[22]  Stefan Schaal,et al.  Optimal distribution of contact forces with inverse-dynamics control , 2013, Int. J. Robotics Res..

[23]  J. Y. S. Luh,et al.  On-Line Computational Scheme for Mechanical Manipulators , 1980 .

[24]  T. Flash,et al.  The coordination of arm movements: an experimentally confirmed mathematical model , 1985, The Journal of neuroscience : the official journal of the Society for Neuroscience.

[25]  Abderrahmane Kheddar,et al.  GPU Robot Motion Planning Using Semi-Infinite Nonlinear Programming , 2016, IEEE Transactions on Parallel and Distributed Systems.

[26]  G. Sohl,et al.  A Recursive Multibody Dynamics and Sensitivity Algorithm for Branched Kinematic Chains , 2001 .

[27]  Eiichi Yoshida,et al.  On human motion imitation by humanoid robot , 2008, 2008 IEEE International Conference on Robotics and Automation.

[28]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[29]  Frank Chongwoo Park,et al.  A Lie Group Formulation of Robot Dynamics , 1995, Int. J. Robotics Res..

[30]  Eiichi Yoshida,et al.  Real-time musculoskeletal visualization of muscle tension and joint reaction forces , 2019, 2019 IEEE/SICE International Symposium on System Integration (SII).

[31]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..

[32]  Eiichi Yoshida,et al.  Comprehensive theory of differential kinematics and dynamics towards extensive motion optimization framework , 2018, Int. J. Robotics Res..

[33]  Barak A. Pearlmutter,et al.  Automatic differentiation in machine learning: a survey , 2015, J. Mach. Learn. Res..