A Dynamic Programming Approach to Optimal Planning for Vehicles with Trailers

In this paper we deal with the optimal feedback synthesis problem for robotic vehicles with trailers which can be modeled by differential equations in chained-form. With respect to classical methods for numerical evolution of optimal feedback synthesis via dynamic programming which are based on both input and state discretization, our method exploits the lattice structure naturally imposed on the reachable set by input quantization. A generalized Dijkstra algorithm can be used to obtain sub-optimal (optimal up to the lattice resolution) feedback laws, for chained-form vehicles with n-trailers, in an effective way.

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

[2]  Antonio Bicchi,et al.  On the reachability of quantized control systems , 2002, IEEE Trans. Autom. Control..

[3]  Richard M. Murray,et al.  Nilpotent bases for a class of nonintegrable distributions with applications to trajectory generation for nonholonomic systems , 1994, Math. Control. Signals Syst..

[4]  Ole Jakob Sørdalen,et al.  Conversion of the kinematics of a car with n trailers into a chained form , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[5]  Antonio Bicchi,et al.  Optimal Control of Quantized Input Systems , 2002, HSCC.

[6]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[7]  Antonio Bicchi,et al.  Motion planning through symbols and lattices , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[8]  A. Bicchi,et al.  On Optimal Steering Of Quantized Input Systems , 2002 .

[9]  Robert E. Larson,et al.  Principles of Dynamic Programming , 1978 .

[10]  Steven M. LaValle,et al.  Algorithms for Computing Numerical Optimal Feedback Motion Strategies , 2001, Int. J. Robotics Res..

[11]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

[12]  Sean R Eddy,et al.  What is dynamic programming? , 2004, Nature Biotechnology.

[13]  Ilya Kolmanovsky,et al.  Developments in nonholonomic control problems , 1995 .

[14]  Eric V. Denardo,et al.  Dynamic Programming: Models and Applications , 2003 .

[15]  Eduardo Sontag.  Control of systems without drift via generic loops , 1995, IEEE Trans. Autom. Control..

[16]  O. J. Sørdalen,et al.  Exponential stabilization of nonholonomic chained systems , 1995, IEEE Trans. Autom. Control..

[17]  C. Samson.  Control of chained systems application to path following and time-varying point-stabilization of mobile robots , 1995, IEEE Trans. Autom. Control..

[18]  A. Marigo,et al.  Reachability analysis for a class of quantized control systems , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[19]  D. Bertsekas.  Convergence of discretization procedures in dynamic programming , 1975 .

[20]  Jean-Paul Laumond,et al.  Topological property for collision-free nonholonomic motion planning: the case of sinusoidal inputs for chained form systems , 1998, IEEE Trans. Robotics Autom..

[21]  Antonio Bicchi,et al.  Encoding steering control with symbols , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).