Hybrid PSO-PWL-Dijkstra approach for path planning of non holonomic platforms in dense contexts

Planning is an essential capability for autonomous robots. Many applications impose a diversity of constraints and traversing costs in addition to the usually considered requirement of obstacle avoidance. In applications such as route planning, the use of dense properties is convenient as these describe the terrain and other aspects of the context of operation more rigorously and are usually the result of a concurrent mapping and learning process. Unfortunately, planning for a platform with more than three degrees of freedom can be computationally expensive, particularly if the application requires the platform to optimally deal with a thorough description of the terrain. The objective of this thesis is to develop and demonstrate an efficient path planning algorithm based on dynamic programming. The goal is to compute paths for ground vehicles with and without trailers, that minimise a specified cost-to-go while taking into account dynamic constraints of the vehicle and dense properties of the environment. The proposed approach utilises a Quadtree Piece-Wise Linear (QT-PWL) approximation to describe the environment in a low dimensional subspace and later uses a particle approach to introduce the dynamic constraints of the vehicle and to smooth the path in the full dimensional configuration space. This implies that the optimisation process can exploit the QT-PWL partition. Many usual contexts of operation of autonomous platforms have cluttered spaces and large regions where the dense properties are smooth; therefore, the QT-PWL partition is able to represent the context in a fraction of cells that would be needed by a homogeneous grid. The proposed methodology includes adaptations to both algorithms to achieve higher efficiency of the computational cost and optimality of the planned path. In order to demonstrate the capabilities of the algorithm, an idealized test case is presented and discussed. The case for a car and a tractor with multiple trailers is presented. A real path planning example is presented in addition to the synthetic experiments. Finally, the experiments and results are analysed and conclusions and directions for possible future work are presented

Design, testing and validation of model predictive control for an unmanned ground vehicle

The rapid increase in designing, manufacturing, and using autonomous robots has attracted numerous researchers and industries in recent decades. The logical motivation behind this interest is the wide range of applications. For instance, perimeter surveillance, search and rescue missions, agriculture, and construction. In this thesis, motion planning and control based on model predictive control (MPC) for unmanned ground vehicles (UGVs) is tackled. In addition, different variants of MPC are designed, analysed, and implemented for such non-holonomic systems. It is imperative to focus on the ability of MPC to handle constraints as one of the motivations. Furthermore, the proliferation of computer processing enables these systems to work in a real-time scenario. The controller's responsibility is to guarantee an accurate trajectory tracking process to deal with other specifications usually not considered or solved by the planner. However, the separation between planner and controller is not necessarily defined uniquely, even though it can be a hybrid process, as seen in part of this thesis. Firstly, a robust MPC is designed and implemented for a small-scale autonomous bulldozer in the presence of uncertainties, which uses an optimal control action and a feed-forward controller to suppress these uncertainties. More precisely, a linearised variant of MPC is deployed to solve the trajectory tracking problem of the vehicle. Afterwards, a nonlinear MPC is designed and implemented to solve the path-following problem of the UGV for masonry in a construction context, where longitudinal velocity and yaw rate are employed as control inputs to the platform. For both the control techniques, several experiments are performed to validate the robustness and accuracy of the proposed scheme. Those experiments are performed under realistic localisation accuracy, provided by a typical localiser. Most conspicuously, a novel proximal planning and control strategy is implemented in the presence of skid-slip and dynamic and static collision avoidance for the posture control and tracking control problems. The ability to operate in moving objects is critical for UGVs to function well. The approach offers specific planning capabilities, able to deal at high frequency with context characteristics, which the higher-level planner may not well solve. Those context characteristics are related to dynamic objects and other terrain details detected by the platform's onboard perception capabilities. In the control context, proximal and interior-point optimisation methods are used for MPC. Relevant attention is given to the processing time required by the MPC process to obtain the control actions at each actual control time. This concern is due to the need to optimise each control action, which must be calculated and applied in real-time. Because the length of a prediction horizon is critical in practical applications, it is worth looking into in further detail. In another study, the accuracies of robust and nonlinear model predictive controllers are compared. Finally, a hybrid controller is proposed and implemented. This approach exploits the availability of a simplified cost-to-go function (which is provided by a higher-level planner); thus, the hybrid approach fuses, in real-time, the nominal CTG function (nominal terrain map) with the rest of the critical constraints, which the planner usually ignores. The conducted research fills necessary gaps in the application areas of MPC and UGVs. Both theoretical and practical contributions have been made in this thesis. Moreover, extensive simulations and experiments are performed to test and verify the working of MPC with a reasonable processing capability of the onboard process