sv/IronOS
1
0
Fork 0
forked from me/IronOS
Code Pull Requests Activity

Fix orientation

Browse Source
This commit is contained in:
Ben V. Brown
2021-01-15 22:45:53 +11:00
parent 7e9ab6ae86
commit 75a2d70080
1 changed files with 4 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
workspace/TS100/Core/Drivers/SC7A20.hpp
View File

@@ -19,12 +19,11 @@ public:
static Orientation getOrientation() {
uint8_t val = ((FRToSI2C::I2C_RegisterRead(SC7A20_ADDRESS, SC7A20_INT2_SOURCE) >> 2) - 1);
if (val == 1)
val = 0;
else if (val == 0)
val = 1;
return Orientation::ORIENTATION_LEFT_HAND;
else if (val == 4 || val == 0)
return Orientation::ORIENTATION_RIGHT_HAND;
else
val = 3;
return static_cast<Orientation>(val);
return Orientation::ORIENTATION_FLAT;
}
static void getAxisReadings(int16_t &x, int16_t &y, int16_t &z);