Added stall detect to reverse direction

Added stall detect to reverse direction.