Danny Eldering / Mbed 2 deprecated KXTJ3

KX022 Accelerometer library

Dependencies:   mbed

Dependents:   SP_BEUNBOX_code

Fork of KX022 by Rohm

Diff: KXTJ3.cpp

Revision:
5:9519f53d9965
Parent:
4:4038b02c530d
--- a/KXTJ3.cpp	Thu Oct 18 12:25:00 2018 +0000
+++ b/KXTJ3.cpp	Tue Feb 05 15:23:38 2019 +0000
@@ -56,17 +56,21 @@
         DEBUG_PRINT("Trying to config anyway, in case there is some compatible sensor connected.\n\r");
     }
 */
-    reg[0] = KXTJ3_CNTL1;
-    reg[1] = 0x40;
-    writeRegs(reg, 2);
+
+    readRegs(KXTJ3_CNTL1, reg, 1);
+    if(reg[0]!=0xC0){
+
+        reg[0] = KXTJ3_CNTL1;
+        reg[1] = 0x40;
+        writeRegs(reg, 2);
 
-    reg[0] = KXTJ3_ODCNTL;
-    reg[1] = 0x01;
-    writeRegs(reg, 2);
+        reg[0] = KXTJ3_ODCNTL;
+        reg[1] = 0x01;
+        writeRegs(reg, 2);
 
-    reg[0] = KXTJ3_CNTL1;
-    reg[1] = 0xC0;
-    writeRegs(reg, 2);
+        reg[0] = KXTJ3_CNTL1;
+        reg[1] = 0xC0;
+        writeRegs(reg, 2);}
 }
     
 float KXTJ3::getAccX()