[qemu.git] / target-s390x / arch_dump.c

/*
 * writing ELF notes for s390x arch
 *
 *
 * Copyright IBM Corp. 2012, 2013
 *
 *     Ekaterina Tumanova <[email protected]>
 *
 * This work is licensed under the terms of the GNU GPL, version 2 or later.
 * See the COPYING file in the top-level directory.
 *
 */

#include "qemu/osdep.h"
#include "cpu.h"
#include "elf.h"
#include "exec/cpu-all.h"
#include "sysemu/dump.h"
#include "sysemu/kvm.h"


struct S390xUserRegsStruct {
    uint64_t psw[2];
    uint64_t gprs[16];
    uint32_t acrs[16];
} QEMU_PACKED;

typedef struct S390xUserRegsStruct S390xUserRegs;

struct S390xElfPrstatusStruct {
    uint8_t pad1[32];
    uint32_t pid;
    uint8_t pad2[76];
    S390xUserRegs regs;
    uint8_t pad3[16];
} QEMU_PACKED;

typedef struct S390xElfPrstatusStruct S390xElfPrstatus;

struct S390xElfFpregsetStruct {
    uint32_t fpc;
    uint32_t pad;
    uint64_t fprs[16];
} QEMU_PACKED;

typedef struct S390xElfFpregsetStruct S390xElfFpregset;

struct S390xElfVregsLoStruct {
    uint64_t vregs[16];
} QEMU_PACKED;

typedef struct S390xElfVregsLoStruct S390xElfVregsLo;

struct S390xElfVregsHiStruct {
    uint64_t vregs[16][2];
} QEMU_PACKED;

typedef struct S390xElfVregsHiStruct S390xElfVregsHi;

typedef struct noteStruct {
    Elf64_Nhdr hdr;
    char name[5];
    char pad3[3];
    union {
        S390xElfPrstatus prstatus;
        S390xElfFpregset fpregset;
        S390xElfVregsLo vregslo;
        S390xElfVregsHi vregshi;
        uint32_t prefix;
        uint64_t timer;
        uint64_t todcmp;
        uint32_t todpreg;
        uint64_t ctrs[16];
    } contents;
} QEMU_PACKED Note;

static void s390x_write_elf64_prstatus(Note *note, S390CPU *cpu)
{
    int i;
    S390xUserRegs *regs;

    note->hdr.n_type = cpu_to_be32(NT_PRSTATUS);

    regs = &(note->contents.prstatus.regs);
    regs->psw[0] = cpu_to_be64(cpu->env.psw.mask);
    regs->psw[1] = cpu_to_be64(cpu->env.psw.addr);
    for (i = 0; i <= 15; i++) {
        regs->acrs[i] = cpu_to_be32(cpu->env.aregs[i]);
        regs->gprs[i] = cpu_to_be64(cpu->env.regs[i]);
    }
}

static void s390x_write_elf64_fpregset(Note *note, S390CPU *cpu)
{
    int i;
    CPUS390XState *cs = &cpu->env;

    note->hdr.n_type = cpu_to_be32(NT_FPREGSET);
    note->contents.fpregset.fpc = cpu_to_be32(cpu->env.fpc);
    for (i = 0; i <= 15; i++) {
        note->contents.fpregset.fprs[i] = cpu_to_be64(get_freg(cs, i)->ll);
    }
}

static void s390x_write_elf64_vregslo(Note *note, S390CPU *cpu)
{
    int i;

    note->hdr.n_type = cpu_to_be32(NT_S390_VXRS_LOW);
    for (i = 0; i <= 15; i++) {
        note->contents.vregslo.vregs[i] = cpu_to_be64(cpu->env.vregs[i][1].ll);
    }
}

static void s390x_write_elf64_vregshi(Note *note, S390CPU *cpu)
{
    int i;
    S390xElfVregsHi *temp_vregshi;

    temp_vregshi = &note->contents.vregshi;

    note->hdr.n_type = cpu_to_be32(NT_S390_VXRS_HIGH);
    for (i = 0; i <= 15; i++) {
        temp_vregshi->vregs[i][0] = cpu_to_be64(cpu->env.vregs[i + 16][0].ll);
        temp_vregshi->vregs[i][1] = cpu_to_be64(cpu->env.vregs[i + 16][1].ll);
    }
}

static void s390x_write_elf64_timer(Note *note, S390CPU *cpu)
{
    note->hdr.n_type = cpu_to_be32(NT_S390_TIMER);
    note->contents.timer = cpu_to_be64((uint64_t)(cpu->env.cputm));
}

static void s390x_write_elf64_todcmp(Note *note, S390CPU *cpu)
{
    note->hdr.n_type = cpu_to_be32(NT_S390_TODCMP);
    note->contents.todcmp = cpu_to_be64((uint64_t)(cpu->env.ckc));
}

static void s390x_write_elf64_todpreg(Note *note, S390CPU *cpu)
{
    note->hdr.n_type = cpu_to_be32(NT_S390_TODPREG);
    note->contents.todpreg = cpu_to_be32((uint32_t)(cpu->env.todpr));
}

static void s390x_write_elf64_ctrs(Note *note, S390CPU *cpu)
{
    int i;

    note->hdr.n_type = cpu_to_be32(NT_S390_CTRS);

    for (i = 0; i <= 15; i++) {
        note->contents.ctrs[i] = cpu_to_be64(cpu->env.cregs[i]);
    }
}

static void s390x_write_elf64_prefix(Note *note, S390CPU *cpu)
{
    note->hdr.n_type = cpu_to_be32(NT_S390_PREFIX);
    note->contents.prefix = cpu_to_be32((uint32_t)(cpu->env.psa));
}


static const struct NoteFuncDescStruct {
    int contents_size;
    void (*note_contents_func)(Note *note, S390CPU *cpu);
} note_func[] = {
    {sizeof(((Note *)0)->contents.prstatus), s390x_write_elf64_prstatus},
    {sizeof(((Note *)0)->contents.prefix),   s390x_write_elf64_prefix},
    {sizeof(((Note *)0)->contents.fpregset), s390x_write_elf64_fpregset},
    {sizeof(((Note *)0)->contents.ctrs),     s390x_write_elf64_ctrs},
    {sizeof(((Note *)0)->contents.timer),    s390x_write_elf64_timer},
    {sizeof(((Note *)0)->contents.todcmp),   s390x_write_elf64_todcmp},
    {sizeof(((Note *)0)->contents.todpreg),  s390x_write_elf64_todpreg},
    {sizeof(((Note *)0)->contents.vregslo),  s390x_write_elf64_vregslo},
    {sizeof(((Note *)0)->contents.vregshi),  s390x_write_elf64_vregshi},
    { 0, NULL}
};

typedef struct NoteFuncDescStruct NoteFuncDesc;


static int s390x_write_all_elf64_notes(const char *note_name,
                                       WriteCoreDumpFunction f,
                                       S390CPU *cpu, int id,
                                       void *opaque)
{
    Note note;
    const NoteFuncDesc *nf;
    int note_size;
    int ret = -1;

    for (nf = note_func; nf->note_contents_func; nf++) {
        memset(&note, 0, sizeof(note));
        note.hdr.n_namesz = cpu_to_be32(sizeof(note.name));
        note.hdr.n_descsz = cpu_to_be32(nf->contents_size);
        strncpy(note.name, note_name, sizeof(note.name));
        (*nf->note_contents_func)(&note, cpu);

        note_size = sizeof(note) - sizeof(note.contents) + nf->contents_size;
        ret = f(&note, note_size, opaque);

        if (ret < 0) {
            return -1;
        }

    }

    return 0;
}


int s390_cpu_write_elf64_note(WriteCoreDumpFunction f, CPUState *cs,
                              int cpuid, void *opaque)
{
    S390CPU *cpu = S390_CPU(cs);
    return s390x_write_all_elf64_notes("CORE", f, cpu, cpuid, opaque);
}

int cpu_get_dump_info(ArchDumpInfo *info,
                      const struct GuestPhysBlockList *guest_phys_blocks)
{
    info->d_machine = EM_S390;
    info->d_endian = ELFDATA2MSB;
    info->d_class = ELFCLASS64;

    return 0;
}

ssize_t cpu_get_note_size(int class, int machine, int nr_cpus)
{
    int name_size = 8; /* "CORE" or "QEMU" rounded */
    size_t elf_note_size = 0;
    int note_head_size;
    const NoteFuncDesc *nf;

    assert(class == ELFCLASS64);
    assert(machine == EM_S390);

    note_head_size = sizeof(Elf64_Nhdr);

    for (nf = note_func; nf->note_contents_func; nf++) {
        elf_note_size = elf_note_size + note_head_size + name_size +
                        nf->contents_size;
    }

    return (elf_note_size) * nr_cpus;
}
Commit	Line	Data
9b4f38e1 ET	1	/*
	2	* writing ELF notes for s390x arch
	3	*
	4	*
	5	* Copyright IBM Corp. 2012, 2013
	6	*
	7	* Ekaterina Tumanova <[email protected]>
	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
9615495a	14	#include "qemu/osdep.h"
9b4f38e1 ET	15	#include "cpu.h"
	16	#include "elf.h"
	17	#include "exec/cpu-all.h"
	18	#include "sysemu/dump.h"
	19	#include "sysemu/kvm.h"
	20
	21
	22	struct S390xUserRegsStruct {
	23	uint64_t psw[2];
	24	uint64_t gprs[16];
	25	uint32_t acrs[16];
	26	} QEMU_PACKED;
	27
	28	typedef struct S390xUserRegsStruct S390xUserRegs;
	29
	30	struct S390xElfPrstatusStruct {
	31	uint8_t pad1[32];
	32	uint32_t pid;
	33	uint8_t pad2[76];
	34	S390xUserRegs regs;
	35	uint8_t pad3[16];
	36	} QEMU_PACKED;
	37
	38	typedef struct S390xElfPrstatusStruct S390xElfPrstatus;
	39
	40	struct S390xElfFpregsetStruct {
	41	uint32_t fpc;
	42	uint32_t pad;
	43	uint64_t fprs[16];
	44	} QEMU_PACKED;
	45
	46	typedef struct S390xElfFpregsetStruct S390xElfFpregset;
	47
3ceeb293 EF	48	struct S390xElfVregsLoStruct {
	49	uint64_t vregs[16];
	50	} QEMU_PACKED;
	51
	52	typedef struct S390xElfVregsLoStruct S390xElfVregsLo;
	53
	54	struct S390xElfVregsHiStruct {
	55	uint64_t vregs[16][2];
	56	} QEMU_PACKED;
	57
	58	typedef struct S390xElfVregsHiStruct S390xElfVregsHi;
	59
9b4f38e1 ET	60	typedef struct noteStruct {
	61	Elf64_Nhdr hdr;
	62	char name[5];
	63	char pad3[3];
	64	union {
	65	S390xElfPrstatus prstatus;
	66	S390xElfFpregset fpregset;
3ceeb293 EF	67	S390xElfVregsLo vregslo;
3ceeb293 EF	68	S390xElfVregsHi vregshi;
9b4f38e1 ET	69	uint32_t prefix;
	70	uint64_t timer;
	71	uint64_t todcmp;
	72	uint32_t todpreg;
	73	uint64_t ctrs[16];
	74	} contents;
	75	} QEMU_PACKED Note;
	76
	77	static void s390x_write_elf64_prstatus(Note note, S390CPU cpu)
	78	{
	79	int i;
	80	S390xUserRegs *regs;
	81
	82	note->hdr.n_type = cpu_to_be32(NT_PRSTATUS);
	83
	84	regs = &(note->contents.prstatus.regs);
	85	regs->psw[0] = cpu_to_be64(cpu->env.psw.mask);
	86	regs->psw[1] = cpu_to_be64(cpu->env.psw.addr);
	87	for (i = 0; i <= 15; i++) {
	88	regs->acrs[i] = cpu_to_be32(cpu->env.aregs[i]);
	89	regs->gprs[i] = cpu_to_be64(cpu->env.regs[i]);
	90	}
	91	}
	92
	93	static void s390x_write_elf64_fpregset(Note note, S390CPU cpu)
	94	{
	95	int i;
c498d8e3	96	CPUS390XState *cs = &cpu->env;
9b4f38e1 ET	97
	98	note->hdr.n_type = cpu_to_be32(NT_FPREGSET);
	99	note->contents.fpregset.fpc = cpu_to_be32(cpu->env.fpc);
	100	for (i = 0; i <= 15; i++) {
c498d8e3	101	note->contents.fpregset.fprs[i] = cpu_to_be64(get_freg(cs, i)->ll);
9b4f38e1 ET	102	}
	103	}
	104
3ceeb293 EF	105	static void s390x_write_elf64_vregslo(Note note, S390CPU cpu)
	106	{
	107	int i;
	108
	109	note->hdr.n_type = cpu_to_be32(NT_S390_VXRS_LOW);
	110	for (i = 0; i <= 15; i++) {
	111	note->contents.vregslo.vregs[i] = cpu_to_be64(cpu->env.vregs[i][1].ll);
	112	}
	113	}
	114
	115	static void s390x_write_elf64_vregshi(Note note, S390CPU cpu)
	116	{
	117	int i;
	118	S390xElfVregsHi *temp_vregshi;
	119
	120	temp_vregshi = &note->contents.vregshi;
	121
	122	note->hdr.n_type = cpu_to_be32(NT_S390_VXRS_HIGH);
	123	for (i = 0; i <= 15; i++) {
	124	temp_vregshi->vregs[i][0] = cpu_to_be64(cpu->env.vregs[i + 16][0].ll);
	125	temp_vregshi->vregs[i][1] = cpu_to_be64(cpu->env.vregs[i + 16][1].ll);
	126	}
	127	}
9b4f38e1 ET	128
	129	static void s390x_write_elf64_timer(Note note, S390CPU cpu)
	130	{
	131	note->hdr.n_type = cpu_to_be32(NT_S390_TIMER);
	132	note->contents.timer = cpu_to_be64((uint64_t)(cpu->env.cputm));
	133	}
	134
	135	static void s390x_write_elf64_todcmp(Note note, S390CPU cpu)
	136	{
	137	note->hdr.n_type = cpu_to_be32(NT_S390_TODCMP);
	138	note->contents.todcmp = cpu_to_be64((uint64_t)(cpu->env.ckc));
	139	}
	140
	141	static void s390x_write_elf64_todpreg(Note note, S390CPU cpu)
	142	{
	143	note->hdr.n_type = cpu_to_be32(NT_S390_TODPREG);
	144	note->contents.todpreg = cpu_to_be32((uint32_t)(cpu->env.todpr));
	145	}
	146
	147	static void s390x_write_elf64_ctrs(Note note, S390CPU cpu)
	148	{
	149	int i;
	150
	151	note->hdr.n_type = cpu_to_be32(NT_S390_CTRS);
	152
	153	for (i = 0; i <= 15; i++) {
	154	note->contents.ctrs[i] = cpu_to_be64(cpu->env.cregs[i]);
	155	}
	156	}
	157
	158	static void s390x_write_elf64_prefix(Note note, S390CPU cpu)
	159	{
	160	note->hdr.n_type = cpu_to_be32(NT_S390_PREFIX);
	161	note->contents.prefix = cpu_to_be32((uint32_t)(cpu->env.psa));
	162	}
	163
	164
ecb4e01e	165	static const struct NoteFuncDescStruct {
9b4f38e1 ET	166	int contents_size;
	167	void (note_contents_func)(Note note, S390CPU *cpu);
	168	} note_func[] = {
	169	{sizeof(((Note *)0)->contents.prstatus), s390x_write_elf64_prstatus},
	170	{sizeof(((Note *)0)->contents.prefix), s390x_write_elf64_prefix},
	171	{sizeof(((Note *)0)->contents.fpregset), s390x_write_elf64_fpregset},
	172	{sizeof(((Note *)0)->contents.ctrs), s390x_write_elf64_ctrs},
	173	{sizeof(((Note *)0)->contents.timer), s390x_write_elf64_timer},
	174	{sizeof(((Note *)0)->contents.todcmp), s390x_write_elf64_todcmp},
	175	{sizeof(((Note *)0)->contents.todpreg), s390x_write_elf64_todpreg},
3ceeb293 EF	176	{sizeof(((Note *)0)->contents.vregslo), s390x_write_elf64_vregslo},
3ceeb293 EF	177	{sizeof(((Note *)0)->contents.vregshi), s390x_write_elf64_vregshi},
9b4f38e1 ET	178	{ 0, NULL}
	179	};
	180
	181	typedef struct NoteFuncDescStruct NoteFuncDesc;
	182
	183
	184	static int s390x_write_all_elf64_notes(const char *note_name,
	185	WriteCoreDumpFunction f,
	186	S390CPU *cpu, int id,
	187	void *opaque)
	188	{
	189	Note note;
ecb4e01e	190	const NoteFuncDesc *nf;
9b4f38e1 ET	191	int note_size;
	192	int ret = -1;
	193
	194	for (nf = note_func; nf->note_contents_func; nf++) {
abd137a1	195	memset(&note, 0, sizeof(note));
9b4f38e1 ET	196	note.hdr.n_namesz = cpu_to_be32(sizeof(note.name));
	197	note.hdr.n_descsz = cpu_to_be32(nf->contents_size);
	198	strncpy(note.name, note_name, sizeof(note.name));
	199	(*nf->note_contents_func)(&note, cpu);
	200
	201	note_size = sizeof(note) - sizeof(note.contents) + nf->contents_size;
	202	ret = f(&note, note_size, opaque);
	203
	204	if (ret < 0) {
	205	return -1;
	206	}
	207
	208	}
	209
	210	return 0;
	211	}
	212
	213
	214	int s390_cpu_write_elf64_note(WriteCoreDumpFunction f, CPUState *cs,
	215	int cpuid, void *opaque)
	216	{
	217	S390CPU *cpu = S390_CPU(cs);
	218	return s390x_write_all_elf64_notes("CORE", f, cpu, cpuid, opaque);
	219	}
	220
56c4bfb3 LE	221	int cpu_get_dump_info(ArchDumpInfo *info,
56c4bfb3 LE	222	const struct GuestPhysBlockList *guest_phys_blocks)
9b4f38e1 ET	223	{
	224	info->d_machine = EM_S390;
	225	info->d_endian = ELFDATA2MSB;
	226	info->d_class = ELFCLASS64;
	227
	228	return 0;
	229	}
	230
	231	ssize_t cpu_get_note_size(int class, int machine, int nr_cpus)
	232	{
	233	int name_size = 8; /* "CORE" or "QEMU" rounded */
	234	size_t elf_note_size = 0;
	235	int note_head_size;
ecb4e01e	236	const NoteFuncDesc *nf;
9b4f38e1 ET	237
	238	assert(class == ELFCLASS64);
	239	assert(machine == EM_S390);
	240
	241	note_head_size = sizeof(Elf64_Nhdr);
	242
	243	for (nf = note_func; nf->note_contents_func; nf++) {
	244	elf_note_size = elf_note_size + note_head_size + name_size +
	245	nf->contents_size;
	246	}
	247
	248	return (elf_note_size) * nr_cpus;
	249	}