A real-time trajectory planning method for enhanced path-tracking performance of serial manipulators

Abstract Robotized assembly and manufacturing often require to modify the robot motion at runtime. When the primary constraint is to preserve the geometrical path as much as possible, it is convenient to scale the nominal trajectory in time to meet the robot constraints. Look-ahead techniques are computationally heavy, while non-look-ahead ones usually show poor performance in critical circumstances. This paper proposes a novel technique that can be embedded in non-look-ahead scaling algorithms to improve their performance. The proposed method takes into account the robot velocity, acceleration, and torque limits and modifies the velocity profile based on an approximated look-ahead criterion. To do this, it considers only the last point of a look-ahead window and, by linearizing the problem, it computes the maximum admissible robot velocity. The technique can be applied to existing trajectory scaling algorithms to confer look-ahead properties on them. Simulation and experimental results on a 6-degree-of-freedom manipulator show that the proposed method significantly reduces path-following errors.

[1]  Christian Kirches,et al.  qpOASES: a parametric active-set algorithm for quadratic programming , 2014, Mathematical Programming Computation.

[2]  Corrado Guarino Lo Bianco,et al.  Predictive joint trajectory scaling for manipulators with kinodynamic constraints , 2020, Control Engineering Practice.

[3]  Csaba Szepesvári,et al.  Extending rapidly-exploring random trees for asymptotically optimal anytime motion planning , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Corrado Guarino Lo Bianco,et al.  A scaling algorithm for the generation of jerk-limited trajectories in the operational space , 2017 .

[5]  Mehmet Çevik,et al.  Improved trajectory planning of an industrial parallel mechanism by a composite polynomial consisting of Bézier curves and cubic polynomials , 2019, Mechanism and Machine Theory.

[6]  Tobias Weber,et al.  Implementation of Nonlinear Model Predictive Path-Following Control for an Industrial Robot , 2015, IEEE Transactions on Control Systems Technology.

[7]  Milan Simic,et al.  Sampling-Based Robot Motion Planning: A Review , 2014, IEEE Access.

[8]  Corrado Guarino Lo Bianco,et al.  A Discrete-Time Filter for the Generation of Signals With Asymmetric and Variable Bounds on Velocity, Acceleration, and Jerk , 2014, IEEE Transactions on Industrial Electronics.

[9]  Antonio Visioli,et al.  Predictive Inverse Kinematics for Redundant Manipulators With Task Scaling and Kinematic Constraints , 2019, IEEE Transactions on Robotics.

[10]  Clément Gosselin,et al.  Extending the capabilities of robotic manipulators using trajectory optimization , 2018 .

[11]  Andrea Maria Zanchettin,et al.  Real-time trajectory planning based on joint-decoupled optimization in human-robot interaction , 2020 .

[12]  Oussama Khatib,et al.  Control of Redundant Robots Under Hard Joint Constraints: Saturation in the Null Space , 2015, IEEE Transactions on Robotics.

[13]  Fan-Tien Cheng,et al.  Resolving manipulator redundancy under inequality constraints , 1994, IEEE Trans. Robotics Autom..

[14]  M. Boryga,et al.  Planning of manipulator motion trajectory with higher-degree polynomials use , 2009 .

[15]  Siddhartha S. Srinivasa,et al.  Informed RRT*: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Hao Ding,et al.  Dynamic speed and separation monitoring for collaborative robot applications - Concepts and performance , 2019, Robotics Comput. Integr. Manuf..

[17]  Alessandro Marino,et al.  Safety in human-multi robot collaborative scenarios: a trajectory scaling approach , 2018 .

[18]  Nan Zhang,et al.  Dynamic trajectory planning of a 3-DOF under-constrained cable-driven parallel robot , 2016 .

[19]  Jeremy A Marvel,et al.  Implementing Speed and Separation Monitoring in Collaborative Robot Workcells. , 2017, Robotics and computer-integrated manufacturing.

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

[21]  Claudio Gaz,et al.  A model-based residual approach for human-robot collaboration during manual polishing operations , 2018, Mechatronics.

[22]  Andrea Maria Zanchettin,et al.  Safety in human-robot collaborative manufacturing environments: Metrics and control , 2016, IEEE Transactions on Automation Science and Engineering.

[23]  Manuel Beschi,et al.  An MPC Framework for Online Motion Planning in Human-Robot Collaborative Tasks , 2019, 2019 24th IEEE International Conference on Emerging Technologies and Factory Automation (ETFA).

[24]  Jan Swevers,et al.  Time-Optimal Path Tracking for Robots: A Convex Optimization Approach , 2009, IEEE Transactions on Automatic Control.

[25]  Kaiyuan Wu,et al.  Optimal time-jerk trajectory planning for industrial robots , 2018 .

[26]  Gianluca Antonelli,et al.  A new on-line algorithm for inverse kinematics of robot manipulators ensuring path tracking capability under joint limits , 2003, IEEE Trans. Robotics Autom..

[27]  B. Siciliano,et al.  THE ROLE OF EULER PARAMETERS IN ROBOT CONTROL , 1999 .

[28]  Quang-Cuong Pham,et al.  A General, Fast, and Robust Implementation of the Time-Optimal Path Parameterization Algorithm , 2013, IEEE Transactions on Robotics.

[29]  Thomas Reisinger,et al.  Example Application of ISO/TS 15066 to a Collaborative Assembly Scenario , 2016 .

[30]  Corrado Guarino Lo Bianco,et al.  Techniques to preserve the stability of a trajectory scaling algorithm , 2013, 2013 IEEE International Conference on Robotics and Automation.