Added support for MPU6500 basic functionality (#581)

* Update iSpindel.cpp * Update iSpindel.cpp * Update iSpindel.cpp * Update iSpindel.cpp * Update main.yml * Update iSpindel.cpp * Update iSpindel.cpp * Update iSpindel.cpp * Update main.yml
universam1 · May 17, 2022 · 6772058 · 6772058
1 parent f176848
commit 6772058
Showing 1 changed file with 5 additions and 1 deletion.
diff --git a/pio/src/iSpindel.cpp b/pio/src/iSpindel.cpp
@@ -974,7 +974,11 @@ bool testAccel()
   if (res != I2C_OK)
     CONSOLELN(String(F("I2C ERROR: ")) + res);
 
-  bool con = accelgyro.testConnection();
+  bool con = false;
+  auto id = accelgyro.getDeviceID();
+  if (id == 0x34 || id == 0x38) //0x34 = MPU6050 | 0x38 = MPU6500
+    con = true;
+
   if (!con)
     CONSOLELN(F("Acc Test Connection ERROR!"));