atmosphere/thermosphere/src/gdb/hvisor_gdb_thread.cpp

/*
 * Copyright (c) 2019-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 <cstdio>

#include "hvisor_gdb_thread.hpp"
#include "hvisor_gdb_defines_internal.hpp"
#include "hvisor_gdb_packet_data.hpp"

#include "../hvisor_core_context.hpp"

namespace ams::hvisor::gdb {

    int ConvertTidToCoreId(unsigned long tid)
    {
        switch (tid) {
            case ULONG_MAX:
                return -1;
            case 0:
                return currentCoreCtx->GetCoreId();
            default:
                return currentCoreCtx->GetCoreId() - 1;
        }
    }

    std::optional<int> ParseConvertExactlyOneTid(std::string_view str)
    {
        if (str.size() == 2 && str[0] == '-' && str[1] == '1') {
            return -1;
        } else  {
            auto [n, tid] = ParseHexIntegerList<1>(str);
            if (n != 0 && tid < MAX_CORE + 1) {
                return ConvertTidToCoreId(tid);
            } else {
                return {};
            }
        }
    }

    // Hg<tid>, Hc<tid>
    GDB_DEFINE_HANDLER(SetThreadId)
    {
        if (!m_commandData.starts_with('g') && !m_commandData.starts_with('c')) {
            return ReplyErrno(EINVAL);
        }

        char kind = m_commandData[0];
        m_commandData.remove_prefix(1);

        auto coreIdOpt = ParseConvertExactlyOneTid(m_commandData);
        if (!coreIdOpt) {
            return ReplyErrno(EILSEQ);
        }

        int coreId = *coreIdOpt;
        if (kind == 'g') {
            if (coreId = -1) {
                return ReplyErrno(EINVAL);
            }
            m_selectedCoreId = coreId;
            MigrateRxIrq(m_selectedCoreId);
        } else {
            m_selectedCoreIdForContinuing = coreId;
        }

        return ReplyOk();
    }

    GDB_DEFINE_HANDLER(IsThreadAlive)
    {
        int coreId = ParseConvertExactlyOneTid(m_commandData).value_or(-1);
        if (coreId < 0) {
            return ReplyErrno(EILSEQ);
        }

        // Is the core off?
        if (m_attachedCoreList & BIT(coreId)) {
            return ReplyOk();
        } else {
            return ReplyErrno(ESRCH);
        }
    }

    GDB_DEFINE_QUERY_HANDLER(CurrentThreadId)
    {
        GDB_CHECK_NO_CMD_DATA();
        return SendFormattedPacket("QC%x", 1 + currentCoreCtx->GetCoreId());
    }

    GDB_DEFINE_QUERY_HANDLER(fThreadInfo)
    {
        GDB_CHECK_NO_CMD_DATA();

        // We have made our GDB packet big enough to list all the thread ids (coreIds + 1 for each coreId)
        char *buf = GetInPlaceOutputBuffer();
        size_t n = 0;

        for (int coreId: util::BitsOf{m_attachedCoreList}) {
            n += sprintf(buf + n, "%lx,", 1u + coreId);
        }

        // Remove trailing comma
        --n;

        return SendStreamData(std::string_view{buf, n}, 0, n, true);
    }

    GDB_DEFINE_QUERY_HANDLER(sThreadInfo)
    {
        GDB_CHECK_NO_CMD_DATA();

        // We have made our GDB packet big enough to list all the thread ids (coreIds + 1 for each coreId) in fThreadInfo
        // Note: we assume GDB doesn't accept notifications during the sequence transfer...
        return SendPacket("l");
    }

    GDB_DEFINE_QUERY_HANDLER(ThreadEvents)
    {
        if (m_commandData.size() != 1) {
            return ReplyErrno(EILSEQ);
        }

        switch (m_commandData[0]) {
            case '0':
                m_catchThreadEvents = false;
                return ReplyOk();
            case '1':
                m_catchThreadEvents = true;
                return ReplyOk();
            default:
                return ReplyErrno(EILSEQ);
        }
    }

    GDB_DEFINE_QUERY_HANDLER(ThreadExtraInfo)
    {
        int coreId = ParseConvertExactlyOneTid(m_commandData).value_or(-1);
        if (coreId < 0) {
            return ReplyErrno(EILSEQ);
        }

        size_t n = sprintf(m_workBuffer, "TODO");

        return SendHexPacket(m_workBuffer, n);
    }
}