AxisStepper: fix debugging bug
MotionPlanner: fix inefficiency when homing.
When an endstop is pressed, we don't need to send any remaining
buffered motion through the planner and into execution, only to find yet
again that the endstop is pressed.