|
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 45 46 47 48 49 50 |
#define Trig A4 #define Echo A5 int LED[]={6, 7, 8, 9, 10, 11, 12, 13}; long distances=0; int cnt=0; void setup() { Serial.begin(9600); pinMode(Trig, OUTPUT); pinMode(Echo, INPUT); for (int i=0;i<8;i++) { pinMode(LED[i], OUTPUT); } } void loop() { digitalWrite(Trig, LOW); delayMicroseconds(2); digitalWrite(Trig, HIGH); delayMicroseconds(10); digitalWrite(Trig, LOW); distances=(pulseIn(Echo, HIGH) / 29.1) / 2.0; Serial.print("Distance : "); Serial.println(distances); cnt=map(distances, 0, 100, 1, 8); for (int i=0;i<8;i++) { if (cnt > i) { digitalWrite(LED[i], HIGH); } else { digitalWrite(LED[i], LOW); } } delay(200); } |