Increase switchDistance and maxDownPath*.

This reduces overshoot during waypoint transitions.
Clear missions list before filling it again.

Resulted in leftover waypoints if you switched from a bigger mission list to a smaller
one without clearing the MATLAB workspace.