Add saturation block to motor speed to avoid div/0 when motor is stopped