MotionPlanner: implement a distance-relative speed limit
Improve implementation of cartesian speed limit.