[mirror_qemu.git] / hw / s390x / ipl.c

/*
 * bootloader support
 *
 * Copyright IBM, Corp. 2012
 *
 * Authors:
 *  Christian Borntraeger <borntraeger@de.ibm.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2 or (at your
 * option) any later version.  See the COPYING file in the top-level directory.
 *
 */

#include "qemu/osdep.h"
#include "qapi/error.h"
#include "sysemu/sysemu.h"
#include "cpu.h"
#include "elf.h"
#include "hw/loader.h"
#include "hw/boards.h"
#include "hw/s390x/virtio-ccw.h"
#include "hw/s390x/css.h"
#include "hw/s390x/ebcdic.h"
#include "ipl.h"
#include "qemu/error-report.h"

#define KERN_IMAGE_START                0x010000UL
#define KERN_PARM_AREA                  0x010480UL
#define INITRD_START                    0x800000UL
#define INITRD_PARM_START               0x010408UL
#define INITRD_PARM_SIZE                0x010410UL
#define PARMFILE_START                  0x001000UL
#define ZIPL_IMAGE_START                0x009000UL
#define IPL_PSW_MASK                    (PSW_MASK_32 | PSW_MASK_64)

static bool iplb_extended_needed(void *opaque)
{
    S390IPLState *ipl = S390_IPL(object_resolve_path(TYPE_S390_IPL, NULL));

    return ipl->iplbext_migration;
}

static const VMStateDescription vmstate_iplb_extended = {
    .name = "ipl/iplb_extended",
    .version_id = 0,
    .minimum_version_id = 0,
    .needed = iplb_extended_needed,
    .fields = (VMStateField[]) {
        VMSTATE_UINT8_ARRAY(reserved_ext, IplParameterBlock, 4096 - 200),
        VMSTATE_END_OF_LIST()
    }
};

static const VMStateDescription vmstate_iplb = {
    .name = "ipl/iplb",
    .version_id = 0,
    .minimum_version_id = 0,
    .fields = (VMStateField[]) {
        VMSTATE_UINT8_ARRAY(reserved1, IplParameterBlock, 110),
        VMSTATE_UINT16(devno, IplParameterBlock),
        VMSTATE_UINT8_ARRAY(reserved2, IplParameterBlock, 88),
        VMSTATE_END_OF_LIST()
    },
    .subsections = (const VMStateDescription*[]) {
        &vmstate_iplb_extended,
        NULL
    }
};

static const VMStateDescription vmstate_ipl = {
    .name = "ipl",
    .version_id = 0,
    .minimum_version_id = 0,
    .fields = (VMStateField[]) {
        VMSTATE_UINT64(compat_start_addr, S390IPLState),
        VMSTATE_UINT64(compat_bios_start_addr, S390IPLState),
        VMSTATE_STRUCT(iplb, S390IPLState, 0, vmstate_iplb, IplParameterBlock),
        VMSTATE_BOOL(iplb_valid, S390IPLState),
        VMSTATE_UINT8(cssid, S390IPLState),
        VMSTATE_UINT8(ssid, S390IPLState),
        VMSTATE_UINT16(devno, S390IPLState),
        VMSTATE_END_OF_LIST()
     }
};

static S390IPLState *get_ipl_device(void)
{
    return S390_IPL(object_resolve_path_type("", TYPE_S390_IPL, NULL));
}

static uint64_t bios_translate_addr(void *opaque, uint64_t srcaddr)
{
    uint64_t dstaddr = *(uint64_t *) opaque;
    /*
     * Assuming that our s390-ccw.img was linked for starting at address 0,
     * we can simply add the destination address for the final location
     */
    return srcaddr + dstaddr;
}

static void s390_ipl_realize(DeviceState *dev, Error **errp)
{
    S390IPLState *ipl = S390_IPL(dev);
    uint64_t pentry = KERN_IMAGE_START;
    int kernel_size;
    Error *err = NULL;

    int bios_size;
    char *bios_filename;

    /*
     * Always load the bios if it was enforced,
     * even if an external kernel has been defined.
     */
    if (!ipl->kernel || ipl->enforce_bios) {
        uint64_t fwbase = (MIN(ram_size, 0x80000000U) - 0x200000) & ~0xffffUL;

        if (bios_name == NULL) {
            bios_name = ipl->firmware;
        }

        bios_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
        if (bios_filename == NULL) {
            error_setg(&err, "could not find stage1 bootloader");
            goto error;
        }

        bios_size = load_elf(bios_filename, bios_translate_addr, &fwbase,
                             &ipl->bios_start_addr, NULL, NULL, 1,
                             EM_S390, 0, 0);
        if (bios_size > 0) {
            /* Adjust ELF start address to final location */
            ipl->bios_start_addr += fwbase;
        } else {
            /* Try to load non-ELF file */
            bios_size = load_image_targphys(bios_filename, ZIPL_IMAGE_START,
                                            4096);
            ipl->bios_start_addr = ZIPL_IMAGE_START;
        }
        g_free(bios_filename);

        if (bios_size == -1) {
            error_setg(&err, "could not load bootloader '%s'", bios_name);
            goto error;
        }

        /* default boot target is the bios */
        ipl->start_addr = ipl->bios_start_addr;
    }

    if (ipl->kernel) {
        kernel_size = load_elf(ipl->kernel, NULL, NULL, &pentry, NULL,
                               NULL, 1, EM_S390, 0, 0);
        if (kernel_size < 0) {
            kernel_size = load_image_targphys(ipl->kernel, 0, ram_size);
        }
        if (kernel_size < 0) {
            error_setg(&err, "could not load kernel '%s'", ipl->kernel);
            goto error;
        }
        /*
         * Is it a Linux kernel (starting at 0x10000)? If yes, we fill in the
         * kernel parameters here as well. Note: For old kernels (up to 3.2)
         * we can not rely on the ELF entry point - it was 0x800 (the SALIPL
         * loader) and it won't work. For this case we force it to 0x10000, too.
         */
        if (pentry == KERN_IMAGE_START || pentry == 0x800) {
            ipl->start_addr = KERN_IMAGE_START;
            /* Overwrite parameters in the kernel image, which are "rom" */
            strcpy(rom_ptr(KERN_PARM_AREA), ipl->cmdline);
        } else {
            ipl->start_addr = pentry;
        }

        if (ipl->initrd) {
            ram_addr_t initrd_offset;
            int initrd_size;

            initrd_offset = INITRD_START;
            while (kernel_size + 0x100000 > initrd_offset) {
                initrd_offset += 0x100000;
            }
            initrd_size = load_image_targphys(ipl->initrd, initrd_offset,
                                              ram_size - initrd_offset);
            if (initrd_size == -1) {
                error_setg(&err, "could not load initrd '%s'", ipl->initrd);
                goto error;
            }

            /*
             * we have to overwrite values in the kernel image,
             * which are "rom"
             */
            stq_p(rom_ptr(INITRD_PARM_START), initrd_offset);
            stq_p(rom_ptr(INITRD_PARM_SIZE), initrd_size);
        }
    }
    /*
     * Don't ever use the migrated values, they could come from a different
     * BIOS and therefore don't work. But still migrate the values, so
     * QEMUs relying on it don't break.
     */
    ipl->compat_start_addr = ipl->start_addr;
    ipl->compat_bios_start_addr = ipl->bios_start_addr;
    qemu_register_reset(qdev_reset_all_fn, dev);
error:
    error_propagate(errp, err);
}

static Property s390_ipl_properties[] = {
    DEFINE_PROP_STRING("kernel", S390IPLState, kernel),
    DEFINE_PROP_STRING("initrd", S390IPLState, initrd),
    DEFINE_PROP_STRING("cmdline", S390IPLState, cmdline),
    DEFINE_PROP_STRING("firmware", S390IPLState, firmware),
    DEFINE_PROP_STRING("netboot_fw", S390IPLState, netboot_fw),
    DEFINE_PROP_BOOL("enforce_bios", S390IPLState, enforce_bios, false),
    DEFINE_PROP_BOOL("iplbext_migration", S390IPLState, iplbext_migration,
                     true),
    DEFINE_PROP_END_OF_LIST(),
};

static bool s390_gen_initial_iplb(S390IPLState *ipl)
{
    DeviceState *dev_st;

    dev_st = get_boot_device(0);
    if (dev_st) {
        VirtioCcwDevice *virtio_ccw_dev = (VirtioCcwDevice *)
            object_dynamic_cast(OBJECT(qdev_get_parent_bus(dev_st)->parent),
                TYPE_VIRTIO_CCW_DEVICE);
        SCSIDevice *sd = (SCSIDevice *) object_dynamic_cast(OBJECT(dev_st),
                                                            TYPE_SCSI_DEVICE);
        VirtIONet *vn = (VirtIONet *) object_dynamic_cast(OBJECT(dev_st),
                                                          TYPE_VIRTIO_NET);

        if (vn) {
            ipl->netboot = true;
        }
        if (virtio_ccw_dev) {
            CcwDevice *ccw_dev = CCW_DEVICE(virtio_ccw_dev);

            ipl->iplb.len = cpu_to_be32(S390_IPLB_MIN_CCW_LEN);
            ipl->iplb.blk0_len =
                cpu_to_be32(S390_IPLB_MIN_CCW_LEN - S390_IPLB_HEADER_LEN);
            ipl->iplb.pbt = S390_IPL_TYPE_CCW;
            ipl->iplb.ccw.devno = cpu_to_be16(ccw_dev->sch->devno);
            ipl->iplb.ccw.ssid = ccw_dev->sch->ssid & 3;
        } else if (sd) {
            SCSIBus *bus = scsi_bus_from_device(sd);
            VirtIOSCSI *vdev = container_of(bus, VirtIOSCSI, bus);
            VirtIOSCSICcw *scsi_ccw = container_of(vdev, VirtIOSCSICcw, vdev);
            CcwDevice *ccw_dev;

            ccw_dev = (CcwDevice *)object_dynamic_cast(OBJECT(scsi_ccw),
                                                       TYPE_CCW_DEVICE);
            if (!ccw_dev) {       /* It might be a PCI device instead */
                return false;
            }

            ipl->iplb.len = cpu_to_be32(S390_IPLB_MIN_QEMU_SCSI_LEN);
            ipl->iplb.blk0_len =
                cpu_to_be32(S390_IPLB_MIN_QEMU_SCSI_LEN - S390_IPLB_HEADER_LEN);
            ipl->iplb.pbt = S390_IPL_TYPE_QEMU_SCSI;
            ipl->iplb.scsi.lun = cpu_to_be32(sd->lun);
            ipl->iplb.scsi.target = cpu_to_be16(sd->id);
            ipl->iplb.scsi.channel = cpu_to_be16(sd->channel);
            ipl->iplb.scsi.devno = cpu_to_be16(ccw_dev->sch->devno);
            ipl->iplb.scsi.ssid = ccw_dev->sch->ssid & 3;
        } else {
            return false; /* unknown device */
        }

        if (!s390_ipl_set_loadparm(ipl->iplb.loadparm)) {
            ipl->iplb.flags |= DIAG308_FLAGS_LP_VALID;
        }
        return true;
    }

    return false;
}

int s390_ipl_set_loadparm(uint8_t *loadparm)
{
    MachineState *machine = MACHINE(qdev_get_machine());
    char *lp = object_property_get_str(OBJECT(machine), "loadparm", NULL);

    if (lp) {
        int i;

        /* lp is an uppercase string without leading/embedded spaces */
        for (i = 0; i < 8 && lp[i]; i++) {
            loadparm[i] = ascii2ebcdic[(uint8_t) lp[i]];
        }

        g_free(lp);
        return 0;
    }

    return -1;
}

static int load_netboot_image(Error **errp)
{
    S390IPLState *ipl = get_ipl_device();
    char *netboot_filename;
    MemoryRegion *sysmem =  get_system_memory();
    MemoryRegion *mr = NULL;
    void *ram_ptr = NULL;
    int img_size = -1;

    mr = memory_region_find(sysmem, 0, 1).mr;
    if (!mr) {
        error_setg(errp, "Failed to find memory region at address 0");
        return -1;
    }

    ram_ptr = memory_region_get_ram_ptr(mr);
    if (!ram_ptr) {
        error_setg(errp, "No RAM found");
        goto unref_mr;
    }

    netboot_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, ipl->netboot_fw);
    if (netboot_filename == NULL) {
        error_setg(errp, "Could not find network bootloader");
        goto unref_mr;
    }

    img_size = load_elf_ram(netboot_filename, NULL, NULL, &ipl->start_addr,
                            NULL, NULL, 1, EM_S390, 0, 0, NULL, false);

    if (img_size < 0) {
        img_size = load_image_size(netboot_filename, ram_ptr, ram_size);
        ipl->start_addr = KERN_IMAGE_START;
    }

    if (img_size < 0) {
        error_setg(errp, "Failed to load network bootloader");
    }

    g_free(netboot_filename);

unref_mr:
    memory_region_unref(mr);
    return img_size;
}

static bool is_virtio_net_device(IplParameterBlock *iplb)
{
    uint8_t cssid;
    uint8_t ssid;
    uint16_t devno;
    uint16_t schid;
    SubchDev *sch = NULL;

    if (iplb->pbt != S390_IPL_TYPE_CCW) {
        return false;
    }

    devno = be16_to_cpu(iplb->ccw.devno);
    ssid = iplb->ccw.ssid & 3;

    for (schid = 0; schid < MAX_SCHID; schid++) {
        for (cssid = 0; cssid < MAX_CSSID; cssid++) {
            sch = css_find_subch(1, cssid, ssid, schid);

            if (sch && sch->devno == devno) {
                return sch->id.cu_model == VIRTIO_ID_NET;
            }
        }
    }
    return false;
}

void s390_ipl_update_diag308(IplParameterBlock *iplb)
{
    S390IPLState *ipl = get_ipl_device();

    ipl->iplb = *iplb;
    ipl->iplb_valid = true;
    ipl->netboot = is_virtio_net_device(iplb);
}

IplParameterBlock *s390_ipl_get_iplb(void)
{
    S390IPLState *ipl = get_ipl_device();

    if (!ipl->iplb_valid) {
        return NULL;
    }
    return &ipl->iplb;
}

void s390_reipl_request(void)
{
    S390IPLState *ipl = get_ipl_device();

    ipl->reipl_requested = true;
    qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
}

void s390_ipl_prepare_cpu(S390CPU *cpu)
{
    S390IPLState *ipl = get_ipl_device();
    Error *err = NULL;

    cpu->env.psw.addr = ipl->start_addr;
    cpu->env.psw.mask = IPL_PSW_MASK;

    if (!ipl->kernel || ipl->iplb_valid) {
        cpu->env.psw.addr = ipl->bios_start_addr;
        if (!ipl->iplb_valid) {
            ipl->iplb_valid = s390_gen_initial_iplb(ipl);
        }
    }
    if (ipl->netboot) {
        if (load_netboot_image(&err) < 0) {
            error_report_err(err);
            vm_stop(RUN_STATE_INTERNAL_ERROR);
        }
        ipl->iplb.ccw.netboot_start_addr = cpu_to_be64(ipl->start_addr);
    }
}

static void s390_ipl_reset(DeviceState *dev)
{
    S390IPLState *ipl = S390_IPL(dev);

    if (!ipl->reipl_requested) {
        ipl->iplb_valid = false;
        memset(&ipl->iplb, 0, sizeof(IplParameterBlock));
    }
    ipl->reipl_requested = false;
}

static void s390_ipl_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);

    dc->realize = s390_ipl_realize;
    dc->props = s390_ipl_properties;
    dc->reset = s390_ipl_reset;
    dc->vmsd = &vmstate_ipl;
    set_bit(DEVICE_CATEGORY_MISC, dc->categories);
    /* Reason: Loads the ROMs and thus can only be used one time - internally */
    dc->user_creatable = false;
}

static const TypeInfo s390_ipl_info = {
    .class_init = s390_ipl_class_init,
    .parent = TYPE_DEVICE,
    .name  = TYPE_S390_IPL,
    .instance_size  = sizeof(S390IPLState),
};

static void s390_ipl_register_types(void)
{
    type_register_static(&s390_ipl_info);
}

type_init(s390_ipl_register_types)
Commit	Line	Data
e674a49a CB	1	/*
	2	* bootloader support
	3	*
	4	* Copyright IBM, Corp. 2012
	5	*
	6	* Authors:
	7	* Christian Borntraeger <borntraeger@de.ibm.com>
	8	*
	9	* This work is licensed under the terms of the GNU GPL, version 2 or (at your
	10	* option) any later version. See the COPYING file in the top-level directory.
	11	*
	12	*/
	13
9615495a	14	#include "qemu/osdep.h"
da34e65c	15	#include "qapi/error.h"
e674a49a CB	16	#include "sysemu/sysemu.h"
	17	#include "cpu.h"
	18	#include "elf.h"
	19	#include "hw/loader.h"
bd1badf4	20	#include "hw/boards.h"
ba1509c0 DD	21	#include "hw/s390x/virtio-ccw.h"
ba1509c0 DD	22	#include "hw/s390x/css.h"
bd1badf4	23	#include "hw/s390x/ebcdic.h"
df75a4e2	24	#include "ipl.h"
f38b5b7f	25	#include "qemu/error-report.h"
e674a49a CB	26
	27	#define KERN_IMAGE_START 0x010000UL
	28	#define KERN_PARM_AREA 0x010480UL
	29	#define INITRD_START 0x800000UL
	30	#define INITRD_PARM_START 0x010408UL
	31	#define INITRD_PARM_SIZE 0x010410UL
	32	#define PARMFILE_START 0x001000UL
e674a49a CB	33	#define ZIPL_IMAGE_START 0x009000UL
	34	#define IPL_PSW_MASK (PSW_MASK_32 \| PSW_MASK_64)
	35
04ca4b92 AY	36	static bool iplb_extended_needed(void *opaque)
	37	{
	38	S390IPLState *ipl = S390_IPL(object_resolve_path(TYPE_S390_IPL, NULL));
	39
	40	return ipl->iplbext_migration;
	41	}
	42
	43	static const VMStateDescription vmstate_iplb_extended = {
	44	.name = "ipl/iplb_extended",
	45	.version_id = 0,
	46	.minimum_version_id = 0,
	47	.needed = iplb_extended_needed,
	48	.fields = (VMStateField[]) {
	49	VMSTATE_UINT8_ARRAY(reserved_ext, IplParameterBlock, 4096 - 200),
	50	VMSTATE_END_OF_LIST()
	51	}
	52	};
	53
2e13fbe4 FZ	54	static const VMStateDescription vmstate_iplb = {
	55	.name = "ipl/iplb",
	56	.version_id = 0,
	57	.minimum_version_id = 0,
	58	.fields = (VMStateField[]) {
	59	VMSTATE_UINT8_ARRAY(reserved1, IplParameterBlock, 110),
	60	VMSTATE_UINT16(devno, IplParameterBlock),
	61	VMSTATE_UINT8_ARRAY(reserved2, IplParameterBlock, 88),
	62	VMSTATE_END_OF_LIST()
04ca4b92 AY	63	},
	64	.subsections = (const VMStateDescription*[]) {
	65	&vmstate_iplb_extended,
	66	NULL
2e13fbe4 FZ	67	}
	68	};
	69
	70	static const VMStateDescription vmstate_ipl = {
	71	.name = "ipl",
	72	.version_id = 0,
	73	.minimum_version_id = 0,
	74	.fields = (VMStateField[]) {
bb099546 DH	75	VMSTATE_UINT64(compat_start_addr, S390IPLState),
bb099546 DH	76	VMSTATE_UINT64(compat_bios_start_addr, S390IPLState),
2e13fbe4 FZ	77	VMSTATE_STRUCT(iplb, S390IPLState, 0, vmstate_iplb, IplParameterBlock),
	78	VMSTATE_BOOL(iplb_valid, S390IPLState),
	79	VMSTATE_UINT8(cssid, S390IPLState),
	80	VMSTATE_UINT8(ssid, S390IPLState),
	81	VMSTATE_UINT16(devno, S390IPLState),
	82	VMSTATE_END_OF_LIST()
	83	}
	84	};
e674a49a	85
feacc6c2 DH	86	static S390IPLState *get_ipl_device(void)
	87	{
	88	return S390_IPL(object_resolve_path_type("", TYPE_S390_IPL, NULL));
	89	}
	90
d884c86d TH	91	static uint64_t bios_translate_addr(void *opaque, uint64_t srcaddr)
	92	{
	93	uint64_t dstaddr = (uint64_t ) opaque;
	94	/*
	95	* Assuming that our s390-ccw.img was linked for starting at address 0,
	96	* we can simply add the destination address for the final location
	97	*/
	98	return srcaddr + dstaddr;
	99	}
	100
04fccf10	101	static void s390_ipl_realize(DeviceState dev, Error *errp)
e674a49a CB	102	{
e674a49a CB	103	S390IPLState *ipl = S390_IPL(dev);
7691993c	104	uint64_t pentry = KERN_IMAGE_START;
376827d4	105	int kernel_size;
e6da780d	106	Error *err = NULL;
e674a49a	107
f0180f91 FZ	108	int bios_size;
f0180f91 FZ	109	char *bios_filename;
e674a49a	110
f0180f91 FZ	111	/*
	112	* Always load the bios if it was enforced,
	113	* even if an external kernel has been defined.
	114	*/
	115	if (!ipl->kernel \|\| ipl->enforce_bios) {
d884c86d TH	116	uint64_t fwbase = (MIN(ram_size, 0x80000000U) - 0x200000) & ~0xffffUL;
d884c86d TH	117
e674a49a	118	if (bios_name == NULL) {
d0249ce5	119	bios_name = ipl->firmware;
e674a49a CB	120	}
	121
	122	bios_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
1f7de853	123	if (bios_filename == NULL) {
e6da780d	124	error_setg(&err, "could not find stage1 bootloader");
8f04e88e	125	goto error;
1f7de853 DD	126	}
1f7de853 DD	127
d884c86d TH	128	bios_size = load_elf(bios_filename, bios_translate_addr, &fwbase,
d884c86d TH	129	&ipl->bios_start_addr, NULL, NULL, 1,
7ef295ea	130	EM_S390, 0, 0);
d884c86d TH	131	if (bios_size > 0) {
	132	/* Adjust ELF start address to final location */
	133	ipl->bios_start_addr += fwbase;
	134	} else {
f35c1f66	135	/* Try to load non-ELF file */
33259956 AG	136	bios_size = load_image_targphys(bios_filename, ZIPL_IMAGE_START,
33259956 AG	137	4096);
f0180f91	138	ipl->bios_start_addr = ZIPL_IMAGE_START;
33259956	139	}
e674a49a CB	140	g_free(bios_filename);
e674a49a CB	141
376827d4	142	if (bios_size == -1) {
e6da780d	143	error_setg(&err, "could not load bootloader '%s'", bios_name);
8f04e88e	144	goto error;
e674a49a	145	}
7691993c	146
f0180f91 FZ	147	/* default boot target is the bios */
f0180f91 FZ	148	ipl->start_addr = ipl->bios_start_addr;
e674a49a	149	}
7691993c	150
f0180f91 FZ	151	if (ipl->kernel) {
f0180f91 FZ	152	kernel_size = load_elf(ipl->kernel, NULL, NULL, &pentry, NULL,
7ef295ea	153	NULL, 1, EM_S390, 0, 0);
f0180f91 FZ	154	if (kernel_size < 0) {
	155	kernel_size = load_image_targphys(ipl->kernel, 0, ram_size);
	156	}
	157	if (kernel_size < 0) {
e6da780d	158	error_setg(&err, "could not load kernel '%s'", ipl->kernel);
8f04e88e	159	goto error;
e674a49a	160	}
f0180f91 FZ	161	/*
	162	* Is it a Linux kernel (starting at 0x10000)? If yes, we fill in the
	163	* kernel parameters here as well. Note: For old kernels (up to 3.2)
	164	* we can not rely on the ELF entry point - it was 0x800 (the SALIPL
	165	* loader) and it won't work. For this case we force it to 0x10000, too.
	166	*/
	167	if (pentry == KERN_IMAGE_START \|\| pentry == 0x800) {
	168	ipl->start_addr = KERN_IMAGE_START;
	169	/* Overwrite parameters in the kernel image, which are "rom" */
	170	strcpy(rom_ptr(KERN_PARM_AREA), ipl->cmdline);
	171	} else {
	172	ipl->start_addr = pentry;
e674a49a CB	173	}
e674a49a CB	174
f0180f91 FZ	175	if (ipl->initrd) {
	176	ram_addr_t initrd_offset;
	177	int initrd_size;
	178
	179	initrd_offset = INITRD_START;
	180	while (kernel_size + 0x100000 > initrd_offset) {
	181	initrd_offset += 0x100000;
	182	}
	183	initrd_size = load_image_targphys(ipl->initrd, initrd_offset,
	184	ram_size - initrd_offset);
	185	if (initrd_size == -1) {
e6da780d	186	error_setg(&err, "could not load initrd '%s'", ipl->initrd);
8f04e88e	187	goto error;
f0180f91	188	}
e674a49a	189
f0180f91 FZ	190	/*
	191	* we have to overwrite values in the kernel image,
	192	* which are "rom"
	193	*/
	194	stq_p(rom_ptr(INITRD_PARM_START), initrd_offset);
	195	stq_p(rom_ptr(INITRD_PARM_SIZE), initrd_size);
	196	}
	197	}
bb099546 DH	198	/*
	199	* Don't ever use the migrated values, they could come from a different
	200	* BIOS and therefore don't work. But still migrate the values, so
	201	* QEMUs relying on it don't break.
	202	*/
	203	ipl->compat_start_addr = ipl->start_addr;
	204	ipl->compat_bios_start_addr = ipl->bios_start_addr;
04fccf10	205	qemu_register_reset(qdev_reset_all_fn, dev);
8f04e88e	206	error:
e6da780d	207	error_propagate(errp, err);
e674a49a CB	208	}
	209
	210	static Property s390_ipl_properties[] = {
	211	DEFINE_PROP_STRING("kernel", S390IPLState, kernel),
	212	DEFINE_PROP_STRING("initrd", S390IPLState, initrd),
	213	DEFINE_PROP_STRING("cmdline", S390IPLState, cmdline),
d0249ce5	214	DEFINE_PROP_STRING("firmware", S390IPLState, firmware),
5f31ade0	215	DEFINE_PROP_STRING("netboot_fw", S390IPLState, netboot_fw),
f0180f91	216	DEFINE_PROP_BOOL("enforce_bios", S390IPLState, enforce_bios, false),
04ca4b92 AY	217	DEFINE_PROP_BOOL("iplbext_migration", S390IPLState, iplbext_migration,
04ca4b92 AY	218	true),
e674a49a CB	219	DEFINE_PROP_END_OF_LIST(),
	220	};
	221
010d45d2	222	static bool s390_gen_initial_iplb(S390IPLState *ipl)
df75a4e2 FZ	223	{
	224	DeviceState *dev_st;
	225
df75a4e2 FZ	226	dev_st = get_boot_device(0);
df75a4e2 FZ	227	if (dev_st) {
b804e8a6 JL	228	VirtioCcwDevice virtio_ccw_dev = (VirtioCcwDevice )
b804e8a6 JL	229	object_dynamic_cast(OBJECT(qdev_get_parent_bus(dev_st)->parent),
df75a4e2	230	TYPE_VIRTIO_CCW_DEVICE);
e468b673 AY	231	SCSIDevice sd = (SCSIDevice ) object_dynamic_cast(OBJECT(dev_st),
e468b673 AY	232	TYPE_SCSI_DEVICE);
f38b5b7f FA	233	VirtIONet vn = (VirtIONet ) object_dynamic_cast(OBJECT(dev_st),
	234	TYPE_VIRTIO_NET);
	235
	236	if (vn) {
	237	ipl->netboot = true;
	238	}
b804e8a6 JL	239	if (virtio_ccw_dev) {
	240	CcwDevice *ccw_dev = CCW_DEVICE(virtio_ccw_dev);
	241
6aed9589 AY	242	ipl->iplb.len = cpu_to_be32(S390_IPLB_MIN_CCW_LEN);
	243	ipl->iplb.blk0_len =
	244	cpu_to_be32(S390_IPLB_MIN_CCW_LEN - S390_IPLB_HEADER_LEN);
	245	ipl->iplb.pbt = S390_IPL_TYPE_CCW;
	246	ipl->iplb.ccw.devno = cpu_to_be16(ccw_dev->sch->devno);
3041e3be	247	ipl->iplb.ccw.ssid = ccw_dev->sch->ssid & 3;
e468b673 AY	248	} else if (sd) {
	249	SCSIBus *bus = scsi_bus_from_device(sd);
	250	VirtIOSCSI *vdev = container_of(bus, VirtIOSCSI, bus);
	251	VirtIOSCSICcw *scsi_ccw = container_of(vdev, VirtIOSCSICcw, vdev);
99efaa26 TH	252	CcwDevice *ccw_dev;
	253
	254	ccw_dev = (CcwDevice *)object_dynamic_cast(OBJECT(scsi_ccw),
	255	TYPE_CCW_DEVICE);
	256	if (!ccw_dev) { /* It might be a PCI device instead */
	257	return false;
	258	}
e468b673 AY	259
	260	ipl->iplb.len = cpu_to_be32(S390_IPLB_MIN_QEMU_SCSI_LEN);
	261	ipl->iplb.blk0_len =
	262	cpu_to_be32(S390_IPLB_MIN_QEMU_SCSI_LEN - S390_IPLB_HEADER_LEN);
	263	ipl->iplb.pbt = S390_IPL_TYPE_QEMU_SCSI;
	264	ipl->iplb.scsi.lun = cpu_to_be32(sd->lun);
	265	ipl->iplb.scsi.target = cpu_to_be16(sd->id);
	266	ipl->iplb.scsi.channel = cpu_to_be16(sd->channel);
b804e8a6 JL	267	ipl->iplb.scsi.devno = cpu_to_be16(ccw_dev->sch->devno);
b804e8a6 JL	268	ipl->iplb.scsi.ssid = ccw_dev->sch->ssid & 3;
bd1badf4 FA	269	} else {
	270	return false; /* unknown device */
	271	}
	272
	273	if (!s390_ipl_set_loadparm(ipl->iplb.loadparm)) {
	274	ipl->iplb.flags \|= DIAG308_FLAGS_LP_VALID;
df75a4e2	275	}
bd1badf4	276	return true;
df75a4e2 FZ	277	}
df75a4e2 FZ	278
010d45d2	279	return false;
df75a4e2 FZ	280	}
df75a4e2 FZ	281
bd1badf4 FA	282	int s390_ipl_set_loadparm(uint8_t *loadparm)
	283	{
	284	MachineState *machine = MACHINE(qdev_get_machine());
	285	char *lp = object_property_get_str(OBJECT(machine), "loadparm", NULL);
	286
	287	if (lp) {
	288	int i;
	289
	290	/* lp is an uppercase string without leading/embedded spaces */
	291	for (i = 0; i < 8 && lp[i]; i++) {
	292	loadparm[i] = ascii2ebcdic[(uint8_t) lp[i]];
	293	}
	294
	295	g_free(lp);
	296	return 0;
	297	}
	298
	299	return -1;
	300	}
	301
f38b5b7f FA	302	static int load_netboot_image(Error **errp)
	303	{
	304	S390IPLState *ipl = get_ipl_device();
	305	char *netboot_filename;
	306	MemoryRegion *sysmem = get_system_memory();
	307	MemoryRegion *mr = NULL;
	308	void *ram_ptr = NULL;
	309	int img_size = -1;
	310
	311	mr = memory_region_find(sysmem, 0, 1).mr;
	312	if (!mr) {
	313	error_setg(errp, "Failed to find memory region at address 0");
	314	return -1;
	315	}
	316
	317	ram_ptr = memory_region_get_ram_ptr(mr);
	318	if (!ram_ptr) {
	319	error_setg(errp, "No RAM found");
	320	goto unref_mr;
	321	}
	322
	323	netboot_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, ipl->netboot_fw);
	324	if (netboot_filename == NULL) {
	325	error_setg(errp, "Could not find network bootloader");
	326	goto unref_mr;
	327	}
	328
	329	img_size = load_elf_ram(netboot_filename, NULL, NULL, &ipl->start_addr,
	330	NULL, NULL, 1, EM_S390, 0, 0, NULL, false);
	331
	332	if (img_size < 0) {
	333	img_size = load_image_size(netboot_filename, ram_ptr, ram_size);
	334	ipl->start_addr = KERN_IMAGE_START;
	335	}
	336
	337	if (img_size < 0) {
	338	error_setg(errp, "Failed to load network bootloader");
	339	}
	340
	341	g_free(netboot_filename);
	342
	343	unref_mr:
	344	memory_region_unref(mr);
	345	return img_size;
	346	}
	347
	348	static bool is_virtio_net_device(IplParameterBlock *iplb)
	349	{
	350	uint8_t cssid;
	351	uint8_t ssid;
	352	uint16_t devno;
	353	uint16_t schid;
	354	SubchDev *sch = NULL;
	355
	356	if (iplb->pbt != S390_IPL_TYPE_CCW) {
	357	return false;
	358	}
	359
	360	devno = be16_to_cpu(iplb->ccw.devno);
	361	ssid = iplb->ccw.ssid & 3;
	362
	363	for (schid = 0; schid < MAX_SCHID; schid++) {
	364	for (cssid = 0; cssid < MAX_CSSID; cssid++) {
	365	sch = css_find_subch(1, cssid, ssid, schid);
366
367	if (sch && sch->devno == devno) {
368	return sch->id.cu_model == VIRTIO_ID_NET;
369	}
370	}
371	}
372	return false;
373	}
374
feacc6c2	375	void s390_ipl_update_diag308(IplParameterBlock *iplb)
df75a4e2	376	{
feacc6c2	377	S390IPLState *ipl = get_ipl_device();
df75a4e2	378
feacc6c2 DH	379	ipl->iplb = *iplb;
feacc6c2 DH	380	ipl->iplb_valid = true;
f38b5b7f	381	ipl->netboot = is_virtio_net_device(iplb);
df75a4e2 FZ	382	}
	383
	384	IplParameterBlock *s390_ipl_get_iplb(void)
	385	{
feacc6c2	386	S390IPLState *ipl = get_ipl_device();
df75a4e2	387
feacc6c2	388	if (!ipl->iplb_valid) {
df75a4e2 FZ	389	return NULL;
	390	}
	391	return &ipl->iplb;
	392	}
	393
e91e972c FZ	394	void s390_reipl_request(void)
e91e972c FZ	395	{
feacc6c2	396	S390IPLState *ipl = get_ipl_device();
e91e972c	397
e91e972c	398	ipl->reipl_requested = true;
cf83f140	399	qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
e91e972c FZ	400	}
e91e972c FZ	401
db3b2566 DH	402	void s390_ipl_prepare_cpu(S390CPU *cpu)
	403	{
	404	S390IPLState *ipl = get_ipl_device();
f38b5b7f	405	Error *err = NULL;
db3b2566 DH	406
	407	cpu->env.psw.addr = ipl->start_addr;
	408	cpu->env.psw.mask = IPL_PSW_MASK;
	409
	410	if (!ipl->kernel \|\| ipl->iplb_valid) {
	411	cpu->env.psw.addr = ipl->bios_start_addr;
010d45d2 AY	412	if (!ipl->iplb_valid) {
	413	ipl->iplb_valid = s390_gen_initial_iplb(ipl);
	414	}
db3b2566	415	}
f38b5b7f FA	416	if (ipl->netboot) {
	417	if (load_netboot_image(&err) < 0) {
	418	error_report_err(err);
	419	vm_stop(RUN_STATE_INTERNAL_ERROR);
	420	}
1045e3cd	421	ipl->iplb.ccw.netboot_start_addr = cpu_to_be64(ipl->start_addr);
f38b5b7f	422	}
db3b2566 DH	423	}
db3b2566 DH	424
e674a49a CB	425	static void s390_ipl_reset(DeviceState *dev)
	426	{
	427	S390IPLState *ipl = S390_IPL(dev);
ba1509c0	428
e91e972c FZ	429	if (!ipl->reipl_requested) {
e91e972c FZ	430	ipl->iplb_valid = false;
6aed9589	431	memset(&ipl->iplb, 0, sizeof(IplParameterBlock));
e91e972c FZ	432	}
e91e972c FZ	433	ipl->reipl_requested = false;
e674a49a CB	434	}
	435
	436	static void s390_ipl_class_init(ObjectClass klass, void data)
	437	{
	438	DeviceClass *dc = DEVICE_CLASS(klass);
e674a49a	439
04fccf10	440	dc->realize = s390_ipl_realize;
e674a49a CB	441	dc->props = s390_ipl_properties;
e674a49a CB	442	dc->reset = s390_ipl_reset;
2e13fbe4	443	dc->vmsd = &vmstate_ipl;
b4ab4572	444	set_bit(DEVICE_CATEGORY_MISC, dc->categories);
0d4fa499 TH	445	/* Reason: Loads the ROMs and thus can only be used one time - internally */
0d4fa499 TH	446	dc->user_creatable = false;
e674a49a CB	447	}
e674a49a CB	448
49973ebc	449	static const TypeInfo s390_ipl_info = {
e674a49a	450	.class_init = s390_ipl_class_init,
04fccf10 DH	451	.parent = TYPE_DEVICE,
04fccf10 DH	452	.name = TYPE_S390_IPL,
e674a49a CB	453	.instance_size = sizeof(S390IPLState),
	454	};
	455
	456	static void s390_ipl_register_types(void)
	457	{
	458	type_register_static(&s390_ipl_info);
	459	}
	460
	461	type_init(s390_ipl_register_types)