diff options
Diffstat (limited to 'src/input_common/helpers/joycon_protocol/poller.cpp')
| -rw-r--r-- | src/input_common/helpers/joycon_protocol/poller.cpp | 95 |
1 files changed, 66 insertions, 29 deletions
diff --git a/src/input_common/helpers/joycon_protocol/poller.cpp b/src/input_common/helpers/joycon_protocol/poller.cpp index 9bb15e935..ab48352b8 100644 --- a/src/input_common/helpers/joycon_protocol/poller.cpp +++ b/src/input_common/helpers/joycon_protocol/poller.cpp | |||
| @@ -12,7 +12,7 @@ JoyconPoller::JoyconPoller(ControllerType device_type_, JoyStickCalibration left | |||
| 12 | : device_type{device_type_}, left_stick_calibration{left_stick_calibration_}, | 12 | : device_type{device_type_}, left_stick_calibration{left_stick_calibration_}, |
| 13 | right_stick_calibration{right_stick_calibration_}, motion_calibration{motion_calibration_} {} | 13 | right_stick_calibration{right_stick_calibration_}, motion_calibration{motion_calibration_} {} |
| 14 | 14 | ||
| 15 | void JoyconPoller::SetCallbacks(const Joycon::JoyconCallbacks& callbacks_) { | 15 | void JoyconPoller::SetCallbacks(const JoyconCallbacks& callbacks_) { |
| 16 | callbacks = std::move(callbacks_); | 16 | callbacks = std::move(callbacks_); |
| 17 | } | 17 | } |
| 18 | 18 | ||
| @@ -22,13 +22,13 @@ void JoyconPoller::ReadActiveMode(std::span<u8> buffer, const MotionStatus& moti | |||
| 22 | memcpy(&data, buffer.data(), sizeof(InputReportActive)); | 22 | memcpy(&data, buffer.data(), sizeof(InputReportActive)); |
| 23 | 23 | ||
| 24 | switch (device_type) { | 24 | switch (device_type) { |
| 25 | case Joycon::ControllerType::Left: | 25 | case ControllerType::Left: |
| 26 | UpdateActiveLeftPadInput(data, motion_status); | 26 | UpdateActiveLeftPadInput(data, motion_status); |
| 27 | break; | 27 | break; |
| 28 | case Joycon::ControllerType::Right: | 28 | case ControllerType::Right: |
| 29 | UpdateActiveRightPadInput(data, motion_status); | 29 | UpdateActiveRightPadInput(data, motion_status); |
| 30 | break; | 30 | break; |
| 31 | case Joycon::ControllerType::Pro: | 31 | case ControllerType::Pro: |
| 32 | UpdateActiveProPadInput(data, motion_status); | 32 | UpdateActiveProPadInput(data, motion_status); |
| 33 | break; | 33 | break; |
| 34 | default: | 34 | default: |
| @@ -47,13 +47,13 @@ void JoyconPoller::ReadPassiveMode(std::span<u8> buffer) { | |||
| 47 | memcpy(&data, buffer.data(), sizeof(InputReportPassive)); | 47 | memcpy(&data, buffer.data(), sizeof(InputReportPassive)); |
| 48 | 48 | ||
| 49 | switch (device_type) { | 49 | switch (device_type) { |
| 50 | case Joycon::ControllerType::Left: | 50 | case ControllerType::Left: |
| 51 | UpdatePasiveLeftPadInput(data); | 51 | UpdatePasiveLeftPadInput(data); |
| 52 | break; | 52 | break; |
| 53 | case Joycon::ControllerType::Right: | 53 | case ControllerType::Right: |
| 54 | UpdatePasiveRightPadInput(data); | 54 | UpdatePasiveRightPadInput(data); |
| 55 | break; | 55 | break; |
| 56 | case Joycon::ControllerType::Pro: | 56 | case ControllerType::Pro: |
| 57 | UpdatePasiveProPadInput(data); | 57 | UpdatePasiveProPadInput(data); |
| 58 | break; | 58 | break; |
| 59 | default: | 59 | default: |
| @@ -211,13 +211,11 @@ void JoyconPoller::UpdateActiveProPadInput(const InputReportActive& input, | |||
| 211 | } | 211 | } |
| 212 | 212 | ||
| 213 | void JoyconPoller::UpdatePasiveLeftPadInput(const InputReportPassive& input) { | 213 | void JoyconPoller::UpdatePasiveLeftPadInput(const InputReportPassive& input) { |
| 214 | static constexpr std::array<Joycon::PasivePadButton, 11> left_buttons{ | 214 | static constexpr std::array<PasivePadButton, 11> left_buttons{ |
| 215 | Joycon::PasivePadButton::Down_A, Joycon::PasivePadButton::Right_X, | 215 | PasivePadButton::Down_A, PasivePadButton::Right_X, PasivePadButton::Left_B, |
| 216 | Joycon::PasivePadButton::Left_B, Joycon::PasivePadButton::Up_Y, | 216 | PasivePadButton::Up_Y, PasivePadButton::SL, PasivePadButton::SR, |
| 217 | Joycon::PasivePadButton::SL, Joycon::PasivePadButton::SR, | 217 | PasivePadButton::L_R, PasivePadButton::ZL_ZR, PasivePadButton::Minus, |
| 218 | Joycon::PasivePadButton::L_R, Joycon::PasivePadButton::ZL_ZR, | 218 | PasivePadButton::Capture, PasivePadButton::StickL, |
| 219 | Joycon::PasivePadButton::Minus, Joycon::PasivePadButton::Capture, | ||
| 220 | Joycon::PasivePadButton::StickL, | ||
| 221 | }; | 219 | }; |
| 222 | 220 | ||
| 223 | for (auto left_button : left_buttons) { | 221 | for (auto left_button : left_buttons) { |
| @@ -225,16 +223,19 @@ void JoyconPoller::UpdatePasiveLeftPadInput(const InputReportPassive& input) { | |||
| 225 | const int button = static_cast<int>(left_button); | 223 | const int button = static_cast<int>(left_button); |
| 226 | callbacks.on_button_data(button, button_status); | 224 | callbacks.on_button_data(button, button_status); |
| 227 | } | 225 | } |
| 226 | |||
| 227 | const auto [left_axis_x, left_axis_y] = | ||
| 228 | GetPassiveAxisValue(static_cast<PasivePadStick>(input.stick_state)); | ||
| 229 | callbacks.on_stick_data(static_cast<int>(PadAxes::LeftStickX), left_axis_x); | ||
| 230 | callbacks.on_stick_data(static_cast<int>(PadAxes::LeftStickY), left_axis_y); | ||
| 228 | } | 231 | } |
| 229 | 232 | ||
| 230 | void JoyconPoller::UpdatePasiveRightPadInput(const InputReportPassive& input) { | 233 | void JoyconPoller::UpdatePasiveRightPadInput(const InputReportPassive& input) { |
| 231 | static constexpr std::array<Joycon::PasivePadButton, 11> right_buttons{ | 234 | static constexpr std::array<PasivePadButton, 11> right_buttons{ |
| 232 | Joycon::PasivePadButton::Down_A, Joycon::PasivePadButton::Right_X, | 235 | PasivePadButton::Down_A, PasivePadButton::Right_X, PasivePadButton::Left_B, |
| 233 | Joycon::PasivePadButton::Left_B, Joycon::PasivePadButton::Up_Y, | 236 | PasivePadButton::Up_Y, PasivePadButton::SL, PasivePadButton::SR, |
| 234 | Joycon::PasivePadButton::SL, Joycon::PasivePadButton::SR, | 237 | PasivePadButton::L_R, PasivePadButton::ZL_ZR, PasivePadButton::Plus, |
| 235 | Joycon::PasivePadButton::L_R, Joycon::PasivePadButton::ZL_ZR, | 238 | PasivePadButton::Home, PasivePadButton::StickR, |
| 236 | Joycon::PasivePadButton::Plus, Joycon::PasivePadButton::Home, | ||
| 237 | Joycon::PasivePadButton::StickR, | ||
| 238 | }; | 239 | }; |
| 239 | 240 | ||
| 240 | for (auto right_button : right_buttons) { | 241 | for (auto right_button : right_buttons) { |
| @@ -242,17 +243,20 @@ void JoyconPoller::UpdatePasiveRightPadInput(const InputReportPassive& input) { | |||
| 242 | const int button = static_cast<int>(right_button); | 243 | const int button = static_cast<int>(right_button); |
| 243 | callbacks.on_button_data(button, button_status); | 244 | callbacks.on_button_data(button, button_status); |
| 244 | } | 245 | } |
| 246 | |||
| 247 | const auto [right_axis_x, right_axis_y] = | ||
| 248 | GetPassiveAxisValue(static_cast<PasivePadStick>(input.stick_state)); | ||
| 249 | callbacks.on_stick_data(static_cast<int>(PadAxes::RightStickX), right_axis_x); | ||
| 250 | callbacks.on_stick_data(static_cast<int>(PadAxes::RightStickY), right_axis_y); | ||
| 245 | } | 251 | } |
| 246 | 252 | ||
| 247 | void JoyconPoller::UpdatePasiveProPadInput(const InputReportPassive& input) { | 253 | void JoyconPoller::UpdatePasiveProPadInput(const InputReportPassive& input) { |
| 248 | static constexpr std::array<Joycon::PasivePadButton, 14> pro_buttons{ | 254 | static constexpr std::array<PasivePadButton, 14> pro_buttons{ |
| 249 | Joycon::PasivePadButton::Down_A, Joycon::PasivePadButton::Right_X, | 255 | PasivePadButton::Down_A, PasivePadButton::Right_X, PasivePadButton::Left_B, |
| 250 | Joycon::PasivePadButton::Left_B, Joycon::PasivePadButton::Up_Y, | 256 | PasivePadButton::Up_Y, PasivePadButton::SL, PasivePadButton::SR, |
| 251 | Joycon::PasivePadButton::SL, Joycon::PasivePadButton::SR, | 257 | PasivePadButton::L_R, PasivePadButton::ZL_ZR, PasivePadButton::Minus, |
| 252 | Joycon::PasivePadButton::L_R, Joycon::PasivePadButton::ZL_ZR, | 258 | PasivePadButton::Plus, PasivePadButton::Capture, PasivePadButton::Home, |
| 253 | Joycon::PasivePadButton::Minus, Joycon::PasivePadButton::Plus, | 259 | PasivePadButton::StickL, PasivePadButton::StickR, |
| 254 | Joycon::PasivePadButton::Capture, Joycon::PasivePadButton::Home, | ||
| 255 | Joycon::PasivePadButton::StickL, Joycon::PasivePadButton::StickR, | ||
| 256 | }; | 260 | }; |
| 257 | 261 | ||
| 258 | for (auto pro_button : pro_buttons) { | 262 | for (auto pro_button : pro_buttons) { |
| @@ -260,6 +264,15 @@ void JoyconPoller::UpdatePasiveProPadInput(const InputReportPassive& input) { | |||
| 260 | const int button = static_cast<int>(pro_button); | 264 | const int button = static_cast<int>(pro_button); |
| 261 | callbacks.on_button_data(button, button_status); | 265 | callbacks.on_button_data(button, button_status); |
| 262 | } | 266 | } |
| 267 | |||
| 268 | const auto [left_axis_x, left_axis_y] = | ||
| 269 | GetPassiveAxisValue(static_cast<PasivePadStick>(input.stick_state && 0xf)); | ||
| 270 | const auto [right_axis_x, right_axis_y] = | ||
| 271 | GetPassiveAxisValue(static_cast<PasivePadStick>(input.stick_state >> 4)); | ||
| 272 | callbacks.on_stick_data(static_cast<int>(PadAxes::LeftStickX), left_axis_x); | ||
| 273 | callbacks.on_stick_data(static_cast<int>(PadAxes::LeftStickY), left_axis_y); | ||
| 274 | callbacks.on_stick_data(static_cast<int>(PadAxes::RightStickX), right_axis_x); | ||
| 275 | callbacks.on_stick_data(static_cast<int>(PadAxes::RightStickY), right_axis_y); | ||
| 263 | } | 276 | } |
| 264 | 277 | ||
| 265 | f32 JoyconPoller::GetAxisValue(u16 raw_value, Joycon::JoyStickAxisCalibration calibration) const { | 278 | f32 JoyconPoller::GetAxisValue(u16 raw_value, Joycon::JoyStickAxisCalibration calibration) const { |
| @@ -270,6 +283,30 @@ f32 JoyconPoller::GetAxisValue(u16 raw_value, Joycon::JoyStickAxisCalibration ca | |||
| 270 | return value / calibration.min; | 283 | return value / calibration.min; |
| 271 | } | 284 | } |
| 272 | 285 | ||
| 286 | std::pair<f32, f32> JoyconPoller::GetPassiveAxisValue(PasivePadStick raw_value) const { | ||
| 287 | switch (raw_value) { | ||
| 288 | case PasivePadStick::Right: | ||
| 289 | return {1.0f, 0.0f}; | ||
| 290 | case PasivePadStick::RightDown: | ||
| 291 | return {1.0f, -1.0f}; | ||
| 292 | case PasivePadStick::Down: | ||
| 293 | return {0.0f, -1.0f}; | ||
| 294 | case PasivePadStick::DownLeft: | ||
| 295 | return {-1.0f, -1.0f}; | ||
| 296 | case PasivePadStick::Left: | ||
| 297 | return {-1.0f, 0.0f}; | ||
| 298 | case PasivePadStick::LeftUp: | ||
| 299 | return {-1.0f, 1.0f}; | ||
| 300 | case PasivePadStick::Up: | ||
| 301 | return {0.0f, 1.0f}; | ||
| 302 | case PasivePadStick::UpRight: | ||
| 303 | return {1.0f, 1.0f}; | ||
| 304 | case PasivePadStick::Neutral: | ||
| 305 | default: | ||
| 306 | return {0.0f, 0.0f}; | ||
| 307 | } | ||
| 308 | } | ||
| 309 | |||
| 273 | f32 JoyconPoller::GetAccelerometerValue(s16 raw, const MotionSensorCalibration& cal, | 310 | f32 JoyconPoller::GetAccelerometerValue(s16 raw, const MotionSensorCalibration& cal, |
| 274 | AccelerometerSensitivity sensitivity) const { | 311 | AccelerometerSensitivity sensitivity) const { |
| 275 | const f32 value = raw * (1.0f / (cal.scale - cal.offset)) * 4; | 312 | const f32 value = raw * (1.0f / (cal.scale - cal.offset)) * 4; |