Check if BLE is connected --> print error message otherwise

ChrGri · Nov 22, 2023 · db502a4 · db502a4
1 parent 91060f6
commit db502a4
Showing 1 changed file with 13 additions and 3 deletions.
diff --git a/Arduino/Esp32/Main/Controller.cpp b/Arduino/Esp32/Main/Controller.cpp
@@ -61,9 +61,19 @@ static const int16_t JOYSTICK_RANGE = JOYSTICK_MAX_VALUE - JOYSTICK_MIN_VALUE;
 
   void SetControllerOutputValue(int32_t value) {
     //bleGamepad.setBrake(value);
-    bleGamepad.setAxes(value, 0, 0, 0, 0, 0, 0, 0);
-    bleGamepad.sendReport();
-    //Serial.println(value);
+
+    if (bleGamepad.isConnected() )
+    {
+      bleGamepad.setAxes(value, 0, 0, 0, 0, 0, 0, 0);
+      bleGamepad.sendReport();
+    }
+    else
+    {
+      Serial.println("BLE not connected!");
+      delay(500);
+    }
+
+
   }
 
 #endif