Diseño 3D y código del robot

Proyecto 

Diseño 3D:

Programación:

#include <Servo.h>

Servo move;

int tiempo;

int distancia;

int servoMin = 90;

int servoMid = 0;

int echo = 5;

int trig = 6;

int servo = 9;

void setup() {

  Serial.begin(9600);

  pinMode(trig, OUTPUT);

  pinMode(echo, INPUT);

  move.attach(servo);

  move.write(servoMin);

}

void loop() {

  move.write(servoMin);

  digitalWrite(trig, HIGH);

  delay(10);

  digitalWrite(trig, LOW);

  tiempo = pulseIn(echo, HIGH);

  distancia = tiempo / 58.2;  // Calcula la distancia en cm

  Serial.println(distancia);

  if (distancia < 8) {

    move.write(servoMid);

    digitalWrite(echo, LOW);

    delay(5000);

  } else {

  }

  delay(500);

}