Motion Planning and Stabilization for a Reversing Truck and Trailer System

Abstract: This thesis work contains a stabilization and a motion planning strategy for a truck and trailer system. A dynamical model for a general 2-trailer with two rigid free joints and a kingpin hitching has been derived based on previous work. The model holds under the assumption of rolling without slipping of the wheels and has been used for control design and as a steering function in a probabilistic motion planning algorithm. A gain scheduled Linear Quadratic (LQ) controller with a Pure pursuit path following algorithm has been designed to stabilize the system around a given reference path. The LQ controller is only used in backward motion and the Pure pursuit controller is split into two parts which are chosen depending on the direction of motion. A motion planning algorithm called Closed-Loop Rapidly-exploring Random Tree (CL-RRT) has then been used to plan suitable reference paths for the system from an initial state configuration to a desired goal configuration with obstacle-imposed constraints. The motion planning algorithm solves a non-convex optimal control problem by randomly exploring the input space to the closed-loop system by performing forward simulations of the closed-loop system. Evaluations of performance is partly done in simulations and partly on a Lego platform consisting of a small-scale system. The controllers have been used on the Lego platform with successful results. When the reference path is chosen as a smooth function the closed-loop system is able to follow the desired path in forward and backward motion with a small control error. In the work, it is shown how the CL-RRT algorithm is able to plan non-trivial maneuvers in simulations by combining forward and backward motion. Beyond simulations, the algorithm has also been used for planning in open-loop for the Lego platform.