Fixed motor stall by adding in stall detection time