Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- //----ingressi stepper driver -----
- int PUL=9; //define Pulse pin
- int DIR=8; //define Direction pin
- int ENA=7; //define Enable Pin
- //----------------------------------
- //----variabili per controllo reset-----
- int topLeft= 5; //ingresso micro (posizionato a estrema sx)
- int readyTogoLed =6; //led segnalazione avvenuto posizionamento
- int resetLeft= 0; //lelettura micro
- int stepperPosition=0; //var per arrivo motore in posizione
- int zeroPosition = 0;
- int readyTogo = 0;
- void setup() {
- pinMode (PUL, OUTPUT);
- pinMode (DIR, OUTPUT);
- pinMode (ENA, OUTPUT);
- pinMode (readyTogoLed, OUTPUT);
- pinMode (topLeft, INPUT);
- Serial.begin (9600);
- }
- void positionReset(){
- while ( digitalRead(topLeft) == LOW)
- {
- digitalWrite(DIR,HIGH);
- digitalWrite(ENA,LOW);
- digitalWrite(PUL,HIGH);
- delayMicroseconds(500);
- digitalWrite(PUL,LOW);
- delayMicroseconds(500);}
- }
- void loop() {
- resetLeft = digitalRead (topLeft);
- readyTogo = zeroPosition;
- if (readyTogo == 0){ positionReset(); }
- if (resetLeft == 1){ zeroPosition = 1; }
- if (readyTogo == 1){ digitalWrite(readyTogoLed, HIGH); }
- Serial.print( "stato micro...");
- Serial.print(resetLeft);
- Serial.print( "...motore in posizione...");
- Serial.print(stepperPosition);
- Serial.print( "...");
- Serial.print( "stato reset avvio....");
- Serial.println( readyTogo);
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement