diff options
Diffstat (limited to 'src/input_common/helpers/joycon_protocol/calibration.cpp')
| -rw-r--r-- | src/input_common/helpers/joycon_protocol/calibration.cpp | 53 |
1 files changed, 28 insertions, 25 deletions
diff --git a/src/input_common/helpers/joycon_protocol/calibration.cpp b/src/input_common/helpers/joycon_protocol/calibration.cpp index d8f040f75..1300ecaf5 100644 --- a/src/input_common/helpers/joycon_protocol/calibration.cpp +++ b/src/input_common/helpers/joycon_protocol/calibration.cpp | |||
| @@ -3,6 +3,7 @@ | |||
| 3 | 3 | ||
| 4 | #include <cstring> | 4 | #include <cstring> |
| 5 | 5 | ||
| 6 | #include "common/input.h" | ||
| 6 | #include "input_common/helpers/joycon_protocol/calibration.h" | 7 | #include "input_common/helpers/joycon_protocol/calibration.h" |
| 7 | #include "input_common/helpers/joycon_protocol/joycon_types.h" | 8 | #include "input_common/helpers/joycon_protocol/joycon_types.h" |
| 8 | 9 | ||
| @@ -11,28 +12,29 @@ namespace InputCommon::Joycon { | |||
| 11 | CalibrationProtocol::CalibrationProtocol(std::shared_ptr<JoyconHandle> handle) | 12 | CalibrationProtocol::CalibrationProtocol(std::shared_ptr<JoyconHandle> handle) |
| 12 | : JoyconCommonProtocol(std::move(handle)) {} | 13 | : JoyconCommonProtocol(std::move(handle)) {} |
| 13 | 14 | ||
| 14 | DriverResult CalibrationProtocol::GetLeftJoyStickCalibration(JoyStickCalibration& calibration) { | 15 | Common::Input::DriverResult CalibrationProtocol::GetLeftJoyStickCalibration( |
| 16 | JoyStickCalibration& calibration) { | ||
| 15 | ScopedSetBlocking sb(this); | 17 | ScopedSetBlocking sb(this); |
| 16 | DriverResult result{DriverResult::Success}; | 18 | Common::Input::DriverResult result{Common::Input::DriverResult::Success}; |
| 17 | JoystickLeftSpiCalibration spi_calibration{}; | 19 | JoystickLeftSpiCalibration spi_calibration{}; |
| 18 | bool has_user_calibration = false; | 20 | bool has_user_calibration = false; |
| 19 | calibration = {}; | 21 | calibration = {}; |
| 20 | 22 | ||
| 21 | if (result == DriverResult::Success) { | 23 | if (result == Common::Input::DriverResult::Success) { |
| 22 | result = HasUserCalibration(SpiAddress::USER_LEFT_MAGIC, has_user_calibration); | 24 | result = HasUserCalibration(SpiAddress::USER_LEFT_MAGIC, has_user_calibration); |
| 23 | } | 25 | } |
| 24 | 26 | ||
| 25 | // Read User defined calibration | 27 | // Read User defined calibration |
| 26 | if (result == DriverResult::Success && has_user_calibration) { | 28 | if (result == Common::Input::DriverResult::Success && has_user_calibration) { |
| 27 | result = ReadSPI(SpiAddress::USER_LEFT_DATA, spi_calibration); | 29 | result = ReadSPI(SpiAddress::USER_LEFT_DATA, spi_calibration); |
| 28 | } | 30 | } |
| 29 | 31 | ||
| 30 | // Read Factory calibration | 32 | // Read Factory calibration |
| 31 | if (result == DriverResult::Success && !has_user_calibration) { | 33 | if (result == Common::Input::DriverResult::Success && !has_user_calibration) { |
| 32 | result = ReadSPI(SpiAddress::FACT_LEFT_DATA, spi_calibration); | 34 | result = ReadSPI(SpiAddress::FACT_LEFT_DATA, spi_calibration); |
| 33 | } | 35 | } |
| 34 | 36 | ||
| 35 | if (result == DriverResult::Success) { | 37 | if (result == Common::Input::DriverResult::Success) { |
| 36 | calibration.x.center = GetXAxisCalibrationValue(spi_calibration.center); | 38 | calibration.x.center = GetXAxisCalibrationValue(spi_calibration.center); |
| 37 | calibration.y.center = GetYAxisCalibrationValue(spi_calibration.center); | 39 | calibration.y.center = GetYAxisCalibrationValue(spi_calibration.center); |
| 38 | calibration.x.min = GetXAxisCalibrationValue(spi_calibration.min); | 40 | calibration.x.min = GetXAxisCalibrationValue(spi_calibration.min); |
| @@ -47,28 +49,29 @@ DriverResult CalibrationProtocol::GetLeftJoyStickCalibration(JoyStickCalibration | |||
| 47 | return result; | 49 | return result; |
| 48 | } | 50 | } |
| 49 | 51 | ||
| 50 | DriverResult CalibrationProtocol::GetRightJoyStickCalibration(JoyStickCalibration& calibration) { | 52 | Common::Input::DriverResult CalibrationProtocol::GetRightJoyStickCalibration( |
| 53 | JoyStickCalibration& calibration) { | ||
| 51 | ScopedSetBlocking sb(this); | 54 | ScopedSetBlocking sb(this); |
| 52 | DriverResult result{DriverResult::Success}; | 55 | Common::Input::DriverResult result{Common::Input::DriverResult::Success}; |
| 53 | JoystickRightSpiCalibration spi_calibration{}; | 56 | JoystickRightSpiCalibration spi_calibration{}; |
| 54 | bool has_user_calibration = false; | 57 | bool has_user_calibration = false; |
| 55 | calibration = {}; | 58 | calibration = {}; |
| 56 | 59 | ||
| 57 | if (result == DriverResult::Success) { | 60 | if (result == Common::Input::DriverResult::Success) { |
| 58 | result = HasUserCalibration(SpiAddress::USER_RIGHT_MAGIC, has_user_calibration); | 61 | result = HasUserCalibration(SpiAddress::USER_RIGHT_MAGIC, has_user_calibration); |
| 59 | } | 62 | } |
| 60 | 63 | ||
| 61 | // Read User defined calibration | 64 | // Read User defined calibration |
| 62 | if (result == DriverResult::Success && has_user_calibration) { | 65 | if (result == Common::Input::DriverResult::Success && has_user_calibration) { |
| 63 | result = ReadSPI(SpiAddress::USER_RIGHT_DATA, spi_calibration); | 66 | result = ReadSPI(SpiAddress::USER_RIGHT_DATA, spi_calibration); |
| 64 | } | 67 | } |
| 65 | 68 | ||
| 66 | // Read Factory calibration | 69 | // Read Factory calibration |
| 67 | if (result == DriverResult::Success && !has_user_calibration) { | 70 | if (result == Common::Input::DriverResult::Success && !has_user_calibration) { |
| 68 | result = ReadSPI(SpiAddress::FACT_RIGHT_DATA, spi_calibration); | 71 | result = ReadSPI(SpiAddress::FACT_RIGHT_DATA, spi_calibration); |
| 69 | } | 72 | } |
| 70 | 73 | ||
| 71 | if (result == DriverResult::Success) { | 74 | if (result == Common::Input::DriverResult::Success) { |
| 72 | calibration.x.center = GetXAxisCalibrationValue(spi_calibration.center); | 75 | calibration.x.center = GetXAxisCalibrationValue(spi_calibration.center); |
| 73 | calibration.y.center = GetYAxisCalibrationValue(spi_calibration.center); | 76 | calibration.y.center = GetYAxisCalibrationValue(spi_calibration.center); |
| 74 | calibration.x.min = GetXAxisCalibrationValue(spi_calibration.min); | 77 | calibration.x.min = GetXAxisCalibrationValue(spi_calibration.min); |
| @@ -83,28 +86,28 @@ DriverResult CalibrationProtocol::GetRightJoyStickCalibration(JoyStickCalibratio | |||
| 83 | return result; | 86 | return result; |
| 84 | } | 87 | } |
| 85 | 88 | ||
| 86 | DriverResult CalibrationProtocol::GetImuCalibration(MotionCalibration& calibration) { | 89 | Common::Input::DriverResult CalibrationProtocol::GetImuCalibration(MotionCalibration& calibration) { |
| 87 | ScopedSetBlocking sb(this); | 90 | ScopedSetBlocking sb(this); |
| 88 | DriverResult result{DriverResult::Success}; | 91 | Common::Input::DriverResult result{Common::Input::DriverResult::Success}; |
| 89 | ImuSpiCalibration spi_calibration{}; | 92 | ImuSpiCalibration spi_calibration{}; |
| 90 | bool has_user_calibration = false; | 93 | bool has_user_calibration = false; |
| 91 | calibration = {}; | 94 | calibration = {}; |
| 92 | 95 | ||
| 93 | if (result == DriverResult::Success) { | 96 | if (result == Common::Input::DriverResult::Success) { |
| 94 | result = HasUserCalibration(SpiAddress::USER_IMU_MAGIC, has_user_calibration); | 97 | result = HasUserCalibration(SpiAddress::USER_IMU_MAGIC, has_user_calibration); |
| 95 | } | 98 | } |
| 96 | 99 | ||
| 97 | // Read User defined calibration | 100 | // Read User defined calibration |
| 98 | if (result == DriverResult::Success && has_user_calibration) { | 101 | if (result == Common::Input::DriverResult::Success && has_user_calibration) { |
| 99 | result = ReadSPI(SpiAddress::USER_IMU_DATA, spi_calibration); | 102 | result = ReadSPI(SpiAddress::USER_IMU_DATA, spi_calibration); |
| 100 | } | 103 | } |
| 101 | 104 | ||
| 102 | // Read Factory calibration | 105 | // Read Factory calibration |
| 103 | if (result == DriverResult::Success && !has_user_calibration) { | 106 | if (result == Common::Input::DriverResult::Success && !has_user_calibration) { |
| 104 | result = ReadSPI(SpiAddress::FACT_IMU_DATA, spi_calibration); | 107 | result = ReadSPI(SpiAddress::FACT_IMU_DATA, spi_calibration); |
| 105 | } | 108 | } |
| 106 | 109 | ||
| 107 | if (result == DriverResult::Success) { | 110 | if (result == Common::Input::DriverResult::Success) { |
| 108 | calibration.accelerometer[0].offset = spi_calibration.accelerometer_offset[0]; | 111 | calibration.accelerometer[0].offset = spi_calibration.accelerometer_offset[0]; |
| 109 | calibration.accelerometer[1].offset = spi_calibration.accelerometer_offset[1]; | 112 | calibration.accelerometer[1].offset = spi_calibration.accelerometer_offset[1]; |
| 110 | calibration.accelerometer[2].offset = spi_calibration.accelerometer_offset[2]; | 113 | calibration.accelerometer[2].offset = spi_calibration.accelerometer_offset[2]; |
| @@ -127,8 +130,8 @@ DriverResult CalibrationProtocol::GetImuCalibration(MotionCalibration& calibrati | |||
| 127 | return result; | 130 | return result; |
| 128 | } | 131 | } |
| 129 | 132 | ||
| 130 | DriverResult CalibrationProtocol::GetRingCalibration(RingCalibration& calibration, | 133 | Common::Input::DriverResult CalibrationProtocol::GetRingCalibration(RingCalibration& calibration, |
| 131 | s16 current_value) { | 134 | s16 current_value) { |
| 132 | constexpr s16 DefaultRingRange{800}; | 135 | constexpr s16 DefaultRingRange{800}; |
| 133 | 136 | ||
| 134 | // TODO: Get default calibration form ring itself | 137 | // TODO: Get default calibration form ring itself |
| @@ -144,15 +147,15 @@ DriverResult CalibrationProtocol::GetRingCalibration(RingCalibration& calibratio | |||
| 144 | .max_value = ring_data_max, | 147 | .max_value = ring_data_max, |
| 145 | .min_value = ring_data_min, | 148 | .min_value = ring_data_min, |
| 146 | }; | 149 | }; |
| 147 | return DriverResult::Success; | 150 | return Common::Input::DriverResult::Success; |
| 148 | } | 151 | } |
| 149 | 152 | ||
| 150 | DriverResult CalibrationProtocol::HasUserCalibration(SpiAddress address, | 153 | Common::Input::DriverResult CalibrationProtocol::HasUserCalibration(SpiAddress address, |
| 151 | bool& has_user_calibration) { | 154 | bool& has_user_calibration) { |
| 152 | MagicSpiCalibration spi_magic{}; | 155 | MagicSpiCalibration spi_magic{}; |
| 153 | const DriverResult result{ReadSPI(address, spi_magic)}; | 156 | const Common::Input::DriverResult result{ReadSPI(address, spi_magic)}; |
| 154 | has_user_calibration = false; | 157 | has_user_calibration = false; |
| 155 | if (result == DriverResult::Success) { | 158 | if (result == Common::Input::DriverResult::Success) { |
| 156 | has_user_calibration = spi_magic.first == CalibrationMagic::USR_MAGIC_0 && | 159 | has_user_calibration = spi_magic.first == CalibrationMagic::USR_MAGIC_0 && |
| 157 | spi_magic.second == CalibrationMagic::USR_MAGIC_1; | 160 | spi_magic.second == CalibrationMagic::USR_MAGIC_1; |
| 158 | } | 161 | } |