PRACTICA DE ROBOT MOVIL
- 1. NOMBRE: Leon Lago Orlando Celso
PRACTICA DE ROBOT MOVIL
CÓDIGO:
int SD = 12;
int SI = 13;
void setup() {
pinMode(2,OUTPUT); //In4-M2
pinMode(3,OUTPUT); //In3-M2
pinMode(4,OUTPUT); //In2-M1
pinMode(5,OUTPUT); //In1-M1
pinMode(SD, INPUT); //Derrecha
pinMode(SI, INPUT); //Izquierda
}
void loop() {
if(digitalRead(SD) == 0 && digitalRead(SI) == 0)
{
//STOP
digitalWrite(5,0); //M1
digitalWrite(4,0); //M1
digitalWrite(3,0); //M2
digitalWrite(2,0); //M2
//delay(3000);
}
if(digitalRead(SD) == 0 && digitalRead(SI) == 1)
{
// IZQUIERDA
digitalWrite(5,0); //M1
digitalWrite(4,1); //M1
digitalWrite(3,1); //M2
digitalWrite(2,0); //M2
//delay(3000);*/
}
if(digitalRead(SD) == 1 && digitalRead(SI) == 0)
{
// DERECHA
digitalWrite(5,1); //M1
digitalWrite(4,0); //M1