MotionPlanner: cosmetic changes
MotionPlanner: micro-optimization
MotionPlanner: optimizations
MotionPlanner: micro-optimization
MotionPlanner: optimize by turning divisions into multiplications