Sensor ultrasonido HC-SR04 del movimiento de GoPro controlado por arduino (3 / 4 paso)

Paso 3: Subir el código a tu arduino

El código es simple si algo es 50 cm cerca del sensor, activa el Servo, se puede cambiar a una distancia lejana o cercana como usted desea, comprobar también el ángulo del servo, en este ejemplo el brazo del servo se mueve en un ángulo de 40 grados, tienes que cambiarlo si se necesita más fuerza para ser aplicado a la tecla de cámara GoPro.

Código:

#include < Servo.h >
Servo myservo;
#define trigPin 3
#define echoPin 2

void setup() {}
myservo.Attach(9);
myservo.Write(0);
Serial.Begin(9600);
pinMode (trigPin, salida);
pinMode (echoPin, entrada);
}

void loop() {}
int duración, distancia;
digitalWrite (trigPin, HIGH);
delayMicroseconds(100);
digitalWrite (trigPin, LOW);
duración = pulseIn (echoPin, HIGH);
distancia = (duración/2) / 29,1;
Serial.Print(Distance);
Serial.println ("cm");
int thisPitch = mapa (distancia, 0, 200, 2093, 22);
tono (4, thisPitch);
Delay(50);
noTone(4);
Si (distancia < 50) {//Distance en cm
myservo.Write(40);       ángulo del brazo de servo
retardo (700);
myservo.Write(0);
retrasar (2000);
}
}