Advertisement
Guest User

Untitled

a guest
Apr 26th, 2015
192
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 2.16 KB | None | 0 0
  1. #include <AccelStepper.h> //carrega a biblioteca accelstepper
  2.  
  3. //===============================
  4. AccelStepper motor1(1, 8, 7); //configura o Easy driver para o motor1
  5. AccelStepper motor2(1, 12, 13); //configura o Easy driver para o motor2
  6. //===============================
  7. #define home1 2 // define o pino 2 como home1 - sensor de home
  8. #define end1  4 // define o pino 4 como end1 - sensor de fim de curso
  9. //===============================
  10. byte iniciar=0; // variavel para inicializacao do motores
  11. long rodamotor1;// variavel para girar o motor1
  12. long rodamotor2;// variavel para girar o motor2
  13. long posicaofinal1;
  14. long posicaofinal2;
  15. //=================
  16.  
  17. void setup()
  18. {
  19.   pinMode(end1,INPUT);       // configura o end1 como entrada
  20.   digitalWrite(end1,HIGH);   //liga o pullUp
  21.   pinMode(home1,INPUT);      //configura o home1 como entrada
  22.   digitalWrite(home1,HIGH);  //liga o pullUp
  23.   motor1.setMaxSpeed(1000);  //seta a maxima velocidade do motor1
  24.   motor1.setAcceleration(500.0);// seta a maxima aceleracao do motor1
  25.   motor2.setMaxSpeed(1000); // seta a maxima do motor2
  26.   motor2.setAcceleration(500.0);//seta a maxima acelercao do motor2
  27. }
  28.  
  29. void loop()
  30. {
  31.  
  32.  if(iniciar==0) //se a variavel inicio for zero...
  33. {
  34.   motor1.moveTo(10000); //configuara o quanto o motor1 vai andar
  35.   motor1.run();         //manda o motor1 andar
  36.  
  37.   if(home1==0)  // se o sensor de home1 for acionado...
  38.   {
  39.     motor1.setCurrentPosition(0); //carrega a posicao do motor1 como 0
  40.     motor1.moveTo(-10000); // configura o quanto o motor vai andar..
  41.     motor1.run(); //move o motor1 para -10000
  42.    
  43.   }
  44.  
  45.   if(end1==0)  // se o sensor de end1 for acionado...
  46.      {
  47.        motor1.targetPosition(); //adquire a posicao atual do motor1
  48.        posicaofinal1=motor1.targetPosition();//carrega o valor na variavel posicaofinal
  49.        motor1.moveTo(-10); //configura o quanto o motor1 vai andar
  50.        motor1.run(); //manda o motor para -10
  51.       }
  52.  
  53.    if(motor1.targetPosition() <= -10) // se o motor1 estiver na posição -10...
  54.       {
  55.         motor1.stop(); // para antes de bater no home1
  56.         iniciar = 1; // muda o valor da variavel iniciar para 1
  57.       }
  58.  
  59.    }
  60. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement