Sie sind auf Seite 1von 5

//Motor paso a paso

//Código:

int A=8;

int B=9;

int C=10;

int D=11;

int PMIZDA;

int PMDCHA;

int PARO;

void setup(){

pinMode(3,INPUT);

pinMode(4,INPUT);

pinMode(5,INPUT);

pinMode(A, OUTPUT);

pinMode(B, OUTPUT);

pinMode(C, OUTPUT);

pinMode(D, OUTPUT);

//INICIAR EN PARO

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,LOW);

digitalWrite(D,LOW);

Serial.begin(9600);

void izquierda(){

// paso 1

digitalWrite(A,HIGH);

digitalWrite(B,LOW);

digitalWrite(C,LOW);
digitalWrite(D,LOW);

delay(10);

// paso 2

digitalWrite(A,HIGH);

digitalWrite(B,HIGH);

digitalWrite(C,LOW);

digitalWrite(D,LOW);

delay(10);

// paso 3

digitalWrite(A,LOW);

digitalWrite(B,HIGH);

digitalWrite(C,LOW);

digitalWrite(D,LOW);

delay(10);

// paso 4

digitalWrite(A,LOW);

digitalWrite(B,HIGH);

digitalWrite(C,HIGH);

digitalWrite(D,LOW);

delay(10);

// paso 5

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,HIGH);

digitalWrite(D,LOW);

delay(10);

// paso 6

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,HIGH);

digitalWrite(D,HIGH);
delay(10);

// paso 7

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,LOW);

digitalWrite(D,HIGH);

delay(10);

// paso 8

digitalWrite(A,HIGH);

digitalWrite(B,LOW);

digitalWrite(C,LOW);

digitalWrite(D,HIGH);

delay(10);

void derecha (){

// if(digitalWrite(A) == HIGH || digitalWrite(B) == HIGH || digitalWrite(C) == HIGH||


digitalWrite(D) == HIGH)

// paso 1

digitalWrite(A,HIGH);

digitalWrite(B,LOW);

digitalWrite(C,LOW);

digitalWrite(D,LOW);

delay(10);

// paso 2

digitalWrite(A,HIGH);

digitalWrite(B,HIGH);

digitalWrite(C,LOW);

digitalWrite(D,LOW);

delay(10);

// paso 3

digitalWrite(A,LOW);
digitalWrite(B,HIGH);

digitalWrite(C,LOW);

digitalWrite(D,LOW);

delay(10);

// paso 4

digitalWrite(A,LOW);

digitalWrite(B,HIGH);

digitalWrite(C,HIGH);

digitalWrite(D,LOW);

delay(10);

// paso 5

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,HIGH);

digitalWrite(D,LOW);

delay(10);

// paso 6

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,HIGH);

digitalWrite(D,HIGH);

delay(10);

// paso 7

digitalWrite(A,LOW);

digitalWrite(B,LOW);

digitalWrite(C,LOW);

digitalWrite(D,HIGH);

delay(10);

// paso 8

digitalWrite(A,HIGH);

digitalWrite(B,LOW);
digitalWrite(C,LOW);

digitalWrite(D,HIGH);

delay(10);

void loop() {

PMIZDA=digitalRead(3);

PMDCHA=digitalRead(4);

PARO=digitalRead(5);

if (PMIZDA==HIGH){

izquierda();

if ( PMDCHA==HIGH){

derecha();

if (PARO==HIGH);{

PMIZDA=LOW;

PMDCHA=LOW;

Das könnte Ihnen auch gefallen