wifi based on closest AP

src/main.cpp

@@ -13,13 +13,52 @@ unsigned int  maxReaderWaitTime = 9000; // Variable to timeout reader after too
 #endif
 
 #ifdef WIFI
-
 void connectToWiFi() {
+  int numNetworks = WiFi.scanNetworks();
+  int strongestSignal = -100; // Initialize with a low signal strength
+  int strongestIndex = -1; // Index of the strongest access point
+
+  #ifdef SERIAL_DEBUG
+    Serial.println("Scan complete");
+    Serial.print(numNetworks);
+    Serial.println(" networks found");
+
+    if (numNetworks > 0) {
+      Serial.println("Strongest networks:");
+      for (int i = 0; i < numNetworks; i++) {
+        String currentSSID = WiFi.SSID(i);
+        int currentSignal = WiFi.RSSI(i);
+        Serial.print(i + 1);
+        Serial.print(": ");
+        Serial.print(currentSSID);
+        Serial.print(" (");
+        Serial.print(currentSignal);
+        Serial.println(" dBm)");
+      }
+    }
+
+  #endif
+
+  for (int i = 0; i < numNetworks; i++) {
+    String currentSSID = WiFi.SSID(i);
+    int currentSignal = WiFi.RSSI(i);
+
+    if (currentSSID.equals(ssid) && currentSignal > strongestSignal) {
+      strongestSignal = currentSignal;
+      strongestIndex = i;
+    }
+  }
+
+  if (strongestIndex != -1) {
     WiFi.mode(WIFI_STA);
     WiFi.begin(ssid, password);
 
     #ifdef SERIAL_DEBUG
-  Serial.print("Connecting to WiFi ..");
+      Serial.print("Connecting to WiFi ");
+      Serial.print(ssid);
+      Serial.print(" (Signal Strength: ");
+      Serial.print(strongestSignal);
+      Serial.println(" dBm)...");
     #endif
 
     unsigned long startTime = millis(); // Record the start time of connection
@@ -43,6 +82,11 @@ void connectToWiFi() {
     #ifdef SERIAL_DEBUG
       Serial.println("WiFi connected");
     #endif
+  } else {
+    #ifdef SERIAL_DEBUG
+      Serial.println("No access point with SSID " + String(ssid) + " found");
+    #endif
+  }
 }
 
 void GetWifiInfo(){