diff options
| author | 2022-12-22 01:07:46 -0600 | |
|---|---|---|
| committer | 2023-01-19 18:05:21 -0600 | |
| commit | 6d6b7bdbc327528d155f0422ef096846559844c0 (patch) | |
| tree | 6954aaa23abe6d725f8452afb1fd19a59e962800 | |
| parent | input_common: Add dual joycon support (diff) | |
| download | yuzu-6d6b7bdbc327528d155f0422ef096846559844c0.tar.gz yuzu-6d6b7bdbc327528d155f0422ef096846559844c0.tar.xz yuzu-6d6b7bdbc327528d155f0422ef096846559844c0.zip | |
input_common: Implement joycon nfc
Diffstat (limited to '')
| -rw-r--r-- | src/core/hid/emulated_controller.cpp | 3 | ||||
| -rw-r--r-- | src/input_common/CMakeLists.txt | 2 | ||||
| -rw-r--r-- | src/input_common/drivers/joycon.cpp | 4 | ||||
| -rw-r--r-- | src/input_common/helpers/joycon_driver.cpp | 44 | ||||
| -rw-r--r-- | src/input_common/helpers/joycon_driver.h | 24 | ||||
| -rw-r--r-- | src/input_common/helpers/joycon_protocol/nfc.cpp | 414 | ||||
| -rw-r--r-- | src/input_common/helpers/joycon_protocol/nfc.h | 61 | ||||
| -rw-r--r-- | src/input_common/helpers/joycon_protocol/poller.cpp | 4 | ||||
| -rw-r--r-- | src/input_common/helpers/joycon_protocol/poller.h | 1 |
9 files changed, 544 insertions, 13 deletions
diff --git a/src/core/hid/emulated_controller.cpp b/src/core/hid/emulated_controller.cpp index 89638cb85..1e4ec4add 100644 --- a/src/core/hid/emulated_controller.cpp +++ b/src/core/hid/emulated_controller.cpp | |||
| @@ -144,7 +144,8 @@ void EmulatedController::LoadDevices() { | |||
| 144 | battery_params[RightIndex].Set("battery", true); | 144 | battery_params[RightIndex].Set("battery", true); |
| 145 | 145 | ||
| 146 | camera_params = Common::ParamPackage{"engine:camera,camera:1"}; | 146 | camera_params = Common::ParamPackage{"engine:camera,camera:1"}; |
| 147 | nfc_params = Common::ParamPackage{"engine:virtual_amiibo,nfc:1"}; | 147 | nfc_params = right_joycon; |
| 148 | nfc_params.Set("nfc", true); | ||
| 148 | ring_params = Common::ParamPackage{"engine:joycon,axis_x:100,axis_y:101"}; | 149 | ring_params = Common::ParamPackage{"engine:joycon,axis_x:100,axis_y:101"}; |
| 149 | 150 | ||
| 150 | output_params[LeftIndex] = left_joycon; | 151 | output_params[LeftIndex] = left_joycon; |
diff --git a/src/input_common/CMakeLists.txt b/src/input_common/CMakeLists.txt index addecc9b3..9c901af2a 100644 --- a/src/input_common/CMakeLists.txt +++ b/src/input_common/CMakeLists.txt | |||
| @@ -64,6 +64,8 @@ if (ENABLE_SDL2) | |||
| 64 | helpers/joycon_protocol/generic_functions.cpp | 64 | helpers/joycon_protocol/generic_functions.cpp |
| 65 | helpers/joycon_protocol/generic_functions.h | 65 | helpers/joycon_protocol/generic_functions.h |
| 66 | helpers/joycon_protocol/joycon_types.h | 66 | helpers/joycon_protocol/joycon_types.h |
| 67 | helpers/joycon_protocol/nfc.cpp | ||
| 68 | helpers/joycon_protocol/nfc.h | ||
| 67 | helpers/joycon_protocol/poller.cpp | 69 | helpers/joycon_protocol/poller.cpp |
| 68 | helpers/joycon_protocol/poller.h | 70 | helpers/joycon_protocol/poller.h |
| 69 | helpers/joycon_protocol/ringcon.cpp | 71 | helpers/joycon_protocol/ringcon.cpp |
diff --git a/src/input_common/drivers/joycon.cpp b/src/input_common/drivers/joycon.cpp index 049ecc4f2..29f0dc0c8 100644 --- a/src/input_common/drivers/joycon.cpp +++ b/src/input_common/drivers/joycon.cpp | |||
| @@ -388,7 +388,9 @@ void Joycons::OnRingConUpdate(f32 ring_data) { | |||
| 388 | 388 | ||
| 389 | void Joycons::OnAmiiboUpdate(std::size_t port, const std::vector<u8>& amiibo_data) { | 389 | void Joycons::OnAmiiboUpdate(std::size_t port, const std::vector<u8>& amiibo_data) { |
| 390 | const auto identifier = GetIdentifier(port, Joycon::ControllerType::Right); | 390 | const auto identifier = GetIdentifier(port, Joycon::ControllerType::Right); |
| 391 | SetNfc(identifier, {Common::Input::NfcState::NewAmiibo, amiibo_data}); | 391 | const auto nfc_state = amiibo_data.empty() ? Common::Input::NfcState::AmiiboRemoved |
| 392 | : Common::Input::NfcState::NewAmiibo; | ||
| 393 | SetNfc(identifier, {nfc_state, amiibo_data}); | ||
| 392 | } | 394 | } |
| 393 | 395 | ||
| 394 | std::shared_ptr<Joycon::JoyconDriver> Joycons::GetHandle(PadIdentifier identifier) const { | 396 | std::shared_ptr<Joycon::JoyconDriver> Joycons::GetHandle(PadIdentifier identifier) const { |
diff --git a/src/input_common/helpers/joycon_driver.cpp b/src/input_common/helpers/joycon_driver.cpp index c0a03fe2e..c3debffd1 100644 --- a/src/input_common/helpers/joycon_driver.cpp +++ b/src/input_common/helpers/joycon_driver.cpp | |||
| @@ -5,6 +5,12 @@ | |||
| 5 | #include "common/swap.h" | 5 | #include "common/swap.h" |
| 6 | #include "common/thread.h" | 6 | #include "common/thread.h" |
| 7 | #include "input_common/helpers/joycon_driver.h" | 7 | #include "input_common/helpers/joycon_driver.h" |
| 8 | #include "input_common/helpers/joycon_protocol/calibration.h" | ||
| 9 | #include "input_common/helpers/joycon_protocol/generic_functions.h" | ||
| 10 | #include "input_common/helpers/joycon_protocol/nfc.h" | ||
| 11 | #include "input_common/helpers/joycon_protocol/poller.h" | ||
| 12 | #include "input_common/helpers/joycon_protocol/ringcon.h" | ||
| 13 | #include "input_common/helpers/joycon_protocol/rumble.h" | ||
| 8 | 14 | ||
| 9 | namespace InputCommon::Joycon { | 15 | namespace InputCommon::Joycon { |
| 10 | JoyconDriver::JoyconDriver(std::size_t port_) : port{port_} { | 16 | JoyconDriver::JoyconDriver(std::size_t port_) : port{port_} { |
| @@ -72,6 +78,7 @@ DriverResult JoyconDriver::InitializeDevice() { | |||
| 72 | // Initialize HW Protocols | 78 | // Initialize HW Protocols |
| 73 | calibration_protocol = std::make_unique<CalibrationProtocol>(hidapi_handle); | 79 | calibration_protocol = std::make_unique<CalibrationProtocol>(hidapi_handle); |
| 74 | generic_protocol = std::make_unique<GenericProtocol>(hidapi_handle); | 80 | generic_protocol = std::make_unique<GenericProtocol>(hidapi_handle); |
| 81 | nfc_protocol = std::make_unique<NfcProtocol>(hidapi_handle); | ||
| 75 | ring_protocol = std::make_unique<RingConProtocol>(hidapi_handle); | 82 | ring_protocol = std::make_unique<RingConProtocol>(hidapi_handle); |
| 76 | rumble_protocol = std::make_unique<RumbleProtocol>(hidapi_handle); | 83 | rumble_protocol = std::make_unique<RumbleProtocol>(hidapi_handle); |
| 77 | 84 | ||
| @@ -193,6 +200,25 @@ void JoyconDriver::OnNewData(std::span<u8> buffer) { | |||
| 193 | .min_value = ring_calibration.min_value, | 200 | .min_value = ring_calibration.min_value, |
| 194 | }; | 201 | }; |
| 195 | 202 | ||
| 203 | if (nfc_protocol->IsEnabled()) { | ||
| 204 | if (amiibo_detected) { | ||
| 205 | if (!nfc_protocol->HasAmiibo()) { | ||
| 206 | joycon_poller->updateAmiibo({}); | ||
| 207 | amiibo_detected = false; | ||
| 208 | return; | ||
| 209 | } | ||
| 210 | } | ||
| 211 | |||
| 212 | if (!amiibo_detected) { | ||
| 213 | std::vector<u8> data(0x21C); | ||
| 214 | const auto result = nfc_protocol->ScanAmiibo(data); | ||
| 215 | if (result == DriverResult::Success) { | ||
| 216 | joycon_poller->updateAmiibo(data); | ||
| 217 | amiibo_detected = true; | ||
| 218 | } | ||
| 219 | } | ||
| 220 | } | ||
| 221 | |||
| 196 | switch (report_mode) { | 222 | switch (report_mode) { |
| 197 | case InputReport::STANDARD_FULL_60HZ: | 223 | case InputReport::STANDARD_FULL_60HZ: |
| 198 | joycon_poller->ReadActiveMode(buffer, motion_status, ring_status); | 224 | joycon_poller->ReadActiveMode(buffer, motion_status, ring_status); |
| @@ -225,6 +251,24 @@ void JoyconDriver::SetPollingMode() { | |||
| 225 | generic_protocol->EnableImu(false); | 251 | generic_protocol->EnableImu(false); |
| 226 | } | 252 | } |
| 227 | 253 | ||
| 254 | if (nfc_protocol->IsEnabled()) { | ||
| 255 | amiibo_detected = false; | ||
| 256 | nfc_protocol->DisableNfc(); | ||
| 257 | } | ||
| 258 | |||
| 259 | if (nfc_enabled && supported_features.nfc) { | ||
| 260 | auto result = nfc_protocol->EnableNfc(); | ||
| 261 | if (result == DriverResult::Success) { | ||
| 262 | result = nfc_protocol->StartNFCPollingMode(); | ||
| 263 | } | ||
| 264 | if (result == DriverResult::Success) { | ||
| 265 | disable_input_thread = false; | ||
| 266 | return; | ||
| 267 | } | ||
| 268 | nfc_protocol->DisableNfc(); | ||
| 269 | LOG_ERROR(Input, "Error enabling NFC"); | ||
| 270 | } | ||
| 271 | |||
| 228 | if (ring_protocol->IsEnabled()) { | 272 | if (ring_protocol->IsEnabled()) { |
| 229 | ring_connected = false; | 273 | ring_connected = false; |
| 230 | ring_protocol->DisableRingCon(); | 274 | ring_protocol->DisableRingCon(); |
diff --git a/src/input_common/helpers/joycon_driver.h b/src/input_common/helpers/joycon_driver.h index dc5d60221..c9118ee93 100644 --- a/src/input_common/helpers/joycon_driver.h +++ b/src/input_common/helpers/joycon_driver.h | |||
| @@ -8,14 +8,15 @@ | |||
| 8 | #include <span> | 8 | #include <span> |
| 9 | #include <thread> | 9 | #include <thread> |
| 10 | 10 | ||
| 11 | #include "input_common/helpers/joycon_protocol/calibration.h" | ||
| 12 | #include "input_common/helpers/joycon_protocol/generic_functions.h" | ||
| 13 | #include "input_common/helpers/joycon_protocol/joycon_types.h" | 11 | #include "input_common/helpers/joycon_protocol/joycon_types.h" |
| 14 | #include "input_common/helpers/joycon_protocol/poller.h" | ||
| 15 | #include "input_common/helpers/joycon_protocol/ringcon.h" | ||
| 16 | #include "input_common/helpers/joycon_protocol/rumble.h" | ||
| 17 | 12 | ||
| 18 | namespace InputCommon::Joycon { | 13 | namespace InputCommon::Joycon { |
| 14 | class CalibrationProtocol; | ||
| 15 | class GenericProtocol; | ||
| 16 | class NfcProtocol; | ||
| 17 | class JoyconPoller; | ||
| 18 | class RingConProtocol; | ||
| 19 | class RumbleProtocol; | ||
| 19 | 20 | ||
| 20 | class JoyconDriver final { | 21 | class JoyconDriver final { |
| 21 | public: | 22 | public: |
| @@ -84,17 +85,18 @@ private: | |||
| 84 | SupportedFeatures GetSupportedFeatures(); | 85 | SupportedFeatures GetSupportedFeatures(); |
| 85 | 86 | ||
| 86 | // Protocol Features | 87 | // Protocol Features |
| 87 | std::unique_ptr<CalibrationProtocol> calibration_protocol = nullptr; | 88 | std::unique_ptr<CalibrationProtocol> calibration_protocol; |
| 88 | std::unique_ptr<GenericProtocol> generic_protocol = nullptr; | 89 | std::unique_ptr<GenericProtocol> generic_protocol; |
| 89 | std::unique_ptr<JoyconPoller> joycon_poller = nullptr; | 90 | std::unique_ptr<NfcProtocol> nfc_protocol; |
| 90 | std::unique_ptr<RingConProtocol> ring_protocol = nullptr; | 91 | std::unique_ptr<JoyconPoller> joycon_poller; |
| 91 | std::unique_ptr<RumbleProtocol> rumble_protocol = nullptr; | 92 | std::unique_ptr<RingConProtocol> ring_protocol; |
| 93 | std::unique_ptr<RumbleProtocol> rumble_protocol; | ||
| 92 | 94 | ||
| 93 | // Connection status | 95 | // Connection status |
| 94 | bool is_connected{}; | 96 | bool is_connected{}; |
| 95 | u64 delta_time; | 97 | u64 delta_time; |
| 96 | std::size_t error_counter{}; | 98 | std::size_t error_counter{}; |
| 97 | std::shared_ptr<JoyconHandle> hidapi_handle = nullptr; | 99 | std::shared_ptr<JoyconHandle> hidapi_handle; |
| 98 | std::chrono::time_point<std::chrono::steady_clock> last_update; | 100 | std::chrono::time_point<std::chrono::steady_clock> last_update; |
| 99 | 101 | ||
| 100 | // External device status | 102 | // External device status |
diff --git a/src/input_common/helpers/joycon_protocol/nfc.cpp b/src/input_common/helpers/joycon_protocol/nfc.cpp new file mode 100644 index 000000000..69b2bfe05 --- /dev/null +++ b/src/input_common/helpers/joycon_protocol/nfc.cpp | |||
| @@ -0,0 +1,414 @@ | |||
| 1 | // SPDX-FileCopyrightText: Copyright 2022 yuzu Emulator Project | ||
| 2 | // SPDX-License-Identifier: GPL-2.0-or-later | ||
| 3 | |||
| 4 | #include <thread> | ||
| 5 | #include "common/logging/log.h" | ||
| 6 | #include "input_common/helpers/joycon_protocol/nfc.h" | ||
| 7 | |||
| 8 | namespace InputCommon::Joycon { | ||
| 9 | |||
| 10 | NfcProtocol::NfcProtocol(std::shared_ptr<JoyconHandle> handle) : JoyconCommonProtocol(handle) {} | ||
| 11 | |||
| 12 | DriverResult NfcProtocol::EnableNfc() { | ||
| 13 | LOG_INFO(Input, "Enable NFC"); | ||
| 14 | DriverResult result{DriverResult::Success}; | ||
| 15 | SetBlocking(); | ||
| 16 | |||
| 17 | if (result == DriverResult::Success) { | ||
| 18 | result = SetReportMode(ReportMode::NFC_IR_MODE_60HZ); | ||
| 19 | } | ||
| 20 | if (result == DriverResult::Success) { | ||
| 21 | result = EnableMCU(true); | ||
| 22 | } | ||
| 23 | if (result == DriverResult::Success) { | ||
| 24 | result = WaitSetMCUMode(ReportMode::NFC_IR_MODE_60HZ, MCUMode::Standby); | ||
| 25 | } | ||
| 26 | if (result == DriverResult::Success) { | ||
| 27 | const MCUConfig config{ | ||
| 28 | .command = MCUCommand::ConfigureMCU, | ||
| 29 | .sub_command = MCUSubCommand::SetMCUMode, | ||
| 30 | .mode = MCUMode::NFC, | ||
| 31 | .crc = {}, | ||
| 32 | }; | ||
| 33 | |||
| 34 | result = ConfigureMCU(config); | ||
| 35 | } | ||
| 36 | |||
| 37 | SetNonBlocking(); | ||
| 38 | return result; | ||
| 39 | } | ||
| 40 | |||
| 41 | DriverResult NfcProtocol::DisableNfc() { | ||
| 42 | LOG_DEBUG(Input, "Disable NFC"); | ||
| 43 | DriverResult result{DriverResult::Success}; | ||
| 44 | SetBlocking(); | ||
| 45 | |||
| 46 | if (result == DriverResult::Success) { | ||
| 47 | result = EnableMCU(false); | ||
| 48 | } | ||
| 49 | |||
| 50 | is_enabled = false; | ||
| 51 | |||
| 52 | SetNonBlocking(); | ||
| 53 | return result; | ||
| 54 | } | ||
| 55 | |||
| 56 | DriverResult NfcProtocol::StartNFCPollingMode() { | ||
| 57 | LOG_DEBUG(Input, "Start NFC pooling Mode"); | ||
| 58 | DriverResult result{DriverResult::Success}; | ||
| 59 | TagFoundData tag_data{}; | ||
| 60 | SetBlocking(); | ||
| 61 | |||
| 62 | if (result == DriverResult::Success) { | ||
| 63 | result = WaitSetMCUMode(ReportMode::NFC_IR_MODE_60HZ, MCUMode::NFC); | ||
| 64 | } | ||
| 65 | if (result == DriverResult::Success) { | ||
| 66 | result = WaitUntilNfcIsReady(); | ||
| 67 | } | ||
| 68 | if (result == DriverResult::Success) { | ||
| 69 | is_enabled = true; | ||
| 70 | } | ||
| 71 | |||
| 72 | SetNonBlocking(); | ||
| 73 | return result; | ||
| 74 | } | ||
| 75 | |||
| 76 | DriverResult NfcProtocol::ScanAmiibo(std::vector<u8>& data) { | ||
| 77 | LOG_DEBUG(Input, "Start NFC pooling Mode"); | ||
| 78 | DriverResult result{DriverResult::Success}; | ||
| 79 | TagFoundData tag_data{}; | ||
| 80 | SetBlocking(); | ||
| 81 | |||
| 82 | if (result == DriverResult::Success) { | ||
| 83 | result = StartPolling(tag_data); | ||
| 84 | } | ||
| 85 | if (result == DriverResult::Success) { | ||
| 86 | result = ReadTag(tag_data); | ||
| 87 | } | ||
| 88 | if (result == DriverResult::Success) { | ||
| 89 | result = WaitUntilNfcIsReady(); | ||
| 90 | } | ||
| 91 | if (result == DriverResult::Success) { | ||
| 92 | result = StartPolling(tag_data); | ||
| 93 | } | ||
| 94 | if (result == DriverResult::Success) { | ||
| 95 | result = GetAmiiboData(data); | ||
| 96 | } | ||
| 97 | |||
| 98 | SetNonBlocking(); | ||
| 99 | return result; | ||
| 100 | } | ||
| 101 | |||
| 102 | bool NfcProtocol::HasAmiibo() { | ||
| 103 | DriverResult result{DriverResult::Success}; | ||
| 104 | TagFoundData tag_data{}; | ||
| 105 | SetBlocking(); | ||
| 106 | |||
| 107 | if (result == DriverResult::Success) { | ||
| 108 | result = StartPolling(tag_data); | ||
| 109 | } | ||
| 110 | |||
| 111 | SetNonBlocking(); | ||
| 112 | return result == DriverResult::Success; | ||
| 113 | } | ||
| 114 | |||
| 115 | DriverResult NfcProtocol::WaitUntilNfcIsReady() { | ||
| 116 | constexpr std::size_t timeout_limit = 10; | ||
| 117 | std::vector<u8> output; | ||
| 118 | std::size_t tries = 0; | ||
| 119 | |||
| 120 | do { | ||
| 121 | auto result = SendStartWaitingRecieveRequest(output); | ||
| 122 | |||
| 123 | if (result != DriverResult::Success) { | ||
| 124 | return result; | ||
| 125 | } | ||
| 126 | if (tries++ > timeout_limit) { | ||
| 127 | return DriverResult::Timeout; | ||
| 128 | } | ||
| 129 | } while (output[49] != 0x2a || (output[51] << 8) + output[50] != 0x0500 || output[55] != 0x31 || | ||
| 130 | output[56] != 0x00); | ||
| 131 | |||
| 132 | return DriverResult::Success; | ||
| 133 | } | ||
| 134 | |||
| 135 | DriverResult NfcProtocol::StartPolling(TagFoundData& data) { | ||
| 136 | LOG_DEBUG(Input, "Start Polling for tag"); | ||
| 137 | constexpr std::size_t timeout_limit = 7; | ||
| 138 | std::vector<u8> output; | ||
| 139 | std::size_t tries = 0; | ||
| 140 | |||
| 141 | do { | ||
| 142 | const auto result = SendStartPollingRequest(output); | ||
| 143 | if (result != DriverResult::Success) { | ||
| 144 | return result; | ||
| 145 | } | ||
| 146 | if (tries++ > timeout_limit) { | ||
| 147 | return DriverResult::Timeout; | ||
| 148 | } | ||
| 149 | } while (output[49] != 0x2a || (output[51] << 8) + output[50] != 0x0500 || output[56] != 0x09); | ||
| 150 | |||
| 151 | data.type = output[62]; | ||
| 152 | data.uuid.resize(output[64]); | ||
| 153 | memcpy(data.uuid.data(), output.data() + 65, data.uuid.size()); | ||
| 154 | |||
| 155 | return DriverResult::Success; | ||
| 156 | } | ||
| 157 | |||
| 158 | DriverResult NfcProtocol::ReadTag(const TagFoundData& data) { | ||
| 159 | constexpr std::size_t timeout_limit = 10; | ||
| 160 | std::vector<u8> output; | ||
| 161 | std::size_t tries = 0; | ||
| 162 | |||
| 163 | std::string uuid_string = ""; | ||
| 164 | for (auto& content : data.uuid) { | ||
| 165 | uuid_string += " " + fmt::format("{:02x}", content); | ||
| 166 | } | ||
| 167 | |||
| 168 | LOG_INFO(Input, "Tag detected, type={}, uuid={}", data.type, uuid_string); | ||
| 169 | |||
| 170 | tries = 0; | ||
| 171 | std::size_t ntag_pages = 0; | ||
| 172 | // Read Tag data | ||
| 173 | loop1: | ||
| 174 | while (true) { | ||
| 175 | auto result = SendReadAmiiboRequest(output, ntag_pages); | ||
| 176 | |||
| 177 | int attempt = 0; | ||
| 178 | while (1) { | ||
| 179 | if (attempt != 0) { | ||
| 180 | result = GetMCUDataResponse(ReportMode::NFC_IR_MODE_60HZ, output); | ||
| 181 | } | ||
| 182 | if ((output[49] == 0x3a || output[49] == 0x2a) && output[56] == 0x07) { | ||
| 183 | return DriverResult::ErrorReadingData; | ||
| 184 | } | ||
| 185 | if (output[49] == 0x3a && output[51] == 0x07 && output[52] == 0x01) { | ||
| 186 | if (data.type != 2) { | ||
| 187 | goto loop1; | ||
| 188 | } | ||
| 189 | switch (output[74]) { | ||
| 190 | case 0: | ||
| 191 | ntag_pages = 135; | ||
| 192 | break; | ||
| 193 | case 3: | ||
| 194 | ntag_pages = 45; | ||
| 195 | break; | ||
| 196 | case 4: | ||
| 197 | ntag_pages = 231; | ||
| 198 | break; | ||
| 199 | default: | ||
| 200 | return DriverResult::ErrorReadingData; | ||
| 201 | } | ||
| 202 | goto loop1; | ||
| 203 | } | ||
| 204 | if (output[49] == 0x2a && output[56] == 0x04) { | ||
| 205 | // finished | ||
| 206 | SendStopPollingRequest(output); | ||
| 207 | return DriverResult::Success; | ||
| 208 | } | ||
| 209 | if (output[49] == 0x2a) { | ||
| 210 | goto loop1; | ||
| 211 | } | ||
| 212 | if (attempt++ > 6) { | ||
| 213 | goto loop1; | ||
| 214 | } | ||
| 215 | } | ||
| 216 | |||
| 217 | if (result != DriverResult::Success) { | ||
| 218 | return result; | ||
| 219 | } | ||
| 220 | if (tries++ > timeout_limit) { | ||
| 221 | return DriverResult::Timeout; | ||
| 222 | } | ||
| 223 | } | ||
| 224 | |||
| 225 | return DriverResult::Success; | ||
| 226 | } | ||
| 227 | |||
| 228 | DriverResult NfcProtocol::GetAmiiboData(std::vector<u8>& ntag_data) { | ||
| 229 | constexpr std::size_t timeout_limit = 10; | ||
| 230 | std::vector<u8> output; | ||
| 231 | std::size_t tries = 0; | ||
| 232 | |||
| 233 | std::size_t ntag_pages = 135; | ||
| 234 | std::size_t ntag_buffer_pos = 0; | ||
| 235 | // Read Tag data | ||
| 236 | loop1: | ||
| 237 | while (true) { | ||
| 238 | auto result = SendReadAmiiboRequest(output, ntag_pages); | ||
| 239 | |||
| 240 | int attempt = 0; | ||
| 241 | while (1) { | ||
| 242 | if (attempt != 0) { | ||
| 243 | result = GetMCUDataResponse(ReportMode::NFC_IR_MODE_60HZ, output); | ||
| 244 | } | ||
| 245 | if ((output[49] == 0x3a || output[49] == 0x2a) && output[56] == 0x07) { | ||
| 246 | return DriverResult::ErrorReadingData; | ||
| 247 | } | ||
| 248 | if (output[49] == 0x3a && output[51] == 0x07) { | ||
| 249 | std::size_t payload_size = (output[54] << 8 | output[55]) & 0x7FF; | ||
| 250 | if (output[52] == 0x01) { | ||
| 251 | memcpy(ntag_data.data() + ntag_buffer_pos, output.data() + 116, | ||
| 252 | payload_size - 60); | ||
| 253 | ntag_buffer_pos += payload_size - 60; | ||
| 254 | } else { | ||
| 255 | memcpy(ntag_data.data() + ntag_buffer_pos, output.data() + 56, payload_size); | ||
| 256 | } | ||
| 257 | goto loop1; | ||
| 258 | } | ||
| 259 | if (output[49] == 0x2a && output[56] == 0x04) { | ||
| 260 | LOG_INFO(Input, "Finished reading amiibo"); | ||
| 261 | return DriverResult::Success; | ||
| 262 | } | ||
| 263 | if (output[49] == 0x2a) { | ||
| 264 | goto loop1; | ||
| 265 | } | ||
| 266 | if (attempt++ > 4) { | ||
| 267 | goto loop1; | ||
| 268 | } | ||
| 269 | } | ||
| 270 | |||
| 271 | if (result != DriverResult::Success) { | ||
| 272 | return result; | ||
| 273 | } | ||
| 274 | if (tries++ > timeout_limit) { | ||
| 275 | return DriverResult::Timeout; | ||
| 276 | } | ||
| 277 | } | ||
| 278 | |||
| 279 | return DriverResult::Success; | ||
| 280 | } | ||
| 281 | |||
| 282 | DriverResult NfcProtocol::SendStartPollingRequest(std::vector<u8>& output) { | ||
| 283 | NFCRequestState request{ | ||
| 284 | .sub_command = MCUSubCommand::ReadDeviceMode, | ||
| 285 | .command_argument = NFCReadCommand::StartPolling, | ||
| 286 | .packet_id = 0x0, | ||
| 287 | .packet_flag = MCUPacketFlag::LastCommandPacket, | ||
| 288 | .data_length = sizeof(NFCPollingCommandData), | ||
| 289 | .nfc_polling = | ||
| 290 | { | ||
| 291 | .enable_mifare = 0x01, | ||
| 292 | .unknown_1 = 0x00, | ||
| 293 | .unknown_2 = 0x00, | ||
| 294 | .unknown_3 = 0x2c, | ||
| 295 | .unknown_4 = 0x01, | ||
| 296 | }, | ||
| 297 | .crc = {}, | ||
| 298 | }; | ||
| 299 | |||
| 300 | std::vector<u8> request_data(sizeof(NFCRequestState)); | ||
| 301 | memcpy(request_data.data(), &request, sizeof(NFCRequestState)); | ||
| 302 | request_data[37] = CalculateMCU_CRC8(request_data.data() + 1, 36); | ||
| 303 | return SendMCUData(ReportMode::NFC_IR_MODE_60HZ, SubCommand::STATE, request_data, output); | ||
| 304 | } | ||
| 305 | |||
| 306 | DriverResult NfcProtocol::SendStopPollingRequest(std::vector<u8>& output) { | ||
| 307 | NFCRequestState request{ | ||
| 308 | .sub_command = MCUSubCommand::ReadDeviceMode, | ||
| 309 | .command_argument = NFCReadCommand::StopPolling, | ||
| 310 | .packet_id = 0x0, | ||
| 311 | .packet_flag = MCUPacketFlag::LastCommandPacket, | ||
| 312 | .data_length = 0, | ||
| 313 | .raw_data = {}, | ||
| 314 | .crc = {}, | ||
| 315 | }; | ||
| 316 | |||
| 317 | std::vector<u8> request_data(sizeof(NFCRequestState)); | ||
| 318 | memcpy(request_data.data(), &request, sizeof(NFCRequestState)); | ||
| 319 | request_data[37] = CalculateMCU_CRC8(request_data.data() + 1, 36); | ||
| 320 | return SendMCUData(ReportMode::NFC_IR_MODE_60HZ, SubCommand::STATE, request_data, output); | ||
| 321 | } | ||
| 322 | |||
| 323 | DriverResult NfcProtocol::SendStartWaitingRecieveRequest(std::vector<u8>& output) { | ||
| 324 | NFCRequestState request{ | ||
| 325 | .sub_command = MCUSubCommand::ReadDeviceMode, | ||
| 326 | .command_argument = NFCReadCommand::StartWaitingRecieve, | ||
| 327 | .packet_id = 0x0, | ||
| 328 | .packet_flag = MCUPacketFlag::LastCommandPacket, | ||
| 329 | .data_length = 0, | ||
| 330 | .raw_data = {}, | ||
| 331 | .crc = {}, | ||
| 332 | }; | ||
| 333 | |||
| 334 | std::vector<u8> request_data(sizeof(NFCRequestState)); | ||
| 335 | memcpy(request_data.data(), &request, sizeof(NFCRequestState)); | ||
| 336 | request_data[37] = CalculateMCU_CRC8(request_data.data() + 1, 36); | ||
| 337 | return SendMCUData(ReportMode::NFC_IR_MODE_60HZ, SubCommand::STATE, request_data, output); | ||
| 338 | } | ||
| 339 | |||
| 340 | DriverResult NfcProtocol::SendReadAmiiboRequest(std::vector<u8>& output, std::size_t ntag_pages) { | ||
| 341 | NFCRequestState request{ | ||
| 342 | .sub_command = MCUSubCommand::ReadDeviceMode, | ||
| 343 | .command_argument = NFCReadCommand::Ntag, | ||
| 344 | .packet_id = 0x0, | ||
| 345 | .packet_flag = MCUPacketFlag::LastCommandPacket, | ||
| 346 | .data_length = sizeof(NFCReadCommandData), | ||
| 347 | .nfc_read = | ||
| 348 | { | ||
| 349 | .unknown = 0xd0, | ||
| 350 | .uuid_length = 0x07, | ||
| 351 | .unknown_2 = 0x00, | ||
| 352 | .uid = {}, | ||
| 353 | .tag_type = NFCTagType::AllTags, | ||
| 354 | .read_block = GetReadBlockCommand(ntag_pages), | ||
| 355 | }, | ||
| 356 | .crc = {}, | ||
| 357 | }; | ||
| 358 | |||
| 359 | std::vector<u8> request_data(sizeof(NFCRequestState)); | ||
| 360 | memcpy(request_data.data(), &request, sizeof(NFCRequestState)); | ||
| 361 | request_data[37] = CalculateMCU_CRC8(request_data.data() + 1, 36); | ||
| 362 | return SendMCUData(ReportMode::NFC_IR_MODE_60HZ, SubCommand::STATE, request_data, output); | ||
| 363 | } | ||
| 364 | |||
| 365 | NFCReadBlockCommand NfcProtocol::GetReadBlockCommand(std::size_t pages) const { | ||
| 366 | if (pages == 0) { | ||
| 367 | return { | ||
| 368 | .block_count = 1, | ||
| 369 | }; | ||
| 370 | } | ||
| 371 | |||
| 372 | if (pages == 45) { | ||
| 373 | return { | ||
| 374 | .block_count = 1, | ||
| 375 | .blocks = | ||
| 376 | { | ||
| 377 | NFCReadBlock{0x00, 0x2C}, | ||
| 378 | }, | ||
| 379 | }; | ||
| 380 | } | ||
| 381 | |||
| 382 | if (pages == 135) { | ||
| 383 | return { | ||
| 384 | .block_count = 3, | ||
| 385 | .blocks = | ||
| 386 | { | ||
| 387 | NFCReadBlock{0x00, 0x3b}, | ||
| 388 | {0x3c, 0x77}, | ||
| 389 | {0x78, 0x86}, | ||
| 390 | }, | ||
| 391 | }; | ||
| 392 | } | ||
| 393 | |||
| 394 | if (pages == 231) { | ||
| 395 | return { | ||
| 396 | .block_count = 4, | ||
| 397 | .blocks = | ||
| 398 | { | ||
| 399 | NFCReadBlock{0x00, 0x3b}, | ||
| 400 | {0x3c, 0x77}, | ||
| 401 | {0x78, 0x83}, | ||
| 402 | {0xb4, 0xe6}, | ||
| 403 | }, | ||
| 404 | }; | ||
| 405 | } | ||
| 406 | |||
| 407 | return {}; | ||
| 408 | } | ||
| 409 | |||
| 410 | bool NfcProtocol::IsEnabled() { | ||
| 411 | return is_enabled; | ||
| 412 | } | ||
| 413 | |||
| 414 | } // namespace InputCommon::Joycon | ||
diff --git a/src/input_common/helpers/joycon_protocol/nfc.h b/src/input_common/helpers/joycon_protocol/nfc.h new file mode 100644 index 000000000..0ede03d50 --- /dev/null +++ b/src/input_common/helpers/joycon_protocol/nfc.h | |||
| @@ -0,0 +1,61 @@ | |||
| 1 | // SPDX-FileCopyrightText: Copyright 2022 yuzu Emulator Project | ||
| 2 | // SPDX-License-Identifier: GPL-2.0-or-later | ||
| 3 | |||
| 4 | // Based on dkms-hid-nintendo implementation, CTCaer joycon toolkit and dekuNukem reverse | ||
| 5 | // engineering https://github.com/nicman23/dkms-hid-nintendo/blob/master/src/hid-nintendo.c | ||
| 6 | // https://github.com/CTCaer/jc_toolkit | ||
| 7 | // https://github.com/dekuNukem/Nintendo_Switch_Reverse_Engineering | ||
| 8 | |||
| 9 | #pragma once | ||
| 10 | |||
| 11 | #include <vector> | ||
| 12 | |||
| 13 | #include "input_common/helpers/joycon_protocol/common_protocol.h" | ||
| 14 | #include "input_common/helpers/joycon_protocol/joycon_types.h" | ||
| 15 | |||
| 16 | namespace InputCommon::Joycon { | ||
| 17 | |||
| 18 | class NfcProtocol final : private JoyconCommonProtocol { | ||
| 19 | public: | ||
| 20 | NfcProtocol(std::shared_ptr<JoyconHandle> handle); | ||
| 21 | |||
| 22 | DriverResult EnableNfc(); | ||
| 23 | |||
| 24 | DriverResult DisableNfc(); | ||
| 25 | |||
| 26 | DriverResult StartNFCPollingMode(); | ||
| 27 | |||
| 28 | DriverResult ScanAmiibo(std::vector<u8>& data); | ||
| 29 | |||
| 30 | bool HasAmiibo(); | ||
| 31 | |||
| 32 | bool IsEnabled(); | ||
| 33 | |||
| 34 | private: | ||
| 35 | struct TagFoundData { | ||
| 36 | u8 type; | ||
| 37 | std::vector<u8> uuid; | ||
| 38 | }; | ||
| 39 | |||
| 40 | DriverResult WaitUntilNfcIsReady(); | ||
| 41 | |||
| 42 | DriverResult StartPolling(TagFoundData& data); | ||
| 43 | |||
| 44 | DriverResult ReadTag(const TagFoundData& data); | ||
| 45 | |||
| 46 | DriverResult GetAmiiboData(std::vector<u8>& data); | ||
| 47 | |||
| 48 | DriverResult SendStartPollingRequest(std::vector<u8>& output); | ||
| 49 | |||
| 50 | DriverResult SendStopPollingRequest(std::vector<u8>& output); | ||
| 51 | |||
| 52 | DriverResult SendStartWaitingRecieveRequest(std::vector<u8>& output); | ||
| 53 | |||
| 54 | DriverResult SendReadAmiiboRequest(std::vector<u8>& output, std::size_t ntag_pages); | ||
| 55 | |||
| 56 | NFCReadBlockCommand GetReadBlockCommand(std::size_t pages) const; | ||
| 57 | |||
| 58 | bool is_enabled{}; | ||
| 59 | }; | ||
| 60 | |||
| 61 | } // namespace InputCommon::Joycon | ||
diff --git a/src/input_common/helpers/joycon_protocol/poller.cpp b/src/input_common/helpers/joycon_protocol/poller.cpp index cb76e1e06..fd05d98f3 100644 --- a/src/input_common/helpers/joycon_protocol/poller.cpp +++ b/src/input_common/helpers/joycon_protocol/poller.cpp | |||
| @@ -74,6 +74,10 @@ void JoyconPoller::UpdateColor(const Color& color) { | |||
| 74 | callbacks.on_color_data(color); | 74 | callbacks.on_color_data(color); |
| 75 | } | 75 | } |
| 76 | 76 | ||
| 77 | void JoyconPoller::updateAmiibo(const std::vector<u8>& amiibo_data) { | ||
| 78 | callbacks.on_amiibo_data(amiibo_data); | ||
| 79 | } | ||
| 80 | |||
| 77 | void JoyconPoller::UpdateRing(s16 value, const RingStatus& ring_status) { | 81 | void JoyconPoller::UpdateRing(s16 value, const RingStatus& ring_status) { |
| 78 | float normalized_value = static_cast<float>(value - ring_status.default_value); | 82 | float normalized_value = static_cast<float>(value - ring_status.default_value); |
| 79 | if (normalized_value > 0) { | 83 | if (normalized_value > 0) { |
diff --git a/src/input_common/helpers/joycon_protocol/poller.h b/src/input_common/helpers/joycon_protocol/poller.h index 68b14b8ba..c40fc7bca 100644 --- a/src/input_common/helpers/joycon_protocol/poller.h +++ b/src/input_common/helpers/joycon_protocol/poller.h | |||
| @@ -36,6 +36,7 @@ public: | |||
| 36 | 36 | ||
| 37 | void UpdateColor(const Color& color); | 37 | void UpdateColor(const Color& color); |
| 38 | void UpdateRing(s16 value, const RingStatus& ring_status); | 38 | void UpdateRing(s16 value, const RingStatus& ring_status); |
| 39 | void updateAmiibo(const std::vector<u8>& amiibo_data); | ||
| 39 | 40 | ||
| 40 | private: | 41 | private: |
| 41 | void UpdateActiveLeftPadInput(const InputReportActive& input, | 42 | void UpdateActiveLeftPadInput(const InputReportActive& input, |