target/i386/arch_dump.c

   1 /*
   2  * i386 memory mapping
   3  *
   4  * Copyright Fujitsu, Corp. 2011, 2012
   5  *
   6  * Authors:
   7  *     Wen Congyang <wency@cn.fujitsu.com>
   8  *
   9  * This work is licensed under the terms of the GNU GPL, version 2 or later.
  10  * See the COPYING file in the top-level directory.
  11  *
  12  */
  13
  14 #include "qemu/osdep.h"
  15 #include "cpu.h"
  16 #include "sysemu/dump.h"
  17 #include "elf.h"
  18 #include "sysemu/memory_mapping.h"
  19
  20 #define ELF_NOTE_SIZE(hdr_size, name_size, desc_size)   \
  21     ((DIV_ROUND_UP((hdr_size), 4)                       \
  22       + DIV_ROUND_UP((name_size), 4)                    \
  23       + DIV_ROUND_UP((desc_size), 4)) * 4)
  24
  25 #ifdef TARGET_X86_64
  26 typedef struct {
  27     target_ulong r15, r14, r13, r12, rbp, rbx, r11, r10;
  28     target_ulong r9, r8, rax, rcx, rdx, rsi, rdi, orig_rax;
  29     target_ulong rip, cs, eflags;
  30     target_ulong rsp, ss;
  31     target_ulong fs_base, gs_base;
  32     target_ulong ds, es, fs, gs;
  33 } x86_64_user_regs_struct;
  34
  35 typedef struct {
  36     char pad1[32];
  37     uint32_t pid;
  38     char pad2[76];
  39     x86_64_user_regs_struct regs;
  40     char pad3[8];
  41 } x86_64_elf_prstatus;
  42
  43 static int x86_64_write_elf64_note(WriteCoreDumpFunction f,
  44                                    CPUX86State *env, int id,
  45                                    DumpState *s)
  46 {
  47     x86_64_user_regs_struct regs;
  48     Elf64_Nhdr *note;
  49     char *buf;
  50     int descsz, note_size, name_size = 5;
  51     const char *name = "CORE";
  52     int ret;
  53
  54     regs.r15 = env->regs[15];
  55     regs.r14 = env->regs[14];
  56     regs.r13 = env->regs[13];
  57     regs.r12 = env->regs[12];
  58     regs.r11 = env->regs[11];
  59     regs.r10 = env->regs[10];
  60     regs.r9  = env->regs[9];
  61     regs.r8  = env->regs[8];
  62     regs.rbp = env->regs[R_EBP];
  63     regs.rsp = env->regs[R_ESP];
  64     regs.rdi = env->regs[R_EDI];
  65     regs.rsi = env->regs[R_ESI];
  66     regs.rdx = env->regs[R_EDX];
  67     regs.rcx = env->regs[R_ECX];
  68     regs.rbx = env->regs[R_EBX];
  69     regs.rax = env->regs[R_EAX];
  70     regs.rip = env->eip;
  71     regs.eflags = env->eflags;
  72
  73     regs.orig_rax = 0; /* FIXME */
  74     regs.cs = env->segs[R_CS].selector;
  75     regs.ss = env->segs[R_SS].selector;
  76     regs.fs_base = env->segs[R_FS].base;
  77     regs.gs_base = env->segs[R_GS].base;
  78     regs.ds = env->segs[R_DS].selector;
  79     regs.es = env->segs[R_ES].selector;
  80     regs.fs = env->segs[R_FS].selector;
  81     regs.gs = env->segs[R_GS].selector;
  82
  83     descsz = sizeof(x86_64_elf_prstatus);
  84     note_size = ELF_NOTE_SIZE(sizeof(Elf64_Nhdr), name_size, descsz);
  85     note = g_malloc0(note_size);
  86     note->n_namesz = cpu_to_le32(name_size);
  87     note->n_descsz = cpu_to_le32(descsz);
  88     note->n_type = cpu_to_le32(NT_PRSTATUS);
  89     buf = (char *)note;
  90     buf += ROUND_UP(sizeof(Elf64_Nhdr), 4);
  91     memcpy(buf, name, name_size);
  92     buf += ROUND_UP(name_size, 4);
  93     memcpy(buf + 32, &id, 4); /* pr_pid */
  94     buf += descsz - sizeof(x86_64_user_regs_struct)-sizeof(target_ulong);
  95     memcpy(buf, &regs, sizeof(x86_64_user_regs_struct));
  96
  97     ret = f(note, note_size, s);
  98     g_free(note);
  99     if (ret < 0) {
 100         return -1;
 101     }
 102
 103     return 0;
 104 }
 105 #endif
 106
 107 typedef struct {
 108     uint32_t ebx, ecx, edx, esi, edi, ebp, eax;
 109     unsigned short ds, __ds, es, __es;
 110     unsigned short fs, __fs, gs, __gs;
 111     uint32_t orig_eax, eip;
 112     unsigned short cs, __cs;
 113     uint32_t eflags, esp;
 114     unsigned short ss, __ss;
 115 } x86_user_regs_struct;
 116
 117 typedef struct {
 118     char pad1[24];
 119     uint32_t pid;
 120     char pad2[44];
 121     x86_user_regs_struct regs;
 122     char pad3[4];
 123 } x86_elf_prstatus;
 124
 125 static void x86_fill_elf_prstatus(x86_elf_prstatus *prstatus, CPUX86State *env,
 126                                   int id)
 127 {
 128     memset(prstatus, 0, sizeof(x86_elf_prstatus));
 129     prstatus->regs.ebp = env->regs[R_EBP] & 0xffffffff;
 130     prstatus->regs.esp = env->regs[R_ESP] & 0xffffffff;
 131     prstatus->regs.edi = env->regs[R_EDI] & 0xffffffff;
 132     prstatus->regs.esi = env->regs[R_ESI] & 0xffffffff;
 133     prstatus->regs.edx = env->regs[R_EDX] & 0xffffffff;
 134     prstatus->regs.ecx = env->regs[R_ECX] & 0xffffffff;
 135     prstatus->regs.ebx = env->regs[R_EBX] & 0xffffffff;
 136     prstatus->regs.eax = env->regs[R_EAX] & 0xffffffff;
 137     prstatus->regs.eip = env->eip & 0xffffffff;
 138     prstatus->regs.eflags = env->eflags & 0xffffffff;
 139
 140     prstatus->regs.cs = env->segs[R_CS].selector;
 141     prstatus->regs.ss = env->segs[R_SS].selector;
 142     prstatus->regs.ds = env->segs[R_DS].selector;
 143     prstatus->regs.es = env->segs[R_ES].selector;
 144     prstatus->regs.fs = env->segs[R_FS].selector;
 145     prstatus->regs.gs = env->segs[R_GS].selector;
 146
 147     prstatus->pid = id;
 148 }
 149
 150 static int x86_write_elf64_note(WriteCoreDumpFunction f, CPUX86State *env,
 151                                 int id, DumpState *s)
 152 {
 153     x86_elf_prstatus prstatus;
 154     Elf64_Nhdr *note;
 155     char *buf;
 156     int descsz, note_size, name_size = 5;
 157     const char *name = "CORE";
 158     int ret;
 159
 160     x86_fill_elf_prstatus(&prstatus, env, id);
 161     descsz = sizeof(x86_elf_prstatus);
 162     note_size = ELF_NOTE_SIZE(sizeof(Elf64_Nhdr), name_size, descsz);
 163     note = g_malloc0(note_size);
 164     note->n_namesz = cpu_to_le32(name_size);
 165     note->n_descsz = cpu_to_le32(descsz);
 166     note->n_type = cpu_to_le32(NT_PRSTATUS);
 167     buf = (char *)note;
 168     buf += ROUND_UP(sizeof(Elf64_Nhdr), 4);
 169     memcpy(buf, name, name_size);
 170     buf += ROUND_UP(name_size, 4);
 171     memcpy(buf, &prstatus, sizeof(prstatus));
 172
 173     ret = f(note, note_size, s);
 174     g_free(note);
 175     if (ret < 0) {
 176         return -1;
 177     }
 178
 179     return 0;
 180 }
 181
 182 int x86_cpu_write_elf64_note(WriteCoreDumpFunction f, CPUState *cs,
 183                              int cpuid, DumpState *s)
 184 {
 185     X86CPU *cpu = X86_CPU(cs);
 186     int ret;
 187 #ifdef TARGET_X86_64
 188     X86CPU *first_x86_cpu = X86_CPU(first_cpu);
 189     bool lma = !!(first_x86_cpu->env.hflags & HF_LMA_MASK);
 190
 191     if (lma) {
 192         ret = x86_64_write_elf64_note(f, &cpu->env, cpuid, s);
 193     } else {
 194 #endif
 195         ret = x86_write_elf64_note(f, &cpu->env, cpuid, s);
 196 #ifdef TARGET_X86_64
 197     }
 198 #endif
 199
 200     return ret;
 201 }
 202
 203 int x86_cpu_write_elf32_note(WriteCoreDumpFunction f, CPUState *cs,
 204                              int cpuid, DumpState *s)
 205 {
 206     X86CPU *cpu = X86_CPU(cs);
 207     x86_elf_prstatus prstatus;
 208     Elf32_Nhdr *note;
 209     char *buf;
 210     int descsz, note_size, name_size = 5;
 211     const char *name = "CORE";
 212     int ret;
 213
 214     x86_fill_elf_prstatus(&prstatus, &cpu->env, cpuid);
 215     descsz = sizeof(x86_elf_prstatus);
 216     note_size = ELF_NOTE_SIZE(sizeof(Elf32_Nhdr), name_size, descsz);
 217     note = g_malloc0(note_size);
 218     note->n_namesz = cpu_to_le32(name_size);
 219     note->n_descsz = cpu_to_le32(descsz);
 220     note->n_type = cpu_to_le32(NT_PRSTATUS);
 221     buf = (char *)note;
 222     buf += ROUND_UP(sizeof(Elf32_Nhdr), 4);
 223     memcpy(buf, name, name_size);
 224     buf += ROUND_UP(name_size, 4);
 225     memcpy(buf, &prstatus, sizeof(prstatus));
 226
 227     ret = f(note, note_size, s);
 228     g_free(note);
 229     if (ret < 0) {
 230         return -1;
 231     }
 232
 233     return 0;
 234 }
 235
 236 /*
 237  * please count up QEMUCPUSTATE_VERSION if you have changed definition of
 238  * QEMUCPUState, and modify the tools using this information accordingly.
 239  */
 240 #define QEMUCPUSTATE_VERSION (1)
 241
 242 struct QEMUCPUSegment {
 243     uint32_t selector;
 244     uint32_t limit;
 245     uint32_t flags;
 246     uint32_t pad;
 247     uint64_t base;
 248 };
 249
 250 typedef struct QEMUCPUSegment QEMUCPUSegment;
 251
 252 struct QEMUCPUState {
 253     uint32_t version;
 254     uint32_t size;
 255     uint64_t rax, rbx, rcx, rdx, rsi, rdi, rsp, rbp;
 256     uint64_t r8, r9, r10, r11, r12, r13, r14, r15;
 257     uint64_t rip, rflags;
 258     QEMUCPUSegment cs, ds, es, fs, gs, ss;
 259     QEMUCPUSegment ldt, tr, gdt, idt;
 260     uint64_t cr[5];
 261     /*
 262      * Fields below are optional and are being added at the end without
 263      * changing the version. External tools may identify their presence
 264      * by checking 'size' field.
 265      */
 266     uint64_t kernel_gs_base;
 267 };
 268
 269 typedef struct QEMUCPUState QEMUCPUState;
 270
 271 static void copy_segment(QEMUCPUSegment *d, SegmentCache *s)
 272 {
 273     d->pad = 0;
 274     d->selector = s->selector;
 275     d->limit = s->limit;
 276     d->flags = s->flags;
 277     d->base = s->base;
 278 }
 279
 280 static void qemu_get_cpustate(QEMUCPUState *s, CPUX86State *env)
 281 {
 282     memset(s, 0, sizeof(QEMUCPUState));
 283
 284     s->version = QEMUCPUSTATE_VERSION;
 285     s->size = sizeof(QEMUCPUState);
 286
 287     s->rax = env->regs[R_EAX];
 288     s->rbx = env->regs[R_EBX];
 289     s->rcx = env->regs[R_ECX];
 290     s->rdx = env->regs[R_EDX];
 291     s->rsi = env->regs[R_ESI];
 292     s->rdi = env->regs[R_EDI];
 293     s->rsp = env->regs[R_ESP];
 294     s->rbp = env->regs[R_EBP];
 295 #ifdef TARGET_X86_64
 296     s->r8  = env->regs[8];
 297     s->r9  = env->regs[9];
 298     s->r10 = env->regs[10];
 299     s->r11 = env->regs[11];
 300     s->r12 = env->regs[12];
 301     s->r13 = env->regs[13];
 302     s->r14 = env->regs[14];
 303     s->r15 = env->regs[15];
 304 #endif
 305     s->rip = env->eip;
 306     s->rflags = env->eflags;
 307
 308     copy_segment(&s->cs, &env->segs[R_CS]);
 309     copy_segment(&s->ds, &env->segs[R_DS]);
 310     copy_segment(&s->es, &env->segs[R_ES]);
 311     copy_segment(&s->fs, &env->segs[R_FS]);
 312     copy_segment(&s->gs, &env->segs[R_GS]);
 313     copy_segment(&s->ss, &env->segs[R_SS]);
 314     copy_segment(&s->ldt, &env->ldt);
 315     copy_segment(&s->tr, &env->tr);
 316     copy_segment(&s->gdt, &env->gdt);
 317     copy_segment(&s->idt, &env->idt);
 318
 319     s->cr[0] = env->cr[0];
 320     s->cr[1] = env->cr[1];
 321     s->cr[2] = env->cr[2];
 322     s->cr[3] = env->cr[3];
 323     s->cr[4] = env->cr[4];
 324
 325 #ifdef TARGET_X86_64
 326     s->kernel_gs_base = env->kernelgsbase;
 327 #endif
 328 }
 329
 330 static inline int cpu_write_qemu_note(WriteCoreDumpFunction f,
 331                                       CPUX86State *env,
 332                                       DumpState *s,
 333                                       int type)
 334 {
 335     QEMUCPUState state;
 336     Elf64_Nhdr *note64;
 337     Elf32_Nhdr *note32;
 338     void *note;
 339     char *buf;
 340     int descsz, note_size, name_size = 5, note_head_size;
 341     const char *name = "QEMU";
 342     int ret;
 343
 344     qemu_get_cpustate(&state, env);
 345
 346     descsz = sizeof(state);
 347     if (type == 0) {
 348         note_head_size = sizeof(Elf32_Nhdr);
 349     } else {
 350         note_head_size = sizeof(Elf64_Nhdr);
 351     }
 352     note_size = (DIV_ROUND_UP(note_head_size, 4) + DIV_ROUND_UP(name_size, 4) +
 353                 DIV_ROUND_UP(descsz, 4)) * 4;
 354     note = g_malloc0(note_size);
 355     if (type == 0) {
 356         note32 = note;
 357         note32->n_namesz = cpu_to_le32(name_size);
 358         note32->n_descsz = cpu_to_le32(descsz);
 359         note32->n_type = 0;
 360     } else {
 361         note64 = note;
 362         note64->n_namesz = cpu_to_le32(name_size);
 363         note64->n_descsz = cpu_to_le32(descsz);
 364         note64->n_type = 0;
 365     }
 366     buf = note;
 367     buf += ROUND_UP(note_head_size, 4);
 368     memcpy(buf, name, name_size);
 369     buf += ROUND_UP(name_size, 4);
 370     memcpy(buf, &state, sizeof(state));
 371
 372     ret = f(note, note_size, s);
 373     g_free(note);
 374     if (ret < 0) {
 375         return -1;
 376     }
 377
 378     return 0;
 379 }
 380
 381 int x86_cpu_write_elf64_qemunote(WriteCoreDumpFunction f, CPUState *cs,
 382                                  DumpState *s)
 383 {
 384     X86CPU *cpu = X86_CPU(cs);
 385
 386     return cpu_write_qemu_note(f, &cpu->env, s, 1);
 387 }
 388
 389 int x86_cpu_write_elf32_qemunote(WriteCoreDumpFunction f, CPUState *cs,
 390                                  DumpState *s)
 391 {
 392     X86CPU *cpu = X86_CPU(cs);
 393
 394     return cpu_write_qemu_note(f, &cpu->env, s, 0);
 395 }
 396
 397 int cpu_get_dump_info(ArchDumpInfo *info,
 398                       const GuestPhysBlockList *guest_phys_blocks)
 399 {
 400     bool lma = false;
 401     GuestPhysBlock *block;
 402
 403 #ifdef TARGET_X86_64
 404     X86CPU *first_x86_cpu = X86_CPU(first_cpu);
 405     lma = first_cpu && (first_x86_cpu->env.hflags & HF_LMA_MASK);
 406 #endif
 407
 408     if (lma) {
 409         info->d_machine = EM_X86_64;
 410     } else {
 411         info->d_machine = EM_386;
 412     }
 413     info->d_endian = ELFDATA2LSB;
 414
 415     if (lma) {
 416         info->d_class = ELFCLASS64;
 417     } else {
 418         info->d_class = ELFCLASS32;
 419
 420         QTAILQ_FOREACH(block, &guest_phys_blocks->head, next) {
 421             if (block->target_end > UINT_MAX) {
 422                 /* The memory size is greater than 4G */
 423                 info->d_class = ELFCLASS64;
 424                 break;
 425             }
 426         }
 427     }
 428
 429     return 0;
 430 }
 431
 432 ssize_t cpu_get_note_size(int class, int machine, int nr_cpus)
 433 {
 434     int name_size = 5; /* "CORE" or "QEMU" */
 435     size_t elf_note_size = 0;
 436     size_t qemu_note_size = 0;
 437     int elf_desc_size = 0;
 438     int qemu_desc_size = 0;
 439     int note_head_size;
 440
 441     if (class == ELFCLASS32) {
 442         note_head_size = sizeof(Elf32_Nhdr);
 443     } else {
 444         note_head_size = sizeof(Elf64_Nhdr);
 445     }
 446
 447     if (machine == EM_386) {
 448         elf_desc_size = sizeof(x86_elf_prstatus);
 449     }
 450 #ifdef TARGET_X86_64
 451     else {
 452         elf_desc_size = sizeof(x86_64_elf_prstatus);
 453     }
 454 #endif
 455     qemu_desc_size = sizeof(QEMUCPUState);
 456
 457     elf_note_size = ELF_NOTE_SIZE(note_head_size, name_size, elf_desc_size);
 458     qemu_note_size = ELF_NOTE_SIZE(note_head_size, name_size, qemu_desc_size);
 459
 460     return (elf_note_size + qemu_note_size) * nr_cpus;
 461 }