diff options
author | Sam Kelly <sam@3drobotics.com> | 2013-06-13 12:51:50 -0700 |
---|---|---|
committer | Sam Kelly <sam@3drobotics.com> | 2013-06-13 12:51:50 -0700 |
commit | 53f29a25b6c011d4cf4992a9eb1207a344ee75ae (patch) | |
tree | 7650dd29a6d2d1e0f898fb474a3c601cdd7178b7 | |
parent | 9444def5f861745da2716a443026e3d0bf061161 (diff) | |
download | px4-firmware-53f29a25b6c011d4cf4992a9eb1207a344ee75ae.tar.gz px4-firmware-53f29a25b6c011d4cf4992a9eb1207a344ee75ae.tar.bz2 px4-firmware-53f29a25b6c011d4cf4992a9eb1207a344ee75ae.zip |
Added l3gd20h detection
-rw-r--r-- | src/drivers/l3gd20/l3gd20.cpp | 3 |
1 files changed, 2 insertions, 1 deletions
diff --git a/src/drivers/l3gd20/l3gd20.cpp b/src/drivers/l3gd20/l3gd20.cpp index 98098c83b..f47481823 100644 --- a/src/drivers/l3gd20/l3gd20.cpp +++ b/src/drivers/l3gd20/l3gd20.cpp @@ -78,6 +78,7 @@ static const int ERROR = -1; /* register addresses */ #define ADDR_WHO_AM_I 0x0F +#define WHO_I_AM_H 0xD7 #define WHO_I_AM 0xD4 #define ADDR_CTRL_REG1 0x20 @@ -351,7 +352,7 @@ L3GD20::probe() (void)read_reg(ADDR_WHO_AM_I); /* verify that the device is attached and functioning */ - if (read_reg(ADDR_WHO_AM_I) == WHO_I_AM) + if (read_reg(ADDR_WHO_AM_I) == WHO_I_AM || read_reg(ADDR_WHO_AM_I) == WHO_I_AM_H) return OK; return -EIO; |