Programa Sigue-líneas

#include <Servo.h>

Servo esquerra;        

Servo dreta;  

int infrai = 4;

int infrad = 2;

int valori = 0;  

int valord=0;

void setup() {

 pinMode(infrai, INPUT);

 pinMode(infrad, INPUT);

 esquerra.attach(9);                          

 dreta.attach(10);

}

void loop() {

 valori = digitalRead(infrai);

 valord= digitalRead(infrad);

 if(valori=1&&valord=1){

esquerra.write(180);

dreta.write(0);    

 }

 else if(valori=1&&valord=0){

esquerra.write(180);

dreta.write(180);

 }

 

else if(valori=0&&valrd=1){

esquerra.write(0);

dreta.write(0);

 else{

esquerra.write(90);

dreta.write(90);

 }

}

Deja un comentario

Tu dirección de correo electrónico no será publicada. Los campos obligatorios están marcados con *

Este sitio usa Akismet para reducir el spam. Aprende cómo se procesan los datos de tus comentarios.