/* * Mengontrol Servo dengan Sensor Ultrasonic * Email :
[email protected] * www.b www.boarduino.blogspot.com oarduino.blogspot.com */ #include !ew"ing.h //$ibrary untu% Sensor Ultrasonic #include Servo.h //$ibrary untu% Servo #de&ine trig"in '( //Set )rigger +S,- di "in digital '( #de&ine echo"in ' //Set Echo +S,- di "in digital ' #de&ine M01234S)0!+E M01234S)0!+E 5-- //Set 6ara% ma%simal !ew"ing sonar7trig"in8 echo"in8 M01234S)0!+E9 M01234S)0!+E9 int $E3hi6au ; 8 $E3merah ; ( //Set "in $E3hi6au dan $E3merah Servo myservo //
ecepatan %omuni%asi serial pinMode7trig"in8 ?U)"U)9 //Set pin )rigger sebagai output pinMode7echo"in8 4!"U)9 //Set pin Echo sebagai input pinMode7$E3merah8 ?U)"U)9 //Set $E3merah sebagai output pinMode7$E3hi6au8 ?U)"U)9 //Set $E3hi6au sebagai output myservo.attach79 //Set servo pada pin "AM B void loop79 = int duration8 6ara%8posisi;-8i digitalArite7trig"in8 $?A9 delayMicroseconds7(9 digitalArite7trig"in8 4C9 delayMicroseconds7'-9 digitalArite7trig"in8 $?A9 duration ; pulse4n7echo"in8 4C9 6ara% ; 7duration/(9 / (.' Serial.print76ara%9 Serial.println7D cmD9 i&76ara%;'59 // ara% 7+m9 dapat anda sesuai%an = digitalArite7$E3hi6au8 $?A9 //$E3hi6au mati digitalArite7$E3merah8 4C9 //$E3merah hidup myservo.write7'F-9 //"osisi servo pada 'F'F- dera6at dera6at delay75-9 //3elay digitalArite7$E3merah8 $?A9 //$E3merah mati myservo.write7-9 //"osisi servo pada - dera6at dera6at delay75-9 //3elay
digitalArite7$E3merah8 4C9 //$E3merah hidup myservo.write7-9 //"osisi servo pada - dera6at delay75-9 //3elay digitalArite7$E3merah8 $?A9 //$E3merah mati myservo.write7-9 //"osisi servo pada - dera6at B else= //i%a 6ara% lebih dari yang ditentu%an digitalArite7$E3merah8 $?A9 //$E3merah mati digitalArite7$E3hi6au8 4C9 //$E3hi6au hidup myservo.write7-9 //"osisi servo pada - dera6at B delay75-9 //3elay B/* * Mengontrol Servo dengan Sensor Ultrasonic * Email :
[email protected] * www.boarduino.blogspot.com */ #include !ew"ing.h //$ibrary untu% Sensor Ultrasonic #include Servo.h //$ibrary untu% Servo #de&ine trig"in '( //Set )rigger +S,- di "in digital '( #de&ine echo"in ' //Set Echo +S,- di "in digital ' #de&ine M01234S)0!+E 5-- //Set 6ara% ma%simal !ew"ing sonar7trig"in8 echo"in8 M01234S)0!+E9 int $E3hi6au ; 8 $E3merah ; ( //Set "in $E3hi6au dan $E3merah Servo myservo //
ecepatan %omuni%asi serial pinMode7trig"in8 ?U)"U)9 //Set pin )rigger sebagai output pinMode7echo"in8 4!"U)9 //Set pin Echo sebagai input pinMode7$E3merah8 ?U)"U)9 //Set $E3merah sebagai output pinMode7$E3hi6au8 ?U)"U)9 //Set $E3hi6au sebagai output myservo.attach79 //Set servo pada pin "AM B void loop79 = int duration8 6ara%8posisi;-8i digitalArite7trig"in8 $?A9 delayMicroseconds7(9 digitalArite7trig"in8 4C9 delayMicroseconds7'-9 digitalArite7trig"in8 $?A9 duration ; pulse4n7echo"in8 4C9 6ara% ; 7duration/(9 / (.'
Serial.print76ara%9 Serial.println7D cmD9 i&76ara%;'59 // ara% 7+m9 dapat anda sesuai%an = digitalArite7$E3hi6au8 $?A9 //$E3hi6au mati digitalArite7$E3merah8 4C9 //$E3merah hidup myservo.write7'F-9 //"osisi servo pada 'F- dera6at delay75-9 //3elay digitalArite7$E3merah8 $?A9 //$E3merah mati myservo.write7-9 //"osisi servo pada - dera6at delay75-9 //3elay digitalArite7$E3merah8 4C9 //$E3merah hidup myservo.write7-9 //"osisi servo pada - dera6at delay75-9 //3elay digitalArite7$E3merah8 $?A9 //$E3merah mati myservo.write7-9 //"osisi servo pada - dera6at B else= //i%a 6ara% lebih dari yang ditentu%an digitalArite7$E3merah8 $?A9 //$E3merah mati digitalArite7$E3hi6au8 4C9 //$E3hi6au hidup myservo.write7-9 //"osisi servo pada - dera6at B delay75-9 //3elay B