Add test features for ESP-Now menu

Only available in developer mode

Author: nseidle

Firmware/RTK_Surveyor/menuMain.ino

@@ -338,6 +338,10 @@ void menuRadio()
 
       Serial.println("2) Pair radios");
       Serial.println("3) Forget all radios");
+#ifdef ENABLE_DEVELOPER
+      Serial.println("4) Add dummy radio");
+      Serial.println("5) Send dummy data");
+#endif
     }
 
     Serial.println("x) Exit");
@@ -406,6 +410,34 @@ void menuRadio()
         Serial.println("Radios forgotten");
       }
     }
+#ifdef ENABLE_DEVELOPER
+    else if (settings.radioType == RADIO_ESPNOW && incoming == 4)
+    {
+      //TODO remove
+      uint8_t peer1[] = {0xB8, 0xD6, 0x1A, 0x0D, 0x8F, 0x9C}; //Facet
+      if (esp_now_is_peer_exist(peer1) == true)
+        log_d("Peer already exists");
+      else
+      {
+        //Add new peer to system
+        espnowAddPeer(peer1);
+
+        //Record this MAC to peer list
+        memcpy(settings.espnowPeers[settings.espnowPeerCount], peer1, 6);
+        settings.espnowPeerCount++;
+        settings.espnowPeerCount %= ESPNOW_MAX_PEERS;
+        recordSystemSettings();
+      }
+
+      espnowSetState(ESPNOW_PAIRED);
+    }
+    else if (settings.radioType == RADIO_ESPNOW && incoming == 5)
+    {
+      //TODO remove
+      uint8_t espnowData[] = "This is the long string to test how quickly we can send one string to the other unit. I am going to need a much longer sentence if I want to get a long amount of data into one transmission. This is nearing 200 characters but needs to be near 250.";
+      esp_now_send(0, (uint8_t *) &espnowData, sizeof(espnowData)); //Send packet to all peers
+    }
+#endif
 
     else if (incoming == STATUS_PRESSED_X)
       break;