service: nfp: Implement mount target and open application area errors, minor fixes

This commit is contained in:
Narr the Reg 2022-09-28 00:47:51 -05:00 committed by german77
parent 673de3995b
commit d9d566bd3f
5 changed files with 124 additions and 19 deletions

View File

@ -58,8 +58,9 @@ bool IsAmiiboValid(const EncryptedNTAG215File& ntag_file) {
if (amiibo_data.model_info.constant_value != 0x02) { if (amiibo_data.model_info.constant_value != 0x02) {
return false; return false;
} }
// dynamic_lock value apparently is not constant if ((ntag_file.dynamic_lock & 0xFFFFFF) != 0x0F0001U) {
// ntag_file.dynamic_lock == 0x0F0001 return false;
}
if (ntag_file.CFG0 != 0x04000000U) { if (ntag_file.CFG0 != 0x04000000U) {
return false; return false;
} }
@ -85,7 +86,7 @@ NTAG215File NfcDataToEncodedData(const EncryptedNTAG215File& nfc_data) {
encoded_data.applicaton_write_counter = nfc_data.user_memory.applicaton_write_counter; encoded_data.applicaton_write_counter = nfc_data.user_memory.applicaton_write_counter;
encoded_data.application_area_id = nfc_data.user_memory.application_area_id; encoded_data.application_area_id = nfc_data.user_memory.application_area_id;
encoded_data.unknown = nfc_data.user_memory.unknown; encoded_data.unknown = nfc_data.user_memory.unknown;
encoded_data.hash = nfc_data.user_memory.hash; encoded_data.unknown2 = nfc_data.user_memory.unknown2;
encoded_data.application_area = nfc_data.user_memory.application_area; encoded_data.application_area = nfc_data.user_memory.application_area;
encoded_data.hmac_tag = nfc_data.user_memory.hmac_tag; encoded_data.hmac_tag = nfc_data.user_memory.hmac_tag;
encoded_data.lock_bytes = nfc_data.uuid.lock_bytes; encoded_data.lock_bytes = nfc_data.uuid.lock_bytes;
@ -116,7 +117,7 @@ EncryptedNTAG215File EncodedDataToNfcData(const NTAG215File& encoded_data) {
nfc_data.user_memory.applicaton_write_counter = encoded_data.applicaton_write_counter; nfc_data.user_memory.applicaton_write_counter = encoded_data.applicaton_write_counter;
nfc_data.user_memory.application_area_id = encoded_data.application_area_id; nfc_data.user_memory.application_area_id = encoded_data.application_area_id;
nfc_data.user_memory.unknown = encoded_data.unknown; nfc_data.user_memory.unknown = encoded_data.unknown;
nfc_data.user_memory.hash = encoded_data.hash; nfc_data.user_memory.unknown2 = encoded_data.unknown2;
nfc_data.user_memory.application_area = encoded_data.application_area; nfc_data.user_memory.application_area = encoded_data.application_area;
nfc_data.user_memory.hmac_tag = encoded_data.hmac_tag; nfc_data.user_memory.hmac_tag = encoded_data.hmac_tag;
nfc_data.user_memory.model_info = encoded_data.model_info; nfc_data.user_memory.model_info = encoded_data.model_info;
@ -181,7 +182,6 @@ std::vector<u8> GenerateInternalKey(const InternalKey& key, const HashSeed& seed
void CryptoInit(CryptoCtx& ctx, mbedtls_md_context_t& hmac_ctx, const HmacKey& hmac_key, void CryptoInit(CryptoCtx& ctx, mbedtls_md_context_t& hmac_ctx, const HmacKey& hmac_key,
const std::vector<u8>& seed) { const std::vector<u8>& seed) {
// Initialize context // Initialize context
ctx.used = false; ctx.used = false;
ctx.counter = 0; ctx.counter = 0;

View File

@ -85,7 +85,7 @@ void NfpDevice::NpadUpdate(Core::HID::ControllerTriggerType type) {
} }
} }
bool NfpDevice::LoadAmiibo(const std::vector<u8>& data) { bool NfpDevice::LoadAmiibo(std::span<const u8> data) {
if (device_state != DeviceState::SearchingForTag) { if (device_state != DeviceState::SearchingForTag) {
LOG_ERROR(Service_NFP, "Game is not looking for amiibos, current state {}", device_state); LOG_ERROR(Service_NFP, "Game is not looking for amiibos, current state {}", device_state);
return false; return false;
@ -176,6 +176,19 @@ Result NfpDevice::StopDetection() {
} }
Result NfpDevice::Flush() { Result NfpDevice::Flush() {
if (device_state != DeviceState::TagMounted) {
LOG_ERROR(Service_NFP, "Wrong device state {}", device_state);
if (device_state == DeviceState::TagRemoved) {
return TagRemoved;
}
return WrongDeviceState;
}
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
auto& settings = tag_data.settings; auto& settings = tag_data.settings;
const auto& current_date = GetAmiiboDate(current_posix_time); const auto& current_date = GetAmiiboDate(current_posix_time);
@ -206,7 +219,7 @@ Result NfpDevice::Flush() {
return ResultSuccess; return ResultSuccess;
} }
Result NfpDevice::Mount() { Result NfpDevice::Mount(MountTarget mount_target_) {
if (device_state != DeviceState::TagFound) { if (device_state != DeviceState::TagFound) {
LOG_ERROR(Service_NFP, "Wrong device state {}", device_state); LOG_ERROR(Service_NFP, "Wrong device state {}", device_state);
return WrongDeviceState; return WrongDeviceState;
@ -218,6 +231,7 @@ Result NfpDevice::Mount() {
} }
device_state = DeviceState::TagMounted; device_state = DeviceState::TagMounted;
mount_target = mount_target_;
return ResultSuccess; return ResultSuccess;
} }
@ -233,6 +247,9 @@ Result NfpDevice::Unmount() {
} }
device_state = DeviceState::TagFound; device_state = DeviceState::TagFound;
mount_target = MountTarget::None;
is_app_area_open = false;
return ResultSuccess; return ResultSuccess;
} }
@ -245,8 +262,8 @@ Result NfpDevice::GetTagInfo(TagInfo& tag_info) const {
tag_info = { tag_info = {
.uuid = encrypted_tag_data.uuid.uid, .uuid = encrypted_tag_data.uuid.uid,
.uuid_length = static_cast<u8>(encrypted_tag_data.uuid.uid.size()), .uuid_length = static_cast<u8>(encrypted_tag_data.uuid.uid.size()),
.protocol = 1, .protocol = TagProtocol::TypeA,
.tag_type = 2, .tag_type = TagType::Type2,
}; };
return ResultSuccess; return ResultSuccess;
@ -255,6 +272,14 @@ Result NfpDevice::GetTagInfo(TagInfo& tag_info) const {
Result NfpDevice::GetCommonInfo(CommonInfo& common_info) const { Result NfpDevice::GetCommonInfo(CommonInfo& common_info) const {
if (device_state != DeviceState::TagMounted) { if (device_state != DeviceState::TagMounted) {
LOG_ERROR(Service_NFP, "Wrong device state {}", device_state); LOG_ERROR(Service_NFP, "Wrong device state {}", device_state);
if (device_state == DeviceState::TagRemoved) {
return TagRemoved;
}
return WrongDeviceState;
}
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState; return WrongDeviceState;
} }
@ -301,6 +326,11 @@ Result NfpDevice::GetRegisterInfo(RegisterInfo& register_info) const {
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
if (tag_data.settings.settings.amiibo_initialized == 0) { if (tag_data.settings.settings.amiibo_initialized == 0) {
return RegistrationIsNotInitialized; return RegistrationIsNotInitialized;
} }
@ -333,6 +363,11 @@ Result NfpDevice::SetNicknameAndOwner(const AmiiboName& amiibo_name) {
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
Service::Mii::MiiManager manager; Service::Mii::MiiManager manager;
auto& settings = tag_data.settings; auto& settings = tag_data.settings;
@ -350,6 +385,19 @@ Result NfpDevice::SetNicknameAndOwner(const AmiiboName& amiibo_name) {
} }
Result NfpDevice::RestoreAmiibo() { Result NfpDevice::RestoreAmiibo() {
if (device_state != DeviceState::TagMounted) {
LOG_ERROR(Service_NFP, "Wrong device state {}", device_state);
if (device_state == DeviceState::TagRemoved) {
return TagRemoved;
}
return WrongDeviceState;
}
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
// TODO: Load amiibo from backup on system // TODO: Load amiibo from backup on system
LOG_ERROR(Service_NFP, "Not Implemented"); LOG_ERROR(Service_NFP, "Not Implemented");
return ResultSuccess; return ResultSuccess;
@ -385,6 +433,11 @@ Result NfpDevice::OpenApplicationArea(u32 access_id) {
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
if (tag_data.settings.settings.appdata_initialized.Value() == 0) { if (tag_data.settings.settings.appdata_initialized.Value() == 0) {
LOG_WARNING(Service_NFP, "Application area is not initialized"); LOG_WARNING(Service_NFP, "Application area is not initialized");
return ApplicationAreaIsNotInitialized; return ApplicationAreaIsNotInitialized;
@ -395,6 +448,8 @@ Result NfpDevice::OpenApplicationArea(u32 access_id) {
return WrongApplicationAreaId; return WrongApplicationAreaId;
} }
is_app_area_open = true;
return ResultSuccess; return ResultSuccess;
} }
@ -407,6 +462,16 @@ Result NfpDevice::GetApplicationArea(std::vector<u8>& data) const {
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
if (!is_app_area_open) {
LOG_ERROR(Service_NFP, "Application area is not open");
return WrongDeviceState;
}
if (tag_data.settings.settings.appdata_initialized.Value() == 0) { if (tag_data.settings.settings.appdata_initialized.Value() == 0) {
LOG_ERROR(Service_NFP, "Application area is not initialized"); LOG_ERROR(Service_NFP, "Application area is not initialized");
return ApplicationAreaIsNotInitialized; return ApplicationAreaIsNotInitialized;
@ -422,7 +487,7 @@ Result NfpDevice::GetApplicationArea(std::vector<u8>& data) const {
return ResultSuccess; return ResultSuccess;
} }
Result NfpDevice::SetApplicationArea(const std::vector<u8>& data) { Result NfpDevice::SetApplicationArea(std::span<const u8> data) {
if (device_state != DeviceState::TagMounted) { if (device_state != DeviceState::TagMounted) {
LOG_ERROR(Service_NFP, "Wrong device state {}", device_state); LOG_ERROR(Service_NFP, "Wrong device state {}", device_state);
if (device_state == DeviceState::TagRemoved) { if (device_state == DeviceState::TagRemoved) {
@ -431,6 +496,16 @@ Result NfpDevice::SetApplicationArea(const std::vector<u8>& data) {
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
if (!is_app_area_open) {
LOG_ERROR(Service_NFP, "Application area is not open");
return WrongDeviceState;
}
if (tag_data.settings.settings.appdata_initialized.Value() == 0) { if (tag_data.settings.settings.appdata_initialized.Value() == 0) {
LOG_ERROR(Service_NFP, "Application area is not initialized"); LOG_ERROR(Service_NFP, "Application area is not initialized");
return ApplicationAreaIsNotInitialized; return ApplicationAreaIsNotInitialized;
@ -442,8 +517,10 @@ Result NfpDevice::SetApplicationArea(const std::vector<u8>& data) {
} }
Common::TinyMT rng{}; Common::TinyMT rng{};
rng.GenerateRandomBytes(tag_data.application_area.data(), sizeof(ApplicationArea));
std::memcpy(tag_data.application_area.data(), data.data(), data.size()); std::memcpy(tag_data.application_area.data(), data.data(), data.size());
// HW seems to fill excess data with garbage
rng.GenerateRandomBytes(tag_data.application_area.data() + data.size(),
sizeof(ApplicationArea) - data.size());
tag_data.applicaton_write_counter++; tag_data.applicaton_write_counter++;
is_data_moddified = true; is_data_moddified = true;
@ -477,6 +554,11 @@ Result NfpDevice::RecreateApplicationArea(u32 access_id, std::span<const u8> dat
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
if (data.size() > sizeof(ApplicationArea)) { if (data.size() > sizeof(ApplicationArea)) {
LOG_ERROR(Service_NFP, "Wrong data size {}", data.size()); LOG_ERROR(Service_NFP, "Wrong data size {}", data.size());
return ResultUnknown; return ResultUnknown;
@ -508,6 +590,11 @@ Result NfpDevice::DeleteApplicationArea() {
return WrongDeviceState; return WrongDeviceState;
} }
if (mount_target == MountTarget::None || mount_target == MountTarget::Rom) {
LOG_ERROR(Service_NFP, "Amiibo is read only", device_state);
return WrongDeviceState;
}
Common::TinyMT rng{}; Common::TinyMT rng{};
rng.GenerateRandomBytes(tag_data.application_area.data(), sizeof(ApplicationArea)); rng.GenerateRandomBytes(tag_data.application_area.data(), sizeof(ApplicationArea));
rng.GenerateRandomBytes(&tag_data.title_id, sizeof(u64)); rng.GenerateRandomBytes(&tag_data.title_id, sizeof(u64));

View File

@ -40,7 +40,7 @@ public:
Result StartDetection(s32 protocol_); Result StartDetection(s32 protocol_);
Result StopDetection(); Result StopDetection();
Result Mount(); Result Mount(MountTarget mount_target);
Result Unmount(); Result Unmount();
Result Flush(); Result Flush();
@ -55,7 +55,7 @@ public:
Result OpenApplicationArea(u32 access_id); Result OpenApplicationArea(u32 access_id);
Result GetApplicationArea(std::vector<u8>& data) const; Result GetApplicationArea(std::vector<u8>& data) const;
Result SetApplicationArea(const std::vector<u8>& data); Result SetApplicationArea(std::span<const u8> data);
Result CreateApplicationArea(u32 access_id, std::span<const u8> data); Result CreateApplicationArea(u32 access_id, std::span<const u8> data);
Result RecreateApplicationArea(u32 access_id, std::span<const u8> data); Result RecreateApplicationArea(u32 access_id, std::span<const u8> data);
Result DeleteApplicationArea(); Result DeleteApplicationArea();
@ -70,7 +70,7 @@ public:
private: private:
void NpadUpdate(Core::HID::ControllerTriggerType type); void NpadUpdate(Core::HID::ControllerTriggerType type);
bool LoadAmiibo(const std::vector<u8>& data); bool LoadAmiibo(std::span<const u8> data);
void CloseAmiibo(); void CloseAmiibo();
AmiiboName GetAmiiboName(const AmiiboSettings& settings) const; AmiiboName GetAmiiboName(const AmiiboSettings& settings) const;
@ -88,8 +88,10 @@ private:
Kernel::KEvent* availability_change_event = nullptr; Kernel::KEvent* availability_change_event = nullptr;
bool is_data_moddified{}; bool is_data_moddified{};
bool is_app_area_open{};
s32 protocol{}; s32 protocol{};
s64 current_posix_time{}; s64 current_posix_time{};
MountTarget mount_target{MountTarget::None};
DeviceState device_state{DeviceState::Unavailable}; DeviceState device_state{DeviceState::Unavailable};
NTAG215File tag_data{}; NTAG215File tag_data{};

View File

@ -75,6 +75,22 @@ enum class AmiiboSeries : u8 {
Diablo, Diablo,
}; };
enum class TagType : u32 {
None,
Type1, // ISO14443A RW 96-2k bytes 106kbit/s
Type2, // ISO14443A RW/RO 540 bytes 106kbit/s
Type3, // Sony Felica RW/RO 2k bytes 212kbit/s
Type4, // ISO14443A RW/RO 4k-32k bytes 424kbit/s
Type5, // ISO15693 RW/RO 540 bytes 106kbit/s
};
enum class TagProtocol : u32 {
None,
TypeA, // ISO14443A
TypeB, // ISO14443B
TypeF, // Sony Felica
};
using UniqueSerialNumber = std::array<u8, 7>; using UniqueSerialNumber = std::array<u8, 7>;
using LockBytes = std::array<u8, 2>; using LockBytes = std::array<u8, 2>;
using HashData = std::array<u8, 0x20>; using HashData = std::array<u8, 0x20>;
@ -174,7 +190,7 @@ struct EncryptedAmiiboFile {
u16_be applicaton_write_counter; // Encrypted Counter u16_be applicaton_write_counter; // Encrypted Counter
u32_be application_area_id; // Encrypted Game id u32_be application_area_id; // Encrypted Game id
std::array<u8, 0x2> unknown; std::array<u8, 0x2> unknown;
HashData hash; // Probably a SHA256-HMAC hash? std::array<u32, 0x8> unknown2;
ApplicationArea application_area; // Encrypted Game data ApplicationArea application_area; // Encrypted Game data
}; };
static_assert(sizeof(EncryptedAmiiboFile) == 0x1F8, "AmiiboFile is an invalid size"); static_assert(sizeof(EncryptedAmiiboFile) == 0x1F8, "AmiiboFile is an invalid size");
@ -193,7 +209,7 @@ struct NTAG215File {
u16_be applicaton_write_counter; // Encrypted Counter u16_be applicaton_write_counter; // Encrypted Counter
u32_be application_area_id; u32_be application_area_id;
std::array<u8, 0x2> unknown; std::array<u8, 0x2> unknown;
HashData hash; // Probably a SHA256-HMAC hash? std::array<u32, 0x8> unknown2;
ApplicationArea application_area; // Encrypted Game data ApplicationArea application_area; // Encrypted Game data
HashData hmac_tag; // Hash HashData hmac_tag; // Hash
UniqueSerialNumber uid; // Unique serial number UniqueSerialNumber uid; // Unique serial number
@ -228,8 +244,8 @@ struct TagInfo {
INSERT_PADDING_BYTES(0x3); INSERT_PADDING_BYTES(0x3);
u8 uuid_length; u8 uuid_length;
INSERT_PADDING_BYTES(0x15); INSERT_PADDING_BYTES(0x15);
s32 protocol; TagProtocol protocol;
u32 tag_type; TagType tag_type;
INSERT_PADDING_BYTES(0x30); INSERT_PADDING_BYTES(0x30);
}; };
static_assert(sizeof(TagInfo) == 0x58, "TagInfo is an invalid size"); static_assert(sizeof(TagInfo) == 0x58, "TagInfo is an invalid size");

View File

@ -189,7 +189,7 @@ void IUser::Mount(Kernel::HLERequestContext& ctx) {
return; return;
} }
const auto result = device.value()->Mount(); const auto result = device.value()->Mount(mount_target);
IPC::ResponseBuilder rb{ctx, 2}; IPC::ResponseBuilder rb{ctx, 2};
rb.Push(result); rb.Push(result);
} }