unsigned long
motorTmr = 0,
processTmr= 0;
float
processDelay = 630, // Общее вращение
motorDelay = 1; // Для обмоток мотора
bool
currentDirection = false,
left_flag = 1,//false,
right_flag = 1;//false;
const byte
leftSensor = 8,
rightSensor = 9,
dirPin = 3,
stepPin = 2;
void setup(){Serial.begin(115200);
pinMode(leftSensor, INPUT);
pinMode(rightSensor, INPUT);
pinMode(dirPin, OUTPUT);
pinMode(stepPin, OUTPUT);
motorTmr = processTmr = millis();
}
void loop(){
if(digitalRead(leftSensor) && left_flag){
left_flag=0;
right_flag=1;
Serial.println("left");
processTmr = millis();
currentDirection = true;
}
if(digitalRead(rightSensor) && right_flag){
left_flag=1;
right_flag=0;
Serial.println("right");
processTmr = millis();
currentDirection =false ;
}
if (millis() - processTmr <= processDelay){
if(millis() - motorTmr >= motorDelay){
motorTmr = millis();
digitalWrite(dirPin, currentDirection);
digitalWrite(stepPin, !digitalRead(stepPin));
}
} else {
processTmr = millis();
currentDirection = !currentDirection;
}
}