#include <WiFi.h>
#include <esp_wps.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET    -1  // Reset pin # (or -1 if sharing Arduino reset pin)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

#define ESP_WPS_MODE WPS_TYPE_PBC
esp_wps_config_t config = WPS_CONFIG_INIT_DEFAULT(ESP_WPS_MODE);

void setup() {
    Serial.begin(115200);

        // Initialize the display
            if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
                    Serial.println(F("SSD1306 allocation failed"));
                            for (;;);
                                }
                                    display.clearDisplay();
                                        display.setTextSize(1);
                                            display.setTextColor(WHITE);

                                                // Initialize Wi-Fi in STA mode
                                                    WiFi.mode(WIFI_MODE_STA);
                                                        WiFi.begin();

                                                            // Start WPS
                                                                esp_wifi_wps_enable(&config);
                                                                    esp_wifi_wps_start(0);

                                                                        // Show WPS status on the display
                                                                            display.setCursor(0, 0);
                                                                                display.println("WPS started...");
                                                                                    display.display();
                                                                                    }

                                                                                    void loop() {
                                                                                        // Continuously check the connection status
                                                                                            if (WiFi.status() == WL_CONNECTED) {
                                                                                                    display.clearDisplay();
                                                                                                            display.setCursor(0, 0);
                                                                                                                    display.println("Connected to Wi-Fi!");
                                                                                                                            display.print("IP: ");
                                                                                                                                    display.println(WiFi.localIP());
                                                                                                                                            display.display();

                                                                                                                                                    // Disable WPS after connection
                                                                                                                                                            esp_wifi_wps_disable();
                                                                                                                                                                } else {
                                                                                                                                                                        display.clearDisplay();
                                                                                                                                                                                display.setCursor(0, 0);
                                                                                                                                                                                        display.println("Trying to connect...");
                                                                                                                                                                                                display.display();
                                                                                                                                                                                                        delay(5000);
                                                                                                                                                                                                            }
                                                                                                                                                                                                            }