Smooth Cubic Polynomial Trajectories for Human-Robot Interactions

With the growing importance of Human-Robot Interaction (HRI), the movement of the robots requires more and more attention to address the issues related to safety, efficiency and ergonomics. Trajectories are excellent candidates in the making of desirable motions designed for collaborative robots, because they allow to simply and precisely describe the motions. Despite the large number of works available for Online Trajectory Generation (OTG), there was, to our knowledge, no complete solution capable to simultaneously meet all the requirements of these new applications. In this paper we present a complete trajectory generation algorithm that build trajectories from arbitrary initial and final conditions, subject to general asymmetric bounds on jerk, acceleration and velocity. A review of the state of the art exposes the limits of the previous OTG works and reveals the difficult problem of non-linearity related with short motions. We explain how these non-linearities introduce discontinuities and we propose a solution based on sequences of segment of third degree polynomial functions.

[1]  Daniel Sidobre,et al.  Online task space trajectory generation , 2012 .

[2]  Khoi Nguyen,et al.  From motion planning to trajectory control with bounded jerk for service manipulator robots , 2010, 2010 IEEE International Conference on Robotics and Automation.

[3]  Arturo Garcia-Perez,et al.  Extending tool-life through jerk-limited motion dynamics in machining processes: An experimental study , 2010 .

[4]  Wisama Khalil,et al.  Modeling, Identification and Control of Robots , 2003 .

[5]  D. Ostry,et al.  Velocity curves of human arm and speech movements , 2004, Experimental Brain Research.

[6]  C. I. Howarth,et al.  The Movement of the Hand towards a Target , 1972, The Quarterly journal of experimental psychology.

[7]  N. Flocke,et al.  Algorithm 954 , 2015 .

[8]  Helge J. Ritter,et al.  On-line planning of time-optimal, jerk-limited trajectories , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[10]  H. Nagasaki Asymmetric velocity and acceleration profiles of human arm movements , 2004, Experimental Brain Research.

[11]  Neville Hogan,et al.  Control and Coordination of Voluntary Arm Movements , 1982, 1982 American Control Conference.

[12]  N. Hogan An organizing principle for a class of voluntary movements , 1984, The Journal of neuroscience : the official journal of the Society for Neuroscience.

[13]  Tamir Tassa,et al.  Planning high order trajectories with general initial and final conditions and asymmetric bounds , 2014, Int. J. Robotics Res..

[14]  Jeffrey C. Trinkle,et al.  Controller design for human-robot interaction , 2008, Auton. Robots.

[15]  Torsten Kr On-Line Trajectory Generation: Nonconstant Motion Constraints , 2012 .

[16]  Wisama Khalil,et al.  Robot Manipulators: Modeling, Performance Analysis and Control , 2007 .

[17]  John Travis Butler,et al.  Psychological Effects of Behavior Patterns of a Mobile Personal Robot , 2001, Auton. Robots.

[18]  Friedrich M. Wahl,et al.  Online Trajectory Generation: Basic Concepts for Instantaneous Reactions to Unforeseen Events , 2010, IEEE Transactions on Robotics.

[19]  Aurelio Piazzi,et al.  Global minimum-jerk trajectory planning of robot manipulators , 2000, IEEE Trans. Ind. Electron..

[20]  William S. Harwin,et al.  Minimum jerk trajectory control for rehabilitation and haptic applications , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[21]  Daniel Sidobre,et al.  Online via-points trajectory generation for reactive manipulations , 2014, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[22]  Corrado Guarino Lo Bianco,et al.  Nonlinear Variable Structure Filter for the Online Trajectory Scaling , 2009, IEEE Transactions on Industrial Electronics.

[23]  John J. Craig,et al.  Introduction to Robotics Mechanics and Control , 1986 .

[24]  Elizabeth A. Croft,et al.  Smooth and time-optimal trajectory planning for industrial manipulators along specified paths , 1999, J. Field Robotics.

[25]  Siddhartha S. Srinivasa,et al.  Generating Legible Motion , 2013, Robotics: Science and Systems.

[26]  Alessandro Gasparetto,et al.  Experimental Validation of Minimum Time-jerk Algorithms for Industrial Robots , 2011, J. Intell. Robotic Syst..

[27]  E. Croft,et al.  Smooth and time-optimal trajectory planning for industrial manipulators along specified paths , 2000 .

[28]  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.

[29]  A. Piazzi,et al.  An interval algorithm for minimum-jerk trajectory planning of robot manipulators , 1997, Proceedings of the 36th IEEE Conference on Decision and Control.

[30]  E. Bizzi,et al.  Posture control and trajectory formation during arm movement , 1984, The Journal of neuroscience : the official journal of the Society for Neuroscience.

[31]  Z. Shiller,et al.  Multi-axis High-order Trajectory Planning , 2012 .

[32]  Peter Strobach The fast quartic solver , 2010, J. Comput. Appl. Math..

[33]  Siddhartha S. Srinivasa,et al.  Legibility and predictability of robot motion , 2013, 2013 8th ACM/IEEE International Conference on Human-Robot Interaction (HRI).

[34]  Wisama Khalil,et al.  Modeling, performance analysis and control of robot manipulators , 2007 .

[35]  Lydia E. Kavraki,et al.  Motion Planning , 2011, IEEE Robotics & Automation Magazine.

[36]  Cynthia Breazeal,et al.  Effects of anticipatory action on human-robot teamwork: Efficiency, fluency, and perception of team , 2007, 2007 2nd ACM/IEEE International Conference on Human-Robot Interaction (HRI).

[37]  S. Liu,et al.  An on-line reference-trajectory generator for smooth motion of impulse-controlled industrial manipulators , 2002, 7th International Workshop on Advanced Motion Control. Proceedings (Cat. No.02TH8623).

[38]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[39]  Przemyslaw A. Lasota,et al.  Toward safe close-proximity human-robot interaction with standard industrial robots , 2014, 2014 IEEE International Conference on Automation Science and Engineering (CASE).

[40]  A. Gasparetto,et al.  A technique for time-jerk optimal planning of robot trajectories , 2008 .

[41]  Leonie Moench,et al.  Graphics Gems I , 2016 .

[42]  Elizabeth A. Croft,et al.  Jerk-bounded manipulator trajectory planning: design for real-time applications , 2003, IEEE Trans. Robotics Autom..

[43]  Friedrich M. Wahl,et al.  Towards On-Line Trajectory Computation , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[44]  Jochen Schwarze Cubic and quartic roots , 1990 .

[45]  Przemyslaw A. Lasota,et al.  Analyzing the Effects of Human-Aware Motion Planning on Close-Proximity Human–Robot Collaboration , 2015, Hum. Factors.

[46]  D. Sidobre,et al.  Soft Motion Trajectory Planning and Control for Service Manipulator Robot , 2006 .

[47]  Alexander Verl,et al.  Cooperation of human and machines in assembly lines , 2009 .

[48]  Anil V. Rao,et al.  GPOPS-II , 2014, ACM Trans. Math. Softw..

[49]  Tamio Arai,et al.  Assessment of operators' mental strain induced by hand-over motion of industrial robot manipulator , 2010, 19th International Symposium in Robot and Human Interactive Communication.

[50]  Tamio Arai,et al.  Assessment of operator stress induced by robot collaboration in assembly , 2010 .

[51]  Kim Doang Nguyen,et al.  On Algorithms for Planning S-Curve Motion Profiles , 2008 .

[52]  Corrado Guarino Lo Bianco,et al.  Online Trajectory Scaling for Manipulators Subject to High-Order Kinematic and Dynamic Constraints , 2011, IEEE Transactions on Robotics.

[53]  Claudio Melchiorri,et al.  Trajectory Planning for Automatic Machines and Robots , 2010 .

[54]  Andreas Öchsner,et al.  Maxima—A Computer Algebra System , 2019 .

[55]  Kostas J. Kyriakopoulos,et al.  Minimum jerk path generation , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[56]  Terrence Fong,et al.  A Survey of Methods for Safe Human-Robot Interaction , 2017, Found. Trends Robotics.

[57]  Rachid Alami,et al.  A Human Aware Mobile Robot Motion Planner , 2007, IEEE Transactions on Robotics.

[58]  M Maarten Steinbuch,et al.  Trajectory planning and feedforward design for electromechanical motion systems , 2005 .