better motion planning