thermopshere: gdb: rewrite stop point handling

thermosphere/src/gdb/stop_points.c

@@ -0,0 +1,70 @@
+/*
+*   This file is part of Luma3DS.
+*   Copyright (C) 2016-2019 Aurora Wright, TuxSH
+*
+*   SPDX-License-Identifier: (MIT OR GPL-2.0-or-later)
+*/
+
+#include <string.h>
+
+#include "../gdb.h"
+#include "net.h"
+
+#include "../breakpoints.h"
+#include "../software_breakpoints.h"
+#include "../watchpoints.h"
+
+GDB_DECLARE_HANDLER(ToggleStopPoint)
+{
+    bool add = ctx->commandData[-1] == 'Z';
+    unsigned long lst[3];
+
+    const char *pos = GDB_ParseHexIntegerList(lst, ctx->commandData, 3, ';');
+    if (pos == NULL) {
+        return GDB_ReplyErrno(ctx, EILSEQ);
+    }
+    bool persist = *pos != 0 && strncmp(pos, ";cmds:1", 7) == 0;
+
+    // In theory we should reject leading zeroes in "kind". Oh well...
+    unsigned long kind = lst[0];
+    uintptr_t addr = lst[1];
+    size_t size = lst[2];
+
+    int res;
+    static const WatchpointLoadStoreControl kinds[3] = {
+        WatchpointLoadStoreControl_Store,
+        WatchpointLoadStoreControl_Load,
+        WatchpointLoadStoreControl_LoadStore,
+    };
+
+    switch(kind) {
+        // Software breakpoint
+        case 0: {
+            if(size != 4) {
+                return GDB_ReplyErrno(ctx, EINVAL);
+            }
+            res = add ? addSoftwareBreakpoint(addr, persist) : removeSoftwareBreakpoint(addr, false);
+            return res == 0 ? GDB_ReplyOk(ctx) : GDB_ReplyErrno(ctx, -res);
+        }
+
+        // Hardware breakpoint
+        case 1: {
+            if(size != 4) {
+                return GDB_ReplyErrno(ctx, EINVAL);
+            }
+            res = add ? addBreakpoint(addr) : removeBreakpoint(addr);
+            return res == 0 ? GDB_ReplyOk(ctx) : GDB_ReplyErrno(ctx, -res);
+        }
+
+        // Watchpoints
+        case 2:
+        case 3:
+        case 4: {
+            res = add ? addWatchpoint(addr, size, kinds[kind - 2]) : removeWatchpoint(addr, size, kinds[kind - 2]);
+            return res == 0 ? GDB_ReplyOk(ctx) : GDB_ReplyErrno(ctx, -res);
+        }
+        default: {
+            return GDB_ReplyEmpty(ctx);
+        }
+    }
+}