Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-30 04:06:33 +08:00
Code Issues Actions 9 Packages Projects Releases Wiki Activity

fxos8701cq:Work with fxos8701cq and fxos8700cq

Browse Source 
Allow whoami of fxos8701cq and fxos8700cq
This commit is contained in:
David Sidrane
2017-12-04 11:50:33 -10:00
committed by Beat Küng
parent 5335778f6e
commit 0ed631227f
1 changed files with 4 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/imu/fxos8701cq/fxos8701cq.cpp
+4 -2
View File
@@ -98,6 +98,7 @@
# define XYZ_DATA_CFG_FS_8G (2 << XYZ_DATA_CFG_FS_SHIFTS) # define XYZ_DATA_CFG_FS_8G (2 << XYZ_DATA_CFG_FS_SHIFTS)
#define FXOS8701CQ_WHOAMI 0x0d #define FXOS8701CQ_WHOAMI 0x0d
# define FXOS8700CQ_WHOAMI_VAL 0xC7
# define FXOS8701CQ_WHOAMI_VAL 0xCA # define FXOS8701CQ_WHOAMI_VAL 0xCA
#define FXOS8701CQ_CTRL_REG1 0x2a #define FXOS8701CQ_CTRL_REG1 0x2a
@@ -670,10 +671,11 @@ int
FXOS8701CQ::probe() FXOS8701CQ::probe()
{ {
/* verify that the device is attached and functioning */ /* 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) { if (success) {
_checked_values[0] = FXOS8701CQ_WHOAMI_VAL; _checked_values[0] = whoami;
return OK; return OK;
} }