GoPro ultrasonique Motion Sensor HC-SR04 contrôlé par arduino (3 / 4 étapes)

Étape 3: Télécharger le code de votre arduino

Le code est simple, si quelque chose est 50 cm près du capteur, il activera le Servo, vous pouvez le changer à une distance de loin ou de près comme vous le souhaitez, vérifiez également l’angle de la servocommande, dans cet exemple, le bras du servo se déplace dans un angle de 40 degrés, il faut le changer si vous avez besoin de plus de force à appliquer à la touche de caméra GoPro.

Code :

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

void setup() {}
myservo.Attach(9) ;
myservo.Write(0) ;
Serial.Begin(9600) ;
pinMode (trigPin, sortie) ;
pinMode (echoPin, entrée) ;
}

void loop() {}
int durée, distance ;
digitalWrite (trigPin, HIGH) ;
delayMicroseconds(100) ;
digitalWrite (trigPin, basse) ;
durée = pulseIn (echoPin, HIGH) ;
distance = (durée/2) / 29,1 ;
Serial.Print(distance) ;
Serial.println ("cm") ;
int thisPitch = carte (distance, 0, 200, 2093, 22) ;
ton (4, thisPitch) ;
Delay(50) ;
noTone(4) ;
Si (distance < 50) {//Distance en cm
myservo.Write(40) ;       angle du bras du servo
retard (700) ;
myservo.Write(0) ;
retarder (2000) ;
}
}