MotionPlanner: Code cleanup.
MotionPlanning: Micro-optimization of backup buffer swapping.