martes, 4 de abril de 2017

usando servo motores




código en el cual hacemos funcionar los motores:

#include <Ultrasonic.h>

Ultrasonic ultrasonic(8,12); // (Trig PIN,Echo PIN)
Ultrasonic ultra(10,11);
//int sensor=2;
//int ult;
int sens;
int MderAvan=4;
int MderAtras=6;
int MizqAvan=5;
int MizqAtras=7;
int detec;
int valor1=0;
int valor;
void setup() {
  Serial.begin(9600);
  pinMode(sensor,INPUT);
  pinMode(ult, INPUT);
  pinMode(MderAvan,OUTPUT);
  pinMode(MizqAvan,OUTPUT);
  pinMode(MderAtras,OUTPUT);
  pinMode(MizqAtras,OUTPUT);
}

void avanzar(){
  pinMode(MderAvan,HIGH);
  pinMode(MizqAvan,HIGH);
  pinMode(MderAtras,LOW);
  pinMode(MizqAtras,LOW);

}
void atras(){
  pinMode(MderAvan,LOW);
  pinMode(MizqAvan,LOW);
  pinMode(MderAtras,HIGH);
  pinMode(MizqAtras,HIGH);

}
void girar(){
  pinMode(MderAvan,LOW);
  pinMode(MizqAvan,LOW);
  pinMode(MderAtras,LOW);
  pinMode(MizqAtras,LOW);

}


void loop()
{
  avanzar();
  delay(10000);
  atras();
  delay(10000);
  girar();
  delay(10000);
}

No hay comentarios:

Publicar un comentario