Miernik odległości z paskiem świetlnym

// Miernik odległości z paskiem świetlnym
// Im bliżej jesteś, tym więcej lampek świeci: zielone, potem pomarańczowe, potem czerwone.

#include <Adafruit_NeoPixel.h>

const int TRIG_PIN = 9;     // Trig z HC-SR04 na pin 9
const int ECHO_PIN = 10;    // Echo z HC-SR04 na pin 10
const int RING_PIN = 6;     // DI z pierścienia LED na pin 6
const int LICZBA_LED = 8;
const int MAX_ODLEGLOSC = 80; // Dalej niż to (w cm): wszystkie lampki zgaszone

Adafruit_NeoPixel pierscien(LICZBA_LED, RING_PIN, NEO_GRB + NEO_KHZ800);

long zmierzOdleglosc() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  long czas = pulseIn(ECHO_PIN, HIGH, 30000);
  if (czas == 0) return 999;
  return czas / 58;
}

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pierscien.begin();
  pierscien.setBrightness(40);
  pierscien.show();
}

void loop() {
  long odleglosc = zmierzOdleglosc();
  Serial.print(F("Odleglosc: "));
  Serial.print(odleglosc);
  Serial.println(F(" cm"));

  // Ile lampek ma świecić? Blisko = 8, daleko = 0
  int liczba = map(constrain(odleglosc, 0, MAX_ODLEGLOSC), 0, MAX_ODLEGLOSC, LICZBA_LED, 0);

  for (int i = 0; i < LICZBA_LED; i++) {
    if (i < liczba) {
      if (i < 3)      pierscien.setPixelColor(i, pierscien.Color(0, 255, 0));    // Zielony
      else if (i < 6) pierscien.setPixelColor(i, pierscien.Color(255, 120, 0));  // Pomarańczowy
      else            pierscien.setPixelColor(i, pierscien.Color(255, 0, 0));    // Czerwony
    } else {
      pierscien.setPixelColor(i, 0);                                        // Wyłączone
    }
  }
  pierscien.show();
  delay(100);
}