MotionPlanner: Add forgotten change.
Implement a faster rounding function for AVR.