Vehículo autónomo Arduino (10 / 10 paso)

Paso 10: código.

Aquí está mi código.

//////////////////////////////////////////////////////

#include
Servo servo;

int servoPin = 5;

const int relé 1 = 10;

const int relé 2 = 11;

const int recto = 30, izquierda = 55, derecha = 5;

const int adelante = 1, freno = 0, posterior = -1;

void setup() {}

servo.Attach(servoPin);

servo.Write(30);

pinMode(RELAY2,OUTPUT);

pinMode(RELAY1,OUTPUT); }

void loop() {}

Go (1, derecho, 500);

ir (0, recta, 500);

Go (-1, izquierda, 500);

ir (0, recta, 500);

}

{} void go (int n, int direccion, int duración)

servo.Write(Direction);

if(n == forward) {}

digitalWrite(RELAY2,HIGH);

digitalWrite(RELAY1,LOW);

}

if(n == backward) {}

digitalWrite(RELAY2,LOW);

digitalWrite(RELAY1,HIGH);

} if(n == BREAK) {}

digitalWrite(RELAY2,LOW);

digitalWrite(RELAY1,LOW);

}

Delay(Duration);

}