-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathcodetong.cpp
36 lines (34 loc) · 1.06 KB
/
codetong.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
#include <Arduino.h>
#include <Wire.h>
#include <Servo.h>
Servo myservo;
#define trigPin 9
#define echoPin 10
long duration;
int distance = 0;
int pos = 0;
void setup()
{
myservo.attach(6);
pinMode(trigPin, OUTPUT); // setting triggerpin sebagai output
pinMode(echoPin, INPUT); // setting echopin sebagai Input
Serial.begin(9600); // setting kecepatan pengiriman serial monitor
}
void loop()
{
digitalWrite(trigPin, HIGH); // aktifkan sensor ultrasonic
delayMicroseconds(10); // selama 10 microseconds
digitalWrite(trigPin, LOW); // matikan sensor ultrasonic
duration = pulseIn(echoPin, HIGH); // baca rentan waktu dari trigPin High sampai echoPin high
distance = duration * 0.034 / 2; // konversi selang waktu ke CM
if (distance < 10) // Hanya menampilkan jarak jika jaraknya kurang dari 300 cm / 3 meter
{
Serial.println(distance); // kirim data jarak ke PC
myservo.write(140);
delay(3000);
}
else
{
myservo.write(0);
}
}