On motion planning and control for truck and trailer systems

Sammanfattning: During the last decades, improved sensor and hardware technologies as well as new methods and algorithms have made self-driving vehicles a realistic possibility in the near future. Thanks to this technology enhancement, many leading automotive and technology companies have turned their attention towards developing advanced driver assistance systems (ADAS) and self-driving vehicles. Autonomous vehicles are expected to have their first big impact in closed areas, such as mines, harbors and loading/offloading sites. In such areas, the legal requirements are less restrictive and the surrounding environment is more controlled and predictable compared to urban areas. Expected positive outcomes include increased productivity and safety, reduced emissions and the possibility to relieve the human from performing complex or dangerous tasks. Within these sites, different truck and trailer systems are used to transport materials. These systems are composed of several interconnected modules, and are thus large and highly unstable while reversing. This thesis addresses the problem of designing efficient motion planning and feedback control frameworks for such systems.First, a cascade controller for a reversing truck with a dolly-steered trailer is presented. The unstable modes of the system is stabilized around circular equilibrium configurations using a gain-scheduled linear quadratic (LQ) controller together with a higher-level pure pursuit controller to enable path following of piecewise linear reference paths. The cascade controller is then used within a rapidly-exploring random tree (RRT) framework and the complete motion planning and control framework is demonstrated on a small-scale test vehicle.Second, a path following controller for a reversing truck with a dolly-steered trailer is proposed for the case when the obtained motion plan is kinematically feasible. The control errors of the system are modeled in terms of their deviation from the nominal path and a stabilizing LQ controller with feedforward action is designed based on the linearization of the control error model. Stability of the closed-loop system is proven by combining global optimization, theory from linear differential inclusions and linear matrix inequality techniques.Third, a systematic framework is presented for analyzing stability of the closed-loop system consisting of a controlled vehicle and a feedback controller, executing a motion plan computed by a lattice planner. When this motion planner is considered, it is shown that the closed-loop system can be modeled as a nonlinear hybrid system. Based on this, a novel method is presented for analyzing the behavior of the tracking error, how to design the feedback controller and how to potentially impose constraints on the motion planner in order to guarantee that the tracking error is bounded and decays towards zero.Fourth, a complete motion planning and control solution for a truck with a dolly-steered trailer is presented. A lattice-based motion planner is proposed, where a novel parametrization of the vehicle’s state-space is proposed to improve online planning time. A time-symmetry result is established that enhance the numerical stability of the numerical optimal control solver used for generating the motion primitives. Moreover, a nonlinear observer for state estimation is developed which only utilizes information from sensors that are mounted on the truck, making the system independent of additional trailer sensors. The proposed framework is implemented on a full-scale truck with a dolly-steered trailer and results from a series of field experiments are presented.