mirror of
https://github.com/Atmosphere-NX/Atmosphere
synced 2024-12-26 22:51:12 +00:00
171 lines
7.5 KiB
C++
171 lines
7.5 KiB
C++
/*
|
|
* Copyright (c) Atmosphère-NX
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
#include <stratosphere.hpp>
|
|
|
|
namespace ams::sf::cmif {
|
|
|
|
namespace {
|
|
|
|
constexpr inline u32 InHeaderMagic = util::FourCC<'S','F','C','I'>::Code;
|
|
constexpr inline u32 OutHeaderMagic = util::FourCC<'S','F','C','O'>::Code;
|
|
#if defined(ATMOSPHERE_OS_HORIZON)
|
|
static_assert(InHeaderMagic == CMIF_IN_HEADER_MAGIC);
|
|
static_assert(OutHeaderMagic == CMIF_OUT_HEADER_MAGIC);
|
|
#endif
|
|
|
|
ALWAYS_INLINE decltype(ServiceCommandMeta::handler) FindCommandHandlerByBinarySearch(const ServiceCommandMeta *entries, const size_t entry_count, const u32 cmd_id, const hos::Version hos_version) {
|
|
/* Binary search for the handler. */
|
|
ssize_t lo = 0;
|
|
ssize_t hi = entry_count - 1;
|
|
while (lo <= hi) {
|
|
const size_t mid = (lo + hi) / 2;
|
|
if (entries[mid].cmd_id < cmd_id) {
|
|
lo = mid + 1;
|
|
} else if (entries[mid].cmd_id > cmd_id) {
|
|
hi = mid - 1;
|
|
} else {
|
|
/* Find start. */
|
|
size_t start = mid;
|
|
while (start > 0 && entries[start - 1].cmd_id == cmd_id) {
|
|
--start;
|
|
}
|
|
|
|
/* Find end. */
|
|
size_t end = mid + 1;
|
|
while (end < entry_count && entries[end].cmd_id == cmd_id) {
|
|
++end;
|
|
}
|
|
|
|
for (size_t idx = start; idx < end; ++idx) {
|
|
if (entries[idx].MatchesVersion(hos_version)) {
|
|
return entries[idx].GetHandler();
|
|
}
|
|
}
|
|
|
|
break;
|
|
}
|
|
}
|
|
|
|
return nullptr;
|
|
}
|
|
|
|
ALWAYS_INLINE decltype(ServiceCommandMeta::handler) FindCommandHandlerByLinearSearch(const ServiceCommandMeta *entries, const size_t entry_count, const u32 cmd_id, const hos::Version hos_version) {
|
|
for (size_t i = 0; i < entry_count; ++i) {
|
|
if (entries[i].Matches(cmd_id, hos_version)) {
|
|
return entries[i].GetHandler();
|
|
break;
|
|
}
|
|
}
|
|
|
|
return nullptr;
|
|
}
|
|
|
|
ALWAYS_INLINE decltype(ServiceCommandMeta::handler) FindCommandHandler(const ServiceCommandMeta *entries, const size_t entry_count, const u32 cmd_id, const hos::Version hos_version) {
|
|
if (entry_count >= 8) {
|
|
return FindCommandHandlerByBinarySearch(entries, entry_count, cmd_id, hos_version);
|
|
} else {
|
|
return FindCommandHandlerByLinearSearch(entries, entry_count, cmd_id, hos_version);
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
Result impl::ServiceDispatchTableBase::ProcessMessageImpl(ServiceDispatchContext &ctx, const cmif::PointerAndSize &in_raw_data, const ServiceCommandMeta *entries, const size_t entry_count, u32 interface_id_for_debug) const {
|
|
/* Get versioning info. */
|
|
const auto hos_version = hos::GetVersion();
|
|
const u32 max_cmif_version = hos_version >= hos::Version_5_0_0 ? 1 : 0;
|
|
|
|
/* Parse the CMIF in header. */
|
|
const CmifInHeader *in_header = reinterpret_cast<const CmifInHeader *>(in_raw_data.GetPointer());
|
|
R_UNLESS(in_raw_data.GetSize() >= sizeof(*in_header), sf::cmif::ResultInvalidHeaderSize());
|
|
R_UNLESS(in_header->magic == InHeaderMagic && in_header->version <= max_cmif_version, sf::cmif::ResultInvalidInHeader());
|
|
const cmif::PointerAndSize in_message_raw_data = cmif::PointerAndSize(in_raw_data.GetAddress() + sizeof(*in_header), in_raw_data.GetSize() - sizeof(*in_header));
|
|
const u32 cmd_id = in_header->command_id;
|
|
|
|
/* Find a handler. */
|
|
const auto cmd_handler = FindCommandHandler(entries, entry_count, cmd_id, hos_version);
|
|
R_UNLESS(cmd_handler != nullptr, sf::cmif::ResultUnknownCommandId());
|
|
|
|
/* Invoke handler. */
|
|
CmifOutHeader *out_header = nullptr;
|
|
Result command_result = cmd_handler(&out_header, ctx, in_message_raw_data);
|
|
|
|
/* Forward any meta-context change result. */
|
|
if (sf::impl::ResultRequestContextChanged::Includes(command_result)) {
|
|
R_RETURN(command_result);
|
|
}
|
|
|
|
/* Otherwise, ensure that we're able to write the output header. */
|
|
if (out_header == nullptr) {
|
|
AMS_ABORT_UNLESS(R_FAILED(command_result));
|
|
R_RETURN(command_result);
|
|
}
|
|
|
|
/* Write output header to raw data. */
|
|
*out_header = CmifOutHeader{OutHeaderMagic, 0, command_result.GetValue(), interface_id_for_debug};
|
|
|
|
R_SUCCEED();
|
|
}
|
|
|
|
#if AMS_SF_MITM_SUPPORTED
|
|
Result impl::ServiceDispatchTableBase::ProcessMessageForMitmImpl(ServiceDispatchContext &ctx, const cmif::PointerAndSize &in_raw_data, const ServiceCommandMeta *entries, const size_t entry_count, u32 interface_id_for_debug) const {
|
|
/* Get versioning info. */
|
|
const auto hos_version = hos::GetVersion();
|
|
const u32 max_cmif_version = hos_version >= hos::Version_5_0_0 ? 1 : 0;
|
|
|
|
/* Parse the CMIF in header. */
|
|
const CmifInHeader *in_header = reinterpret_cast<const CmifInHeader *>(in_raw_data.GetPointer());
|
|
R_UNLESS(in_raw_data.GetSize() >= sizeof(*in_header), sf::cmif::ResultInvalidHeaderSize());
|
|
R_UNLESS(in_header->magic == InHeaderMagic && in_header->version <= max_cmif_version, sf::cmif::ResultInvalidInHeader());
|
|
const cmif::PointerAndSize in_message_raw_data = cmif::PointerAndSize(in_raw_data.GetAddress() + sizeof(*in_header), in_raw_data.GetSize() - sizeof(*in_header));
|
|
const u32 cmd_id = in_header->command_id;
|
|
|
|
/* Find a handler. */
|
|
const auto cmd_handler = FindCommandHandler(entries, entry_count, cmd_id, hos_version);
|
|
|
|
/* If we didn't find a handler, forward the request. */
|
|
if (cmd_handler == nullptr) {
|
|
R_RETURN(ctx.session->ForwardRequest(ctx));
|
|
}
|
|
|
|
/* Invoke handler. */
|
|
CmifOutHeader *out_header = nullptr;
|
|
Result command_result = cmd_handler(&out_header, ctx, in_message_raw_data);
|
|
|
|
/* If we should, forward the request to the forward session. */
|
|
if (sm::mitm::ResultShouldForwardToSession::Includes(command_result)) {
|
|
R_RETURN(ctx.session->ForwardRequest(ctx));
|
|
}
|
|
|
|
/* Forward any meta-context change result. */
|
|
if (sf::impl::ResultRequestContextChanged::Includes(command_result)) {
|
|
R_RETURN(command_result);
|
|
}
|
|
|
|
/* Otherwise, ensure that we're able to write the output header. */
|
|
if (out_header == nullptr) {
|
|
AMS_ABORT_UNLESS(R_FAILED(command_result));
|
|
R_RETURN(command_result);
|
|
}
|
|
|
|
/* Write output header to raw data. */
|
|
*out_header = CmifOutHeader{OutHeaderMagic, 0, command_result.GetValue(), interface_id_for_debug};
|
|
|
|
R_SUCCEED();
|
|
}
|
|
#endif
|
|
|
|
}
|