From 0ed631227f0e5b4efc414e5a0a95f236eb3267b1 Mon Sep 17 00:00:00 2001 From: David Sidrane Date: Mon, 4 Dec 2017 11:50:33 -1000 Subject: [PATCH] fxos8701cq:Work with fxos8701cq and fxos8700cq Allow whoami of fxos8701cq and fxos8700cq --- src/drivers/imu/fxos8701cq/fxos8701cq.cpp | 6 ++++-- 1 file changed, 4 insertions(+), 2 deletions(-) diff --git a/src/drivers/imu/fxos8701cq/fxos8701cq.cpp b/src/drivers/imu/fxos8701cq/fxos8701cq.cpp index 77188a0143..e4f7311740 100644 --- a/src/drivers/imu/fxos8701cq/fxos8701cq.cpp +++ b/src/drivers/imu/fxos8701cq/fxos8701cq.cpp @@ -98,6 +98,7 @@ # define XYZ_DATA_CFG_FS_8G (2 << XYZ_DATA_CFG_FS_SHIFTS) #define FXOS8701CQ_WHOAMI 0x0d +# define FXOS8700CQ_WHOAMI_VAL 0xC7 # define FXOS8701CQ_WHOAMI_VAL 0xCA #define FXOS8701CQ_CTRL_REG1 0x2a @@ -670,10 +671,11 @@ int FXOS8701CQ::probe() { /* verify that the device is attached and functioning */ - bool success = (read_reg(FXOS8701CQ_WHOAMI) == FXOS8701CQ_WHOAMI_VAL); + uint8_t whoami = read_reg(FXOS8701CQ_WHOAMI); + bool success = (whoami == FXOS8700CQ_WHOAMI_VAL) || (whoami == FXOS8701CQ_WHOAMI_VAL); if (success) { - _checked_values[0] = FXOS8701CQ_WHOAMI_VAL; + _checked_values[0] = whoami; return OK; }