Advertisement
Guest User

Untitled

a guest
Jun 18th, 2019
89
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.53 KB | None | 0 0
  1.  
  2. //----ingressi stepper driver -----
  3. int PUL=9; //define Pulse pin
  4. int DIR=8; //define Direction pin
  5. int ENA=7; //define Enable Pin
  6. //----------------------------------
  7.  
  8. //----variabili per controllo reset-----
  9. int topLeft= 5;              //ingresso micro (posizionato a estrema sx)
  10. int readyTogoLed =6;          //led segnalazione avvenuto posizionamento
  11.  
  12. int resetLeft= 0;             //lelettura micro
  13. int stepperPosition=0;        //var per arrivo motore in posizione
  14. int zeroPosition = 0;
  15. int readyTogo = 0;
  16. void setup() {
  17.   pinMode (PUL, OUTPUT);
  18.   pinMode (DIR, OUTPUT);
  19.   pinMode (ENA, OUTPUT);
  20.   pinMode (readyTogoLed, OUTPUT);
  21.   pinMode (topLeft, INPUT);
  22.  Serial.begin (9600);  
  23.  
  24. }
  25. void positionReset(){
  26.  
  27.    while ( digitalRead(topLeft) == LOW)
  28.        {
  29.      
  30.         digitalWrite(DIR,HIGH);
  31.         digitalWrite(ENA,LOW);
  32.         digitalWrite(PUL,HIGH);
  33.         delayMicroseconds(500);
  34.         digitalWrite(PUL,LOW);
  35.         delayMicroseconds(500);}
  36.        
  37. }
  38. void loop() {
  39.  
  40.    resetLeft = digitalRead (topLeft);
  41.    readyTogo = zeroPosition;
  42.        
  43.      
  44.        if (readyTogo == 0){ positionReset(); }
  45.        if (resetLeft == 1){ zeroPosition = 1; }
  46.        if (readyTogo == 1){ digitalWrite(readyTogoLed, HIGH);      }
  47.         Serial.print( "stato micro...");
  48.         Serial.print(resetLeft);
  49.          Serial.print( "...motore in posizione...");
  50.         Serial.print(stepperPosition);
  51.         Serial.print( "...");
  52.         Serial.print( "stato reset avvio....");
  53.         Serial.println( readyTogo);
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement