'목록하단 광고 치환자(withSeok)
728x90
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
37
38
39
40
41
42
43
44
#include <Servo.h>
Servo servo_45c4R;
Servo servo_45c4L;
int EchoPin = 12;
int TrigPin = 13;
 
 
void setup() {
  // put your setup code here, to run once:
  pinMode(TrigPin, OUTPUT);
  pinMode(EchoPin, INPUT);
  //Serial.begin(9600);
  
  servo_45c4R.attach(9);
  servo_45c4R.write(0);
  servo_45c4L.attach(10);
  servo_45c4L.write(105);
}
void loop () {
  long duration, distance;
  duration=0;
  distance=0;
  digitalWrite(TrigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(TrigPin, LOW);
  duration = pulseIn(EchoPin, HIGH);
  distance = duration*0.01723;
  //Serial.print(distance);
  //Serial.print("cm");
  //Serial.println();
    
  if (distance < 10){
    servo_45c4R.attach(9);
    servo_45c4R.write(105);
    servo_45c4L.attach(10);
    servo_45c4L.write(0);
    delay(3000);     
    }
  servo_45c4R.attach(9);
  servo_45c4R.write(0); 
  servo_45c4L.attach(10);
  servo_45c4L.write(105); 
  delayMicroseconds(10);
}
cs
728x90

+ Recent posts