GoPro ultrasone Motion Sensor HC-SR04 gecontroleerd door arduino (3 / 4 stap)

Stap 3: De code uploaden naar je arduino

De code is eenvoudig als iets is 50 cm in de buurt van de sensor, de Servo zal activeren, kunt u het tot op een afstand van ver of dichtbij als u wilt, ook de hoek van de servo controleren, in dit voorbeeld de arm van de servo in een hoek van 40 graden verplaatsen zullen, u hebt om het te veranderen moet u meer kracht moet worden toegepast op de knoop van de camera van 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, OUTPUT);
pinMode (echoPin, INPUT);
}

void loop {}
int duur, afstand;
digitalWrite (trigPin, hoge);
delayMicroseconds(100);
digitalWrite (trigPin, laag);
duur = pulseIn (echoPin, hoge);
afstand = (duur/2) / 29.1;
Serial.Print(distance);
Serial.println ("cm");
int thisPitch = kaart (afstand, 0, 200, 2093, 22);
Toon (4, thisPitch);
delay(50);
noTone(4);
Als (< 50 afstand) {//Distance in cm
myservo.write(40);       hoek van de servo arm
vertraging (700);
myservo.write(0);
vertraging (2000);
}
}