Ebotics BXCAR01 Guia De Inicio Rapido página 3

necesario.
Código Arduino
1. Descarga el software Arduino
2. Abre el programa Arduino y, una vez en él, copia el siguiente programa:
int PinSpeedMA = 5, PinSpeedMB = 6;
VELOCIDAD DE LOS MOTORES
int PinTurnMA = 4, PinTurnMB = 7;
GIRO DE LOS MOTORES
int TrigPin = 13;
int EchoPin = 12;
float SSound = 0.0343;
long Lengh, Distance ;
cm
int PinLED1 = 9, PinLED2 = 10;
void setup() {
// put your setup code here, to run once:
//CONFIGURACIÓN DE LOS PUERTOS DIGITALES
pinMode(PinSpeedMA, OUTPUT);
pinMode(PinSpeedMB, OUTPUT);
pinMode(PinTurnMA, OUTPUT);
pinMode(PinTurnMB, OUTPUT);
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
pinMode(PinLED1, OUTPUT);
pinMode(PinLED2, OUTPUT);
// VELOCIDAD DE LOS MOTORES DE 100 A 255
analogWrite(PinSpeedMA, 175);
analogWrite(PinSpeedMB, 175);
}
void loop() {
// put your main code here, to run repeatedly:
DistanceCM();
if (( Distance < 25) && ( Distance > 1))
ENTRE 1 Y 25cm
{
digitalWrite(PinLED1,HIGH);//LED1 Y LED2 = ON
digitalWrite(PinLED2,HIGH);
digitalWrite(PinTurnMA,
digitalWrite(PinTurnMB, LOW);
delay(1000);
3
y realiza en proceso de instalación.
// PINES DEL SENSOR ULTRASONIDOS
//VELOCIDAD DEL SONIDO EN cm/us
// VARIABLES PARA CALCULAR LA DISTANCIA EN
// PIN DIGITAL LED1 Y LED2
// LLAMAR A LA FUNCIÓN PARA CALCULAR LA DISTANCIA
HIGH);// CODE&DRIVE HACIA ATRÁS
www.ebotics.com
// PIN DIGITAL PARA LA
// PIN DIGITAL PARA SENTIDO DE
// SI LA DISTANCIA ES