#include <Servo.h>
#include <PinButton.h>
#include <LiquidCrystal.h>
#include "CountDown.h"

CountDown CD(CountDown::SECONDS);

Servo servo1;
int taster = 7;
int taster_status = 0;
int servo_status = 0;
uint32_t start, stop;
LiquidCrystal lcd(12, 11, 5, 4, 3, 2);

void setup() {
  servo1.attach(6);
  servo1.write(servo_status);
  pinMode(taster, INPUT);
  lcd.begin(16, 2);
}


void zaehneputzen() {
  lcd.setCursor(0, 0);
  lcd.print("KNOPF DRUECKEN ~");
  taster_status = digitalRead(taster);
  if (taster_status == HIGH) {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("  LOS GEHT ES!");
    lcd.setCursor(0, 1);
    lcd.print(" # # # # # # # # #");
    delay(2000);
    lcd.clear();
    if (servo_status == 0) {
      servo_status = 180;
    } else if (servo_status == 180) {
      servo_status = 0;
    }
    servo1.write(servo_status);
    start = millis();
    CD.start(5);

    while (CD.remaining() > 0 ) {
      lcd.setCursor(0, 0);
      lcd.print(CD.remaining());
      if (CD.remaining() <= 0) {
        lcd.clear();
        lcd.setCursor(0, 0);
        lcd.print("COLIN IST FERTIG!");
        lcd.setCursor(0, 1);
        lcd.print(" :D :D :D :D :D");
        delay(2000);
        lcd.clear();
        CD.restart();
        return;
      } 
    }
  }
}

void loop() {
  zaehneputzen();
}