Using BMP280 sensor to control servos. Need some guidance with coding

Projects General Guidance
33

Hello TomGeorge,

I did put a resistor in the circuit between the pin that the push button is connected to (pin2) and GND.
When I run the debounce button codes alone, it seemed to have worked just fine. Like when I pushed the button once, the LED lighted up, and when I pushed it again, the LED turned off. So I think the circuit should be okay.
I did a drawing of the circuit diagram and attached it here. Forgive me for my amateur circuit diagram :sweat_smile:(I never create a circuit diagram before, I still hope it helps to show what I have on my arduino and the wiring on my breadboard)

IMG_3469.HEIC
IMG_3469.HEIC4032×3024 2.7 MB

The wiring worked on moving the servos with the BMP280_DEV library that MartinL provided, and also worked with the debounce button codes. However, when I try to use it with my new attempt with the state machine code, things didn't go the way intended to be.
If you see anything that could be the issues, please let me know. Thanks for taking time to look at this!
Here is the debounce button codes for reference:

// constants won't change. They're used here to set pin numbers:
const int buttonPin = 2;    // the number of the pushbutton pin
const int ledPin = 13;      // 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 lastButtonState = 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 = 50;    // the debounce time; increase if the output flickers

void debounceButtonSetup () {
  pinMode(buttonPin, INPUT);
  pinMode(ledPin, OUTPUT);

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

}
void setup() {
  debounceButtonSetup ();
}

void debounceButtonPush () {

  // read the state of the switch into a local variable:
  int reading = digitalRead(buttonPin);

  // check to see if you just pressed the button
  // (i.e. the input went from LOW to HIGH), and you've waited long enough
  // since the last press to ignore any noise:

  // If the switch changed, due to noise or pressing:
  if (reading != lastButtonState) {
    // reset the debouncing timer
    lastDebounceTime = millis();
  }

  if ((millis() - lastDebounceTime) > debounceDelay) {
    // whatever the reading is at, it's been there for longer than the debounce
    // delay, so take it as the actual current state:

    // if the button state has changed:
    if (reading != buttonState) {
      buttonState = reading;

      // only toggle the LED if the new button state is HIGH
      if (buttonState == HIGH) {
        ledState = !ledState;
      }
    }
  }

  // set the LED:
  digitalWrite(ledPin, ledState);

  // save the reading. Next time through the loop, it'll be the lastButtonState:
  lastButtonState = reading;
}


void loop() {
  debounceButtonPush ();

}