Fixed task switching

Auterion · Sep 13, 2024 · 23a0e19 · 23a0e19
1 parent 8dd263e
commit 23a0e19
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/src/emdbg/debug/px4/base.py b/src/emdbg/debug/px4/base.py
@@ -62,7 +62,8 @@ def write_registers(self, values: dict[str, int]):
             if name in ["sp", "r13"]:
                 name = "msp"
             if name == "msp":
-                self.write_register("r13", value)
+                # NuttX stores the SP incorrectly (is off by 4 bytes)
+                self.write_register("r13", value + 4)
             # Remove double FP registers
             if name.startswith("d"): continue
             self.write_register(name, value)