MissionControl/mc_mitm/source/mcmitm_initialization.cpp

93 lines
3.4 KiB
C++

/*
* Copyright (c) 2020-2021 ndeadly
*
* 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>
#include <switch.h>
#include "mcmitm_initialization.hpp"
#include "mcmitm_config.hpp"
#include "bluetooth_mitm/btdrv_mitm_service.hpp"
#include "bluetooth_mitm/bluetooth/bluetooth_events.hpp"
#include "bluetooth_mitm/bluetooth/bluetooth_core.hpp"
#include "bluetooth_mitm/bluetooth/bluetooth_hid.hpp"
#include "bluetooth_mitm/bluetooth/bluetooth_ble.hpp"
namespace ams::mitm {
namespace {
constexpr size_t InitializeThreadStackSize = 0x1000;
os::ThreadType g_initialize_thread;
alignas(os::ThreadStackAlignment) u8 g_initialize_thread_stack[InitializeThreadStackSize];
os::Event g_init_event(os::EventClearMode_ManualClear);
void WaitInterfacesInitialized(void) {
while (!(ams::bluetooth::core::IsInitialized() && ams::bluetooth::hid::IsInitialized() && (ams::bluetooth::ble::IsInitialized() || (hos::GetVersion() < hos::Version_5_0_0)))) {
svc::SleepThread(1'000'000ul);
}
}
void InitializeThreadFunc(void *arg) {
// Wait for all bluetooth interfaces to be initialised
WaitInterfacesInitialized();
// Connect to btdrv service now that we're sure the mitm is up and running
sm::DoWithSession([&]() {
R_ABORT_UNLESS(btdrvInitialize());
});
// Start bluetooth event handling thread
ams::bluetooth::events::Initialize();
// Get global module settings
auto config = GetGlobalConfig();
// Wait for system to call BluetoothEnable so the proceeding adapter properties aren't overwritten
ams::bluetooth::core::WaitEnabled();
// Set bluetooth adapter host address override
ams::bluetooth::Address null_address = {};
if (std::memcmp(&config->bluetooth.host_address, &null_address, sizeof(ams::bluetooth::Address)) != 0) {
R_ABORT_UNLESS(btdrvSetAdapterProperty(BtdrvBluetoothPropertyType_Address, &config->bluetooth.host_address, sizeof(ams::bluetooth::Address)));
}
// Set bluetooth adapter host name override
if (std::strlen(config->bluetooth.host_name) > 0) {
R_ABORT_UNLESS(btdrvSetAdapterProperty(BtdrvBluetoothPropertyType_Name, config->bluetooth.host_name, std::strlen(config->bluetooth.host_name)));
}
g_init_event.Signal();
}
}
void StartInitialize(void) {
R_ABORT_UNLESS(os::CreateThread(&g_initialize_thread,
InitializeThreadFunc,
nullptr,
g_initialize_thread_stack,
sizeof(g_initialize_thread_stack),
-7
));
os::StartThread(&g_initialize_thread);
}
void WaitInitialized(void) {
g_init_event.Wait();
}
}