Test Motor PAP con final de carrera

/*EM 258 200 pasos en 360° 360/200= 1.8° cada paso Nominal Voltage 7
 * https://cdn-learn.adafruit.com/downloads/pdf/afmotor-library-reference.pdf
 * http://www.motors.wrobots.com/EM-258_17PM-K212-PIT.php
 */
#include <AFMotor.h>

// to motor port #2 (M3 and M4)
AF_Stepper motor(200, 1);// M1 200 pasos

bool sentido=false;//Sentido de giro
int pasos=1;

void setup() {
  Serial.begin(9600);

  pinMode(A5, INPUT);  //A5 como entrada
  pinMode(A5, INPUT_PULLUP);

  Serial.println("Icaro TEST PAP!");

  motor.setSpeed(10);  // Velocidad RPM
}

void loop() {

  //Serial.println (digitalRead(A5)); //Debug input 1 0

  if (digitalRead(A5)==0){//Cambio de sentido ha tocado el sensor

    sentido = ! sentido ;

    pasos=3; //Cambio de sentido tiene que alejarse del sensor a 0
    } else {pasos =1;} //No hay sensor paso a 1


  if (sentido ==true){
      motor.step(pasos, FORWARD, SINGLE); //Giro derecha
  }else{
     motor.step(pasos, BACKWARD, SINGLE); //Giro Izquierda
  }

}