From 75a2d7008094acb20c9c76a2cad893acedf751ae Mon Sep 17 00:00:00 2001 From: "Ben V. Brown" Date: Fri, 15 Jan 2021 22:45:53 +1100 Subject: [PATCH] Fix orientation --- workspace/TS100/Core/Drivers/SC7A20.hpp | 9 ++++----- 1 file changed, 4 insertions(+), 5 deletions(-) diff --git a/workspace/TS100/Core/Drivers/SC7A20.hpp b/workspace/TS100/Core/Drivers/SC7A20.hpp index 757c4f5f..f58214da 100644 --- a/workspace/TS100/Core/Drivers/SC7A20.hpp +++ b/workspace/TS100/Core/Drivers/SC7A20.hpp @@ -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(val); + return Orientation::ORIENTATION_FLAT; } static void getAxisReadings(int16_t &x, int16_t &y, int16_t &z);