MissionControl/mc_mitm/source/mcmitm_initialization.cpp

/*
 * Copyright (c) 2020-2023 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 "async/async.hpp"
#include "bluetooth_mitm/btdrv_mitm_service.hpp"
#include "bluetooth_mitm/bluetoothmitm_module.hpp"
#include "btm_mitm/btmmitm_module.hpp"
#include "mc/mc_module.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_hid_report.hpp"
#include "bluetooth_mitm/bluetooth/bluetooth_ble.hpp"
#include "usb/mc_usb_handler.hpp"

namespace ams::mitm {

    namespace {

        os::Event g_init_event(os::EventClearMode_ManualClear);

        void InitializeThreadFunc(void *) {
            // Start async worker thread(s)
            ams::async::Initialize();

            // Start bluetooth event handling thread
            ams::bluetooth::events::Initialize();

            // Start hid report handling thread
            ams::bluetooth::hid::report::Initialize();

            // Wait for system to call BluetoothEnable
            ams::bluetooth::core::WaitEnabled();

            // Connect to btdrv service now that we're sure the mitm is up and running
            R_ABORT_UNLESS(btdrvInitialize());

            // Get global module settings
            auto config = GetGlobalConfig();

            // 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) {
                if (hos::GetVersion() < hos::Version_12_0_0) {
                    R_ABORT_UNLESS(btdrvLegacySetAdapterProperty(BtdrvBluetoothPropertyType_Address, &config->bluetooth.host_address, sizeof(ams::bluetooth::Address)));
                }
                else {
                    BtdrvAdapterProperty property;
                    property.type = BtdrvAdapterPropertyType_Address;
                    property.size = sizeof(ams::bluetooth::Address);
                    std::memcpy(property.data, &config->bluetooth.host_address, sizeof(ams::bluetooth::Address));
                    R_ABORT_UNLESS(btdrvSetAdapterProperty(BtdrvAdapterPropertyType_Address, &property));
                }
            }

            // Set bluetooth adapter host name override
            if (std::strlen(config->bluetooth.host_name) > 0) {
                if (hos::GetVersion() < hos::Version_12_0_0) {
                    R_ABORT_UNLESS(btdrvLegacySetAdapterProperty(BtdrvBluetoothPropertyType_Name, config->bluetooth.host_name, std::strlen(config->bluetooth.host_name)));
                }
                else {
                    BtdrvAdapterProperty property;
                    property.type = BtdrvAdapterPropertyType_Name;
                    property.size = std::strlen(config->bluetooth.host_name);
                    std::memcpy(property.data, config->bluetooth.host_name, std::strlen(config->bluetooth.host_name));
                    R_ABORT_UNLESS(btdrvSetAdapterProperty(BtdrvAdapterPropertyType_Name, &property));
                }
            }

            g_init_event.Signal();

            // Loop until we can initialise btm:sys
            while (R_FAILED(btmsysInitialize())) {
                os::SleepThread(ams::TimeSpan::FromMilliSeconds(200));
            }

            // Loop until we can initialise btm
            while (R_FAILED(btmInitialize())) {
                os::SleepThread(ams::TimeSpan::FromMilliSeconds(200));
            }
            
        }

    }

    void InitializeModules() {
        const s32 ThreadPriority = -7;
        const size_t ThreadStackSize = 0x1000;
        os::ThreadType init_thread;

        // Allocate temporary thread stack on heap
        struct alignas(os::ThreadStackAlignment) ThreadStack { u8 stack[ThreadStackSize]; };
        auto thread_stack = std::make_unique<ThreadStack>();

        // Create and start initialisation thread
        R_ABORT_UNLESS(os::CreateThread(&init_thread,
            InitializeThreadFunc,
            nullptr,
            thread_stack.get(),
            ThreadStackSize,
            ThreadPriority
        ));
        os::SetThreadNamePointer(&init_thread, "mc::InitThread");
        os::StartThread(&init_thread);

        // Launch mitm and other modules
        R_ABORT_UNLESS(ams::mitm::bluetooth::Launch());
        R_ABORT_UNLESS(ams::mitm::btm::Launch());
        R_ABORT_UNLESS(ams::mitm::mc::Launch());
        R_ABORT_UNLESS(ams::usb::Launch());

        // Wait for initialisation thread to finish and destroy it
        os::WaitThread(&init_thread);
        os::DestroyThread(&init_thread);
    }

    void WaitInitialized() {
        g_init_event.Wait();
    }

    void WaitModules() {
        ams::usb::WaitFinished();
        ams::mitm::mc::WaitFinished();
        ams::mitm::btm::WaitFinished();
        ams::mitm::bluetooth::WaitFinished();
    }

}