From motion planning through waypoints to open-loop trajectory tracking algorithm

This paper addresses the trajectory tracking problem which will be regarded as an open-loop planning problem, in contrast to various feedback motion control methods. The trajectory tracking problem is formulated as the constrained motion planning problem, whereas constraints reflect the distance in the task space between the system output and the desired trajectory. The problem consists in defining a control function that drives the system output through selected points in the task space at given time instants, and simultaneously maintains the trajectory tracking constraints. The original constrained motion planning problem is replaced by an unconstrained one addressed in an extended control system representation, and solved with the task priority version of the Lifted Newton method. Solutions of example trajectory tracking problems for the kinematic car type platform illustrate the theoretical concepts.

[1]  Krzysztof Tchon,et al.  Constrained motion planning of nonholonomic systems , 2011, Syst. Control. Lett..

[2]  K. Tchoń,et al.  Multiple-task motion planning of non-holonomic systems with dynamics , 2013 .

[3]  M. Cholewiński,et al.  Implementation of factitious force method for control of 5R manipulator with skid-steering platform REX , 2016 .

[4]  Krzysztof Kozlowski,et al.  Motion planning and feedback control for a unicycle in a way point following task: The VFO approach , 2009, Int. J. Appl. Math. Comput. Sci..

[5]  Dariusz Pazderski Waypoint Following for Differentially Driven Wheeled Robots with Limited Velocity Perturbations , 2017, J. Intell. Robotic Syst..

[6]  Mariusz Janiak Lifted Newton motion planning algorithm , 2015, 2015 10th International Workshop on Robot Motion and Control (RoMoCo).

[7]  James B. Rawlings,et al.  Postface to “ Model Predictive Control : Theory and Design ” , 2012 .

[8]  Adrian Sandu,et al.  Forward and adjoint sensitivity analysis with continuous explicit Runge-Kutta schemes , 2009, Appl. Math. Comput..

[9]  S. Shankar Sastry,et al.  Stabilization of trajectories for systems with nonholonomic constraints , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[10]  Krzysztof Tchon,et al.  Motion planning through waypoints for a skid-steering mobile platform , 2015, 2015 10th International Workshop on Robot Motion and Control (RoMoCo).

[11]  Krzysztof Tchoń,et al.  Endogenous configuration space approach to mobile manipulators: A derivation and performance assessment of Jacobian inverse kinematics algorithms , 2003 .

[12]  Krzysztof Tchoń,et al.  Endogenous Configuration Space Approach: An Intersection of Robotics and Control Theory , 2017 .

[13]  Moritz Diehl,et al.  The Lifted Newton Method and Its Application in Optimization , 2009, SIAM J. Optim..

[14]  A. Ratajczak Trajectory reproduction and trajectory tracking problem for the nonholonomic systems , 2016 .

[15]  C. Samson,et al.  Stabilization of trajectories for systems on Lie groups. Application to the rolling sphere. , 2008 .

[16]  Krzysztof Kozlowski,et al.  Trajectory tracking control with obstacle avoidance capability for unicycle-like mobile robot , 2012 .

[17]  Thomas P. Wihler,et al.  An adaptive Newton-method based on a dynamical systems approach , 2014, Commun. Nonlinear Sci. Numer. Simul..

[18]  Krzysztof Tchon,et al.  Continuation method approach to trajectory planning in robotic systems , 2011, 2011 16th International Conference on Methods & Models in Automation & Robotics.