Zadanie z uzyciem Stepper.h
unknown
c_cpp
2 years ago
911 B
8
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