Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- MakeStepX(int direction, long stepPause){
- StepX += direction;
- if(StepX > 3){
- StepX = 0;
- }
- if(StepX < 0){
- StepX = 3;
- }
- //You might have to swap the sequence of steps!!!
- //If your motor doesn't rotate as expected, try:
- // StepX == 0 StepX == 1 StepX == 2 StepX == 3
- // 1 0 0 0 0 0 0 1 0 1 0 0 0 0 1 0
- // or:
- // StepX == 0 StepX == 1 StepX == 2 StepX == 3
- // 1 0 0 0 0 0 1 0 0 1 0 0 0 0 0 1
- // or:
- // StepX == 0 StepX == 1 StepX == 2 StepX == 3
- // 1 0 0 0 0 1 0 0 0 0 1 0 0 0 0 1
- // or:
- // StepX == 0 StepX == 1 StepX == 2 StepX == 3
- // 1 0 0 0 0 1 0 0 0 0 0 1 0 0 1 0
- if(StepX == 0){
- digitalWrite(X_STEPPER01, 1);
- digitalWrite(X_STEPPER02, 0);
- digitalWrite(X_STEPPER03, 0);
- digitalWrite(X_STEPPER04, 0);
- }
- if(StepX == 1){
- digitalWrite(X_STEPPER01, 0);
- digitalWrite(X_STEPPER02, 0);
- digitalWrite(X_STEPPER03, 1);
- digitalWrite(X_STEPPER04, 0);
- }
- if(StepX == 2){
- digitalWrite(X_STEPPER01, 0);
- digitalWrite(X_STEPPER02, 1);
- digitalWrite(X_STEPPER03, 0);
- digitalWrite(X_STEPPER04, 0);
- }
- if(StepX == 3){
- digitalWrite(X_STEPPER01, 0);
- digitalWrite(X_STEPPER02, 0);
- digitalWrite(X_STEPPER03, 0);
- digitalWrite(X_STEPPER04, 1);
- }
- usleep(stepPause);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement