diff options
| author | Lorenz Meier <lm@inf.ethz.ch> | 2013-06-13 12:58:06 -0700 |
|---|---|---|
| committer | Lorenz Meier <lm@inf.ethz.ch> | 2013-06-13 12:58:06 -0700 |
| commit | 758ebf6c04206d78f817d91ef714ddf78cd8dc43 (patch) | |
| tree | 7650dd29a6d2d1e0f898fb474a3c601cdd7178b7 | |
| parent | 9444def5f861745da2716a443026e3d0bf061161 (diff) | |
| parent | 53f29a25b6c011d4cf4992a9eb1207a344ee75ae (diff) | |
| download | px4-firmware-758ebf6c04206d78f817d91ef714ddf78cd8dc43.tar.gz px4-firmware-758ebf6c04206d78f817d91ef714ddf78cd8dc43.tar.bz2 px4-firmware-758ebf6c04206d78f817d91ef714ddf78cd8dc43.zip | |
Merge pull request #6 from skelly/l3gd20h_support
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; |