//library micro servo
#include <Servo.h>
Servo servo;
//define dari sensor ultrasonic
const int TRIG_PIN = 2;
const int ECHO_PIN = 3;
//define dari sensor ultrasonic ke2
const int TRIG_PIN2 = 5;
const int ECHO_PIN2 = 6;
//define LED merah di pin 7
const int LED = 7;
long echotime;
int jarak = 0;
void setup()
{
servo.attach(4);
Serial.begin(9600);
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
digitalWrite(TRIG_PIN, LOW);
pinMode(TRIG_PIN2, OUTPUT);
pinMode(ECHO_PIN2, INPUT);
digitalWrite(TRIG_PIN2, LOW);
digitalWrite(LED,OUTPUT);
}
void loop()
{
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
echotime = pulseIn(ECHO_PIN, HIGH);
jarak = 0.034 * echotime / 2;
Serial.print("Jarak: ");
Serial.print(jarak);
Serial.println(" cm");
if (jarak < 100) {
servo.write(90);
} else {
servo.write(0);
}
delay(500);
}
{
//kodingan inti sensor ajak/ultrasonic
digitalWrite(TRIG_PIN2, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN2, LOW);
echotime = pulseIn(ECHO_PIN2, HIGH);
jarak = 0.0001* ((float)echotime*340.0)/2.0;
//print hasil bacaan melalui serial monitor
Serial.print("Jarak: ");
if (jarak <=10)
{
digitalWrite(LED,HIGH);
delay(2000);
}
else
{
digitalWrite(LED,LOW);
delay(2000);
}
}