■ Computer/ㅡArduino
아두이노 초음파센스 쓰레기통 코드
with seok
2020. 8. 22. 23:00
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