diff --git a/debug/gdbserver.py b/debug/gdbserver.py
index 92f7ce33f..8d2293a0f 100755
--- a/debug/gdbserver.py
+++ b/debug/gdbserver.py
@@ -1649,15 +1649,20 @@ def setup(self):
         # pylint: disable=attribute-defined-outside-init
         self.gdb.load()
 
-        misa = self.hart.misa
+        # It may be affected by reset halt
+        misa = self.gdb.p(f"$misa=0x{self.hart.misa:x}")
         self.supported = set()
         if misa & (1<<20):
             self.supported.add(0)
         if misa & (1<<18):
             self.supported.add(1)
         if misa & (1<<7):
-            self.supported.add(2)
+            self.supported_vmodes = self.supported
+        else:
+            self.supported_vmodes = None
         self.supported.add(3)
+        for privilege in self.supported_vmodes:
+           self.supported.add(f"{(1 << 2) + privilege}")
 
         self.disable_pmp()
 
@@ -1672,14 +1677,17 @@ def setup(self):
 class PrivRw(PrivTest):
     """Test reading/writing priv."""
     def test(self):
-        self.write_nop_program(4)
-        for privilege in range(4):
+        self.write_nop_program(6)
+        for privilege in range(6):
             self.gdb.p(f"$priv={privilege}")
             self.gdb.stepi()
             actual = self.gdb.p("$priv")
             assertIn(actual, self.supported)
             if privilege in self.supported:
                 assertEqual(actual, privilege)
+        if self.supported_vmodes:
+            # Restore to machine mode
+            self.gdb.p("$priv=3")
 
 class PrivChange(PrivTest):
     """Test that the core's privilege level actually changes when the debugger