From 6772058c8b55d3c981916ed1dc2c58395c1d98e6 Mon Sep 17 00:00:00 2001
From: Bananaman <70923176+Bananamannn@users.noreply.github.com>
Date: Wed, 18 May 2022 01:48:26 +1000
Subject: [PATCH] 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
---
 pio/src/iSpindel.cpp | 6 +++++-
 1 file changed, 5 insertions(+), 1 deletion(-)

diff --git a/pio/src/iSpindel.cpp b/pio/src/iSpindel.cpp
index 4dd33092..830c0935 100644
--- 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!"));