Time-optimal path tracking for robots under dynamics constraints based on convex optimization

To fully utilize the dynamic performance of robotic manipulators and enforce minimum motion time in path tracking, the problem of minimum time path tracking for robotic manipulators under confined torque, change rate of the torque, and voltage of the DC motor is considered. The main contribution is the introduction of the concepts of virtual change rate of the torque and the virtual voltage, which are linear functions in the state and control variables and are shown to be very tight approximation to the real ones. As a result, the computationally challenging non-convex minimum time path tracking problem is reduced to a convex optimization problem which can be solved efficiently. It is also shown that introducing dynamics constraints can significantly improve the motion precision without costing much in motion time, especially in the case of high speed motion. Extensive simulations are presented to demonstrate the effectiveness of the proposed approach.

[1]  Yaobin Chen,et al.  A proof of the structure of the minimum-time control law of robotic manipulators using a Hamiltonian formulation , 1990, IEEE Trans. Robotics Autom..

[2]  Qiang Zhang,et al.  Practical smooth minimum time trajectory planning for path following robotic manipulators , 2013, 2013 American Control Conference.

[3]  Rida T. Farouki,et al.  Time-optimal traversal of curved paths by Cartesian CNC machines under both constant and speed-dependent axis acceleration bounds , 2007 .

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

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

[6]  Friedrich Pfeiffer,et al.  A concept for manipulator trajectory planning , 1986, Proceedings. 1986 IEEE International Conference on Robotics and Automation.

[7]  Alberto Trevisani,et al.  Planning of dynamically feasible trajectories for translational, planar, and underconstrained cable-driven robots , 2013, J. Syst. Sci. Complex..

[8]  Zvi Shiller,et al.  On singular time-optimal control along specified paths , 1994, IEEE Trans. Robotics Autom..

[9]  J. Bobrow,et al.  Time-Optimal Control of Robotic Manipulators Along Specified Paths , 1985 .

[10]  Qiang Zhang,et al.  Tractable Algorithm for Robust Time-Optimal Trajectory Planning of Robotic Manipulators under Confined Torque , 2015, Int. J. Comput. Commun. Control.

[11]  Chian-Song Chiu,et al.  Robust adaptive motion/force tracking control design for uncertain constrained robot manipulators , 2004, Autom..

[12]  Xiao-Shan Gao,et al.  A Greedy Algorithm for Feed-rate Planning of CNC Machines along Curved Tool Paths with Confined Jerk for Each Axis , 2010 .

[13]  Zvi Shiller,et al.  Time optimal motions of manipulators with actuator dynamics , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[14]  Mohammad Jafar Sadigh,et al.  Application of phase-plane method in generating minimum time solution for stable walking of biped robot with specified pattern of motion , 2013, Robotica.

[15]  Ke Zhang,et al.  Time-optimal interpolation for CNC machining along curved tool pathes with confined chord error , 2013, J. Syst. Sci. Complex..

[16]  Elizabeth A. Croft,et al.  Feed optimization for five-axis CNC machine tools with drive constraints , 2008 .

[17]  Jingyan Dong,et al.  Feed-rate optimization with jerk constraints for generating minimum-time trajectories , 2007 .

[18]  Xiao-Shan Gao,et al.  Time-optimal interpolation for five-axis CNC machining along parametric tool path based on linear programming , 2013 .

[19]  Masayoshi Tomizuka,et al.  On the time-optimal trajectory planning and control of robotic manipulators along predefined paths , 2013, 2013 American Control Conference.

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

[21]  H. Maurer,et al.  SQP-methods for solving optimal control problems with control and state constraints: adjoint variables, sensitivity analysis and real-time control , 2000 .

[22]  Goele Pipeleers,et al.  Time-Optimal Path Following for Robots With Convex–Concave Constraints Using Sequential Convex Programming , 2013, IEEE Transactions on Robotics.

[23]  Tzyh Jong Tarn,et al.  Effect of motor dynamics on nonlinear feedback robot arm control , 1991, IEEE Trans. Robotics Autom..

[24]  Nicholas M. Patrikalakis,et al.  Shape Interrogation for Computer Aided Design and Manufacturing , 2002, Springer Berlin Heidelberg.

[25]  M. H. Korayem,et al.  Trajectory planning of mobile manipulators using dynamic programming approach , 2012, Robotica.

[26]  Xiao-Shan Gao,et al.  A greedy algorithm for feedrate planning of CNC machines along curved tool paths with confined jerk , 2012 .

[27]  Xiao-Shan Gao,et al.  Efficient algorithm for time-optimal feedrate planning and smoothing with confined chord error and acceleration , 2013 .

[28]  T. J. Rivlin The Chebyshev polynomials , 1974 .

[29]  J. Löfberg,et al.  Convex Optimization approach for Time-Optimal Path Tracking of Robots with Speed Dependent Constraints , 2011 .

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