/*
  Debounce

  Each time the input pin goes from LOW to HIGH (e.g. because of a push-button
  press), the output pin is toggled from LOW to HIGH or HIGH to LOW. There's a
  minimum delay between toggles to debounce the circuit (i.e. to ignore noise).

  The circuit:
  - LED attached from pin 13 to ground through 220 ohm resistor
  - pushbutton attached from pin 2 to +5V
  - 10 kilohm resistor attached from pin 2 to ground

  - Note: On most Arduino boards, there is already an LED on the board connected
    to pin 13, so you don't need any extra components for this example.

  created 21 Nov 2006
  by David A. Mellis
  modified 30 Aug 2011
  by Limor Fried
  modified 28 Dec 2012
  by Mike Walters
  modified 30 Aug 2016
  by Arturo Guadalupi

  This example code is in the public domain.

  https://www.arduino.cc/en/Tutorial/BuiltInExamples/Debounce
*/

// constants won't change. They're used here to set pin numbers:
const int buttonPin = A0;  // the number of the pushbutton pin
const int ledPin = 6;    // the number of the LED pin

// Variables will change:
int ledState = HIGH;        // the current state of the output pin
int buttonState;            // the current reading from the input pin
int lastVoltState = LOW;  // the previous reading from the input pin

// the following variables are unsigned longs because the time, measured in
// milliseconds, will quickly become a bigger number than can be stored in an int.

unsigned long lastDebounceTime = 0;  // the last time the output pin was toggled
unsigned long debounceDelay = 2000;


void setup() {
  Serial.begin(115200);
  pinMode(buttonPin, INPUT_PULLUP);
  pinMode(ledPin, OUTPUT);

  // set initial LED state
  digitalWrite(ledPin, ledState);
}

void loop() {

  static bool firstTime = true;
  static bool timedOut = false;

  // highVolts stands in for reading
  bool highVolts = digitalRead(buttonPin); //

  if (highVolts == true) {
    lastDebounceTime = millis(); // reset the timer
  }

  if ((millis() - lastDebounceTime) > debounceDelay) {
    timedOut == true;
    firstTime = false;
  }
  else timedOut = false;

  if (firstTime == false) {
    if (timedOut) digitalWrite(ledPin, HIGH);
    else digitalWrite(ledPin, LOW);
  }



  digitalWrite(ledPin, HIGH);

  // save the reading. Next time through the loop, it'll be the lastVoltState:
  lastVoltState = highVolts;
  Serial.print(firstTime);
  Serial.print("\t");
  Serial.println(timedOut);
}