some correction to work nice
Fork of L3GD20 by
Diff: L3GD20.cpp
- Revision:
- 2:90eddd0eff29
- Parent:
- 1:53d0deb65d1b
diff -r 53d0deb65d1b -r 90eddd0eff29 L3GD20.cpp --- a/L3GD20.cpp Tue Nov 12 17:25:28 2013 +0000 +++ b/L3GD20.cpp Sun Nov 17 17:59:04 2013 +0000 @@ -30,13 +30,7 @@ #include "L3GD20.h" -// Defines //////////////////////////////////////////////////////////////// -// The Arduino two-wire interface uses a 7-bit number for the address, -// and sets the last bit correctly based on reads and writes -// mbed I2C libraries take the 7-bit address shifted left 1 bit -// #define GYR_ADDRESS (0xD2 >> 1) -#define GYR_ADDRESS 0xD6 // Public Methods ////////////////////////////////////////////////////////////// @@ -65,9 +59,9 @@ if (recv(GYR_ADDRESS, L3GD20_OUT_X_L, (char *)gyr, 6)) { //scale is 8.75 mdps/digit - *gx = *((short *)gyr)*0.00875; //((((short)gyr[1]) << 8 )| gyr[0])*0.00875; - *gy = *((short *)(gyr+2))*0.00875; //((((short)gyr[3]) << 8 )| gyr[2])*0.00875; - *gz = *((short *)(gyr+4))*0.00875;//((((short)gyr[5]) << 8 )| gyr[4])*0.00875; + *gx = *((short *)gyr);//*0.00875; //((((short)gyr[1]) << 8 )| gyr[0])*0.00875; + *gy = *((short *)(gyr+2));//*0.00875; //((((short)gyr[3]) << 8 )| gyr[2])*0.00875; + *gz = *((short *)(gyr+4));//*0.00875;//((((short)gyr[5]) << 8 )| gyr[4])*0.00875; return true;