Zadanie z uzyciem Stepper.h

 avatar
unknown
c_cpp
a year ago
911 B
6
Indexable
#include <Stepper.h>
int kroki=1000;
int count=0;
long int opoznienie_us =10000;
#define IN1 23
#define IN2 22
#define IN3 18
#define IN4 5

Stepper krokowy(kroki, IN1, IN3, IN2, IN4);
bool prawo =false;
bool lewo =false;

void setup() {

 krokowy.setSpeed(3);
  pinMode(33, INPUT_PULLUP);
  pinMode(32, INPUT_PULLUP);

  pinMode(23, OUTPUT);
  pinMode(22, OUTPUT);
  pinMode(18, OUTPUT);
  pinMode(5, OUTPUT);
  pinMode(LED_BUILTIN, OUTPUT);

  
  Serial.begin(115200);

}

void loop() {
 
prawo= digitalRead(33);
lewo= digitalRead(32);

if(prawo == true && lewo == false){
  digitalWrite(LED_BUILTIN, HIGH);
  
  krokowy.step(kroki);
  delayMicroseconds(opoznienie_us);
}
if(prawo == false && lewo == true){
  digitalWrite(LED_BUILTIN, HIGH);
  
  krokowy.step(-kroki);
  delayMicroseconds(opoznienie_us);
  
}
else{
  digitalWrite(LED_BUILTIN, LOW);


}
}
Editor is loading...
Leave a Comment