Papermind

hcsr04

Dec 29th, 2017
346
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.95 KB | None | 0 0
  1. const int trig = 11;
  2. const int echo = 10;
  3. const int DC = 9;
  4. int led = 13;
  5. int jarak = 0;
  6. long durasi=0;
  7.  
  8. void setup() {
  9.   Serial.begin(9600);
  10.   pinMode(trig, OUTPUT);
  11.   pinMode(echo, INPUT);
  12.   pinMode (DC, OUTPUT);
  13.   pinMode(led, OUTPUT);
  14. }
  15.  
  16. void loop() {
  17. digitalWrite(trig, LOW);
  18.  delayMicroseconds(2);
  19.  digitalWrite(trig, HIGH);
  20.  delayMicroseconds(10);
  21.  digitalWrite(trigPin, LOW);
  22.  duration = pulseIn(echo, HIGH);
  23.  jarak = (duration/2) / 29.1;
  24.  Serial.println(jarak); //menampilkan nilai jarak dalam centimeter
  25. if  (jarak >= 10) {
  26.   int val = map(jarak, 10, 300, 70, 255); //membuat skala nilai jarak menjadi nilai PWM
  27.   analogWrite(DC, val); //memberikan nilai PWM berdasarkan nilai val
  28.   digitalWrite(led, HIGH);
  29.       delay(val); //buat delay berdasarkan nillai val
  30.       digitalWrite (led, LOW);  
  31.       }
  32. else{ //jika jarak kurang dari 10 cm, maka motor akan berhenti.
  33.   digitalWrite(led, LOW);
  34.   digitalWrite(DC, LOW);         }}
Advertisement
Add Comment
Please, Sign In to add comment