Atmosphere/stratosphere/dmnt.gen2/source/dmnt2_gdb_server.cpp

/*
 * Copyright (c) 2018-2020 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>
#include "dmnt2_gdb_packet_io.hpp"
#include "dmnt2_gdb_packet_parser.hpp"
#include "dmnt2_gdb_server.hpp"
#include "dmnt2_debug_log.hpp"

namespace ams::dmnt {

    namespace {

        constexpr size_t ServerThreadStackSize = util::AlignUp(4 * GdbPacketBufferSize + os::MemoryPageSize, os::ThreadStackAlignment);

        alignas(os::ThreadStackAlignment) constinit u8 g_server_thread32_stack[ServerThreadStackSize];
        alignas(os::ThreadStackAlignment) constinit u8 g_server_thread64_stack[ServerThreadStackSize];

        constinit os::ThreadType g_server_thread32;
        constinit os::ThreadType g_server_thread64;

        constinit util::TypedStorage<HtcsSession> g_session32;
        constinit util::TypedStorage<HtcsSession> g_session64;


        void ProcessForHtcsSession(HtcsSession *session, bool is_64_bit) {
            /* Create packet io handler. */
            GdbPacketIo packet_io;

            /* Process packets. */
            while (session->IsValid()) {
                /* Receive a packet. */
                bool do_break = false;
                char recv_buf[GdbPacketBufferSize];
                char *packet = packet_io.ReceivePacket(std::addressof(do_break), recv_buf, sizeof(recv_buf), session);

                if (!do_break && packet != nullptr) {
                    /* Create a packet parser. */
                    char reply_buffer[GdbPacketBufferSize];
                    GdbPacketParser parser(packet, reply_buffer, is_64_bit);

                    /* Process the packet. */
                    parser.Process();

                    /* Send packet. */
                    packet_io.SendPacket(std::addressof(do_break), reply_buffer, session);
                }
            }
        }

        template<bool Is64Bit>
        void GdbServerThreadFunction() {
            /* Loop forever, servicing our gdb server. */
            while (true) {
                /* Get a socket. */
                int fd;
                while ((fd = htcs::Socket()) == -1) {
                    os::SleepThread(TimeSpan::FromSeconds(1));
                }

                /* Ensure we cleanup the socket when we're done with it. */
                ON_SCOPE_EXIT {
                    htcs::Close(fd);
                    os::SleepThread(TimeSpan::FromSeconds(1));
                };

                /* Create a sock addr for our server. */
                htcs::SockAddrHtcs addr;
                addr.family    = htcs::HTCS_AF_HTCS;
                addr.peer_name = htcs::GetPeerNameAny();
                std::strcpy(addr.port_name.name, Is64Bit ? "iywys@$gdb-aarch64" : "iywys@$gdb-aarch32");

                /* Bind. */
                if (htcs::Bind(fd, std::addressof(addr)) == -1) {
                    continue;
                }

                /* Listen on our port. */
                while (htcs::Listen(fd, 0) == 0) {
                    /* Continue accepting clients, so long as we can. */
                    int client_fd;
                    while (true) {
                        /* Try to accept a client. */
                        if (client_fd = htcs::Accept(fd, std::addressof(addr)); client_fd < 0) {
                            break;
                        }

                        /* Create htcs session for the socket. */
                        auto &session_storage = Is64Bit ? g_session64 : g_session32;
                        util::ConstructAt(session_storage, client_fd);
                        ON_SCOPE_EXIT { util::DestroyAt(session_storage); };

                        /* Process for the session. */
                        ProcessForHtcsSession(util::GetPointer(session_storage), Is64Bit);

                        /* Close the client socket. */
                        htcs::Close(client_fd);
                    }
                }
            }
        }

        void GdbServerThreadFunction64(void *) {
            GdbServerThreadFunction<true>();
        }

        void GdbServerThreadFunction32(void *) {
            GdbServerThreadFunction<false>();
        }

    }

    void InitializeGdbServer() {
        /* Create and start gdb server threads. */
        R_ABORT_UNLESS(os::CreateThread(std::addressof(g_server_thread64), GdbServerThreadFunction64, nullptr, g_server_thread64_stack, sizeof(g_server_thread64_stack), os::HighestThreadPriority - 1));
        R_ABORT_UNLESS(os::CreateThread(std::addressof(g_server_thread32), GdbServerThreadFunction32, nullptr, g_server_thread32_stack, sizeof(g_server_thread32_stack), os::HighestThreadPriority - 1));
        os::StartThread(std::addressof(g_server_thread64));
        os::StartThread(std::addressof(g_server_thread32));
    }

}