Useless_Box-kopia.txt

#include <LiquidCrystal.h>
#include <Servo.h>
#define PRZYCISK 8
#define SERVO 9
#define DALMIERZ_Echo 10
#define DALMIERZ_Trig 11

int odleglosc=0;
int obrot;
Servo serwo;
LiquidCrystal lcd(2,3,4,5,6,7); 
                          
void setup(){
  serwo.attach(SERVO);
  pinMode(PRZYCISK,INPUT_PULLUP);
  pinMode(DALMIERZ_Trig,OUTPUT);
  pinMode(DALMIERZ_Echo,INPUT); 
  lcd.begin(16, 2);   // Typ wiswietlacza 16x2 (ilosc znakow, ilosc wierszy)
  lcd.clear();
  
  lcd.setCursor(2,0); // Ustawienie kursora (pozycja, wiersz) 
  lcd.print("BEZUZYTECZNE");
  lcd.setCursor(4,1); 
  lcd.print("PUDELKO");
 
}

void loop(){
  // Otwarcie pudelka na zadanie poprzez przycisk na 8 sekund
  if(digitalRead(PRZYCISK)==LOW){
    serwo.write(180); // 180-w pelni otwarte, 0 - w pelni zamkniete
    lcd.clear();
    lcd.setCursor(1,0); 
    lcd.print("Czas otwarcia:");
    lcd.setCursor(5,1); 
    lcd.print("s");
    for(int i=0;i<9;i++){ //petla odliczajaca czas do zamkniecia
      lcd.setCursor(4,1); 
      lcd.print(8-i);
      delay(1000);
    }
  lcd.clear();
  lcd.setCursor(2,0);
  lcd.print("BEZUZYTECZNE");
  lcd.setCursor(4,1); 
  lcd.print("PUDELKO");
  }
  
  // Odczyt odleglosci osoby od pudelka
  digitalWrite(DALMIERZ_Trig, LOW);
  delayMicroseconds(2);
  digitalWrite(DALMIERZ_Trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(DALMIERZ_Trig, LOW);
  odleglosc=pulseIn(DALMIERZ_Echo, HIGH)/58;// 58 ms to czas dla ktorego dzwiek przebywa 1cm

  // Jezeli odleglosc jest mniejsza niz 18cm to stopniowo zamykaj pudelko serwem
  // w przeciwnym razie otworz w pelni
  if(odleglosc<18){
    obrot=odleglosc*10;
    serwo.write(obrot);
  }
    else{serwo.write(180);}
  delay(100);
}