Predictive joint trajectory scaling for manipulators with kinodynamic constraints

• Published in: Control engineering practice Vol. 95; p. 104264
• Main Authors: Faroni, Marco, Beschi, Manuel, Guarino Lo Bianco, Corrado, Visioli, Antonio
• Format: Journal Article
• Language: English
• Published: Elsevier Ltd 01.02.2020; Elsevier
• Subjects: Automatic Control Engineering; Computer Science; Joint constraints; Motion planning; Predictive control; Robot manipulators; Robotics; Trajectory scaling; Motion planning; Trajectory scaling; Joint constraints; Robot manipulators; Predictive control; robot manipulators; predictive control; trajectory scaling; joint constraints
• ISSN: 0967-0661; 1873-6939
• DOI: 10.1016/j.conengprac.2019.104264

Trajectory scaling techniques adapt online the robot timing law to preserve the desired geometric path when the desired motion does not respect the robot limits. State-of-the-art non-predictive methods typically provide far-from-optimal solutions, while high computational burdens are the main bottleneck for the implementation of receding horizon strategies. This paper proposes a predictive approach to trajectory scaling subject to joint velocity, acceleration, and torque limitations. Computational complexity is dramatically reduced by means of the parametrization of inputs and outputs and the iterative linearization of the optimal control problem around the previous output prediction. This allows the online implementation of the method for sampling periods in the order of one millisecond. Numerical and experimental results on a six-degree-of-freedom robot show the effectiveness of the method.