Stappenmotor BYJ48 (4 / 4 stap)

Stap 4: Wijzig Code

de definitieve code voor deze stappenmotor:

/*
BYJ48 Stepper motor code
Verbinding maken:
IN1 >> D8
In2 >> D9
3 >> D10
IN4 >> D11
VCC... 5V Prefer te gebruiken externe 5V bron
GND
geschreven door: Mohannad Rawashdeh

28/9/2013
*/

#define IN1 8
#define IN2 9
#define 3 10
#define IN4 11
int stappen = 0;
Booleaanse richting = true; / / gre
unsigned long last_time;
unsigned long currentMillis;
int steps_left = 4095;
lange tijd;
VOID Setup
{
Serial.begin(115200);
pinMode (IN1, uitvoer);
pinMode (IN2, uitvoer);
pinMode (3, OUTPUT);
pinMode (IN4, uitvoer);
delay(1000);

}
void loop
{
while(steps_left>0) {}
currentMillis = micros();
Als (currentMillis-last_time > = 1000) {}
Stepper(1);
tijd = tijd + micros ()-last_time;
last_time=Micros();
steps_left--;
}
}
Serial.println(time);
Serial.println("wait...!");
delay(2000);
Richting =! Richting;
steps_left = 4095;
}

VOID stepper (int xw) {}
voor (int x = 0; x < xw; x ++) {}
switch(Steps) {}
Case 0:
digitalWrite (IN1, laag);
digitalWrite (IN2, laag);
digitalWrite (3, laag);
digitalWrite (IN4, hoge);
breken;
Case 1:
digitalWrite (IN1, laag);
digitalWrite (IN2, laag);
digitalWrite (3, hoge);
digitalWrite (IN4, hoge);
breken;
Case 2:
digitalWrite (IN1, laag);
digitalWrite (IN2, laag);
digitalWrite (3, hoge);
digitalWrite (IN4, laag);
breken;
Case 3:
digitalWrite (IN1, laag);
digitalWrite (IN2, hoge);
digitalWrite (3, hoge);
digitalWrite (IN4, laag);
breken;
Case 4:
digitalWrite (IN1, laag);
digitalWrite (IN2, hoge);
digitalWrite (3, laag);
digitalWrite (IN4, laag);
breken;
Case 5:
digitalWrite (IN1, hoge);
digitalWrite (IN2, hoge);
digitalWrite (3, laag);
digitalWrite (IN4, laag);
breken;
Case 6:
digitalWrite (IN1, hoge);
digitalWrite (IN2, laag);
digitalWrite (3, laag);
digitalWrite (IN4, laag);
breken;
Case 7:
digitalWrite (IN1, hoge);
digitalWrite (IN2, laag);
digitalWrite (3, laag);

digitalWrite (IN4, hoge);
breken;
standaard:
digitalWrite (IN1, laag);
digitalWrite (IN2, laag);
digitalWrite (3, laag);
digitalWrite (IN4, laag);
breken;
}
SetDirection();
}
}
VOID SetDirection() {}
if(Direction==1) {stappen ++;}
if(Direction==0) {stappen--;}
if(Steps>7) {stappen = 0;}
if(Steps<0) {stappen = 7;}
}