Advanced motion planning