Enhancing Lattice-based Motion Planning with Introspective Learning and
  Reasoning
  Lattice-based motion planning is a hybrid planning method where a plan made
up of discrete actions simultaneously is a physically feasible trajectory. The
planning takes both discrete and continuous aspects into account, for example
action pre-conditions and collision-free action-duration in the configuration
space. Safe motion planing rely on well-calibrated safety-margins for collision
checking. The trajectory tracking controller must further be able to reliably
execute the motions within this safety margin for the execution to be safe. In
this work we are concerned with introspective learning and reasoning about
controller performance over time. Normal controller execution of the different
actions is learned using reliable and uncertainty-aware machine learning
techniques. By correcting for execution bias we manage to substantially reduce
the safety margin of motion actions. Reasoning takes place to both verify that
the learned models stays safe and to improve collision checking effectiveness
in the motion planner by the use of more accurate execution predictions with a
smaller safety margin. The presented approach allows for explicit awareness of
controller performance under normal circumstances, and timely detection of
incorrect performance in abnormal circumstances. Evaluation is made on the
nonlinear dynamics of a quadcopter in 3D using simulation. Video:
https://youtu.be/STmZduvSUMM
