Paso 9: Haga el robot en un "vagabundo de la tapa de tabla"
Este código es para un obstáculo evitando robot con un sensor de reflectived QRD 1114.
no dude en hacer cambios para mejorar o solucionar problemas.
const int Lf = 9; //forwards izquierda
const int Lb = 10; //backwards izquierda
const int Rf = 11; //forwards en derecho
const int Rb = 12; hacia atrás a la derecha
int val = 0; almacenar los datos de sensor
void setup() {}
pinMode (Lf, salida); salida del motor izquierdo
pinMode (Lb, salida); salida del motor izquierdo
pinMode (Rf, salida); salida motor derecho
pinMode (Rb, salida); salida motor derecho
pines analógicos establece automáticamente como entrada
}
void loop() {}
Val = analogRead(0); valor de la lectura del sensor de
Si (val > 100) {}
digitalWrite (Lf, LOW); / / dejar de ir hacia delante
digitalWrite (Rf baja); //stop va hacia adelante
digitalWrite (Lb, alto); / / volver a pieza objeto
digitalWrite (Rb, alto); //back de objeto
Delay(2500);
digitalWrite (Rb, LOW); //turn de objeto
Delay(2500);
digitalWrite (Lb, LOW); / / detiene
} else {}
digitalWrite (Lf, alto);
digitalWrite (Rf alta); ir hacia delante si no hay objeto
}
}
utilizando este código, con el sensor doblado hacia abajo, usted puede hacer su robot capaz de moverse alrededor de una mesa sola sin caerse.