M src/debugger/gdb-stub.c → src/debugger/gdb-stub.c

@@ -5,6 +5,7 @@ * License, v. 2.0. If a copy of the MPL was not distributed with this
  * file, You can obtain one at http://mozilla.org/MPL/2.0/. */
 #include "gdb-stub.h"
 
+#include "arm/isa-inlines.h"
 #include "core/core.h"
 #include "gba/memory.h"
 
@@ -295,9 +296,15 @@ struct ARMCore* cpu = stub->d.core->cpu;
 	const char* readAddress = message;
 
 	int r;
-	for (r = 0; r < ARM_PC; ++r) {
+	for (r = 0; r <= ARM_PC; ++r) {
 		cpu->gprs[r] = _hex2int(readAddress, 8);
 		readAddress += 8;
+	}
+	int32_t currentCycles = 0;
+	if (cpu->executionMode == MODE_ARM) {
+		ARM_WRITE_PC;
+	} else {
+		THUMB_WRITE_PC;
 	}
 
 	strncpy(stub->outgoing, "OK", GDB_STUB_MAX_LINE - 4);
@@ -336,8 +343,16 @@ #else
 	value = __builtin_bswap32(value);
 #endif
 
-	if (reg < 0x10) {
+	if (reg <= ARM_PC) {
 		cpu->gprs[reg] = value;
+		if (reg == ARM_PC) {
+			int32_t currentCycles = 0;
+			if (cpu->executionMode == MODE_ARM) {
+				ARM_WRITE_PC;
+			} else {
+				THUMB_WRITE_PC;
+			}
+		}
 	} else if (reg == 0x19) {
 		cpu->cpsr.packed = value;
 	} else {