BloomPatched/src/DebugServers/GdbRsp/CommandPackets/SupportedFeaturesQuery.cpp

#include "SupportedFeaturesQuery.hpp"

#include <QtCore/QString>

#include "src/DebugServers/GdbRsp/Feature.hpp"

#include "src/DebugServers/GdbRsp/ResponsePackets/SupportedFeaturesResponse.hpp"
#include "src/DebugServers/GdbRsp/ResponsePackets/ErrorResponsePacket.hpp"

#include "src/Logger/Logger.hpp"
#include "src/Exceptions/Exception.hpp"
#include "src/DebugServers/GdbRsp/Exceptions/ClientNotSupported.hpp"

namespace Bloom::DebugServers::Gdb::CommandPackets
{
    using ResponsePackets::SupportedFeaturesResponse;
    using ResponsePackets::ErrorResponsePacket;

    using Bloom::Exceptions::Exception;
    using Gdb::Exceptions::ClientNotSupported;

    void SupportedFeaturesQuery::init() {
        /*
         * For qSupported packets, supported and unsupported GDB features are reported in the packet
         * data, where each GDB feature is separated by a semicolon.
         */

        // The "qSupported:" prefix occupies 11 bytes
        if (data.size() > 11) {
            auto packetData = QString::fromLocal8Bit(
                reinterpret_cast<const char*>(this->data.data() + 11),
                static_cast<int>(this->data.size() - 11)
            );

            auto featureList = packetData.split(";");
            auto gdbFeatureMapping = getGdbFeatureToNameMapping();

            for (int i = 0; i < featureList.size(); i++) {
                auto featureString = featureList.at(i);

                // We only care about supported features. Supported features will precede a '+' character.
                if (featureString[featureString.size() - 1] == '+') {
                    featureString.remove('+');

                    auto feature = gdbFeatureMapping.valueAt(featureString.toStdString());
                    if (feature.has_value()) {
                        this->supportedFeatures.insert(static_cast<decltype(feature)::value_type>(feature.value()));
                    }
                }
            }
        }
    }

    void SupportedFeaturesQuery::handle(DebugSession& debugSession, TargetControllerConsole& targetControllerConsole) {
        Logger::debug("Handling QuerySupport packet");

        if (!this->isFeatureSupported(Feature::HARDWARE_BREAKPOINTS)
            && !this->isFeatureSupported(Feature::SOFTWARE_BREAKPOINTS)
        ) {
            // All GDB clients are expected to support breakpoints!
            throw ClientNotSupported("GDB client does not support HW or SW breakpoints");
        }

        // Respond with a SupportedFeaturesResponse packet, listing all supported GDB features by Bloom
        auto response = SupportedFeaturesResponse({
            {Feature::SOFTWARE_BREAKPOINTS, std::nullopt},
            {Feature::PACKET_SIZE, std::to_string(debugSession.connection.getMaxPacketSize())},
        });

        debugSession.connection.writePacket(response);
    }
}