[Qemu-devel] [PATCH v2 26/43] windbg: implemented windbg_read_context

[Mihail Abakumov]

Signed-off-by: Mihail Abakumov <mikhail.abaku...@ispras.ru>
Signed-off-by: Pavel Dovgalyuk <dovga...@ispras.ru>
Signed-off-by: Dmitriy Koltunov <koltu...@ispras.ru>
---
 target/i386/windbgstub.c |   96 ++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 96 insertions(+)

diff --git a/target/i386/windbgstub.c b/target/i386/windbgstub.c
index 3e238525da..a3ec5c1c6a 100755
--- a/target/i386/windbgstub.c
+++ b/target/i386/windbgstub.c
@@ -274,6 +274,102 @@ typedef struct _CPU_KPROCESSOR_STATE {
 static int windbg_read_context(CPUState *cpu, uint8_t *buf, int buf_size,
                                int offset, int len)
 {
+    CPUArchState *env = cpu->env_ptr;
+    CPU_CONTEXT *cc;
+    bool new_mem;
+
+    if (len < 0 || len > buf_size) {
+        WINDBG_ERROR("windbg_read_context: incorrect length %d", len);
+        return 1;
+    }
+
+    if (offset < 0 || offset + len > sizeof(CPU_CONTEXT)) {
+        WINDBG_ERROR("windbg_read_context: incorrect offset %d", offset);
+        return 2;
+    }
+
+    new_mem = len != sizeof(CPU_CONTEXT) || offset != 0;
+    if (new_mem) {
+        cc = g_new0(CPU_CONTEXT, 1);
+    } else {
+        cc = (CPU_CONTEXT *) buf;
+        memset(cc, 0, sizeof(CPU_CONTEXT));
+    }
+
+    cc->ContextFlags = CPU_CONTEXT_ALL;
+
+    if (cc->ContextFlags & CPU_CONTEXT_SEGMENTS) {
+        stw_p(&cc->SegCs, env->segs[R_CS].selector);
+        stw_p(&cc->SegDs, env->segs[R_DS].selector);
+        stw_p(&cc->SegEs, env->segs[R_ES].selector);
+        stw_p(&cc->SegFs, env->segs[R_FS].selector);
+        stw_p(&cc->SegGs, env->segs[R_GS].selector);
+        stw_p(&cc->SegSs, env->segs[R_SS].selector);
+    }
+
+    if (cc->ContextFlags & CPU_CONTEXT_DEBUG_REGISTERS) {
+        sttul_p(&cc->Dr0, env->dr[0]);
+        sttul_p(&cc->Dr1, env->dr[1]);
+        sttul_p(&cc->Dr2, env->dr[2]);
+        sttul_p(&cc->Dr3, env->dr[3]);
+        sttul_p(&cc->Dr6, env->dr[6]);
+        sttul_p(&cc->Dr7, env->dr[7]);
+    }
+
+    if (cc->ContextFlags & CPU_CONTEXT_INTEGER) {
+        stl_p(&cc->Edi, env->regs[R_EDI]);
+        stl_p(&cc->Esi, env->regs[R_ESI]);
+        stl_p(&cc->Ebx, env->regs[R_EBX]);
+        stl_p(&cc->Edx, env->regs[R_EDX]);
+        stl_p(&cc->Ecx, env->regs[R_ECX]);
+        stl_p(&cc->Eax, env->regs[R_EAX]);
+        stl_p(&cc->Ebp, env->regs[R_EBP]);
+        stl_p(&cc->Esp, env->regs[R_ESP]);
+        stl_p(&cc->Eip, env->eip);
+        stl_p(&cc->EFlags, env->eflags);
+    }
+
+    if (cc->ContextFlags & CPU_CONTEXT_FLOATING_POINT) {
+        uint32_t swd = 0, twd = 0;
+        swd = env->fpus & ~(7 << 11);
+        swd |= (env->fpstt & 7) << 11;
+        int i;
+        for (i = 0; i < 8; ++i) {
+            twd |= (!env->fptags[i]) << i;
+        }
+
+        stl_p(&cc->FloatSave.ControlWord, env->fpuc);
+        stl_p(&cc->FloatSave.StatusWord, swd);
+        stl_p(&cc->FloatSave.TagWord, twd);
+        stl_p(&cc->FloatSave.ErrorOffset, UINT32_P(&env->fpip)[0]);
+        stl_p(&cc->FloatSave.ErrorSelector, UINT32_P(&env->fpip)[1]);
+        stl_p(&cc->FloatSave.DataOffset, UINT32_P(&env->fpdp)[0]);
+        stl_p(&cc->FloatSave.DataSelector, UINT32_P(&env->fpdp)[1]);
+        stl_p(&cc->FloatSave.Cr0NpxState, env->xcr0);
+
+        for (i = 0; i < 8; ++i) {
+            memcpy(PTR(cc->FloatSave.RegisterArea[i * 10]),
+                   PTR(env->fpregs[i]), 10);
+        }
+    }
+
+    if (cc->ContextFlags & CPU_CONTEXT_EXTENDED_REGISTERS) {
+        uint8_t *ptr = cc->ExtendedRegisters + 160;
+        int i;
+        for (i = 0; i < 8; ++i, ptr += 16) {
+            stq_p(ptr,     env->xmm_regs[i].ZMM_Q(0));
+            stq_p(ptr + 8, env->xmm_regs[i].ZMM_Q(1));
+        }
+
+        stl_p(cc->ExtendedRegisters + 24, env->mxcsr);
+    }
+
+    stl_p(&cc->ContextFlags, cc->ContextFlags);
+
+    if (new_mem) {
+        memcpy(buf, (uint8_t *) cc + offset, len);
+        g_free(cc);
+    }
     return 0;
 }