Integrated motion planning and model learning for mobile robots with application to marine vehicles

Abstract

Robust motion planning algorithms for mobile robots consider stochasticity in the dynamic model of the vehicle and the environment. A practical robust planning approach balances the duration of the motion plan with the probability of colliding with obstacles. This thesis develops fast analytic algorithms for predicting the collision probability due to model uncertainty and random disturbances in the environment for a planar holonomic vehicle such as a marine surface vessel. These predictions lead to a robust motion planning algorithm that nds the optimal motion plan quickly and efficiently. By incorporating model learning into the predictions, the integrated algorithm exhibits emergent active learning strategies to autonomously acquire the model data needed to safely and eectively complete the mission. The motion planner constructs plans through a known environment by concatenating maneuvers based upon speed controller setpoints. A model-based feedforward/ feedback controller is used to track the resulting reference trajectory, and the model parameters are learned online with a least squares regression algorithm. The path-following performance of the vehicle depends on the effects of unknown environmental disturbances and modeling error. The convergence rate of the parameter estimates depends on the motion plan, as different plans excite different modes of the system.

(cont.) By predicting how the collision probability is affected by the parameter covariance evolution, the motion planner automatically incorporates active learning strategies into the motion plans. In particular, the vehicle will practice maneuvers in the open regions of the configuration space before using them in the constrained regions to ensure that the collision risk due to modeling error is low. High-level feedback across missions allows the system to recognize configuration changes and quickly learn new model parameters as necessary. Simulations and experimental results using an autonomous marine surface vessel are presented.