Fix orientation
This commit is contained in:
@@ -19,12 +19,11 @@ public:
|
|||||||
static Orientation getOrientation() {
|
static Orientation getOrientation() {
|
||||||
uint8_t val = ((FRToSI2C::I2C_RegisterRead(SC7A20_ADDRESS, SC7A20_INT2_SOURCE) >> 2) - 1);
|
uint8_t val = ((FRToSI2C::I2C_RegisterRead(SC7A20_ADDRESS, SC7A20_INT2_SOURCE) >> 2) - 1);
|
||||||
if (val == 1)
|
if (val == 1)
|
||||||
val = 0;
|
return Orientation::ORIENTATION_LEFT_HAND;
|
||||||
else if (val == 0)
|
else if (val == 4 || val == 0)
|
||||||
val = 1;
|
return Orientation::ORIENTATION_RIGHT_HAND;
|
||||||
else
|
else
|
||||||
val = 3;
|
return Orientation::ORIENTATION_FLAT;
|
||||||
return static_cast<Orientation>(val);
|
|
||||||
}
|
}
|
||||||
static void getAxisReadings(int16_t &x, int16_t &y, int16_t &z);
|
static void getAxisReadings(int16_t &x, int16_t &y, int16_t &z);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user