@@ -355,4 +355,18 @@ static inline int uv_set_se_hdr(uint64_t handle, void *hdr, size_t len)
return uv_call(0, (uint64_t)&uvcb);
}
+static inline int uv_unp_page(uint64_t handle, uint64_t gaddr, uint64_t tweak1, uint64_t tweak2)
+{
+ struct uv_cb_unp uvcb = {
+ .header.cmd = UVC_CMD_UNPACK_IMG,
+ .header.len = sizeof(uvcb),
+ .guest_handle = handle,
+ .gaddr = gaddr,
+ .tweak[0] = tweak1,
+ .tweak[1] = tweak2,
+ };
+
+ return uv_call(0, (uint64_t)&uvcb);
+}
+
#endif
@@ -203,6 +203,9 @@ union {
struct vm_uv {
uint64_t vm_handle;
uint64_t vcpu_handle;
+ void *conf_base_stor;
+ void *conf_var_stor;
+ void *cpu_stor;
};
struct vm_save_regs {
@@ -2,9 +2,16 @@
#ifndef _S390X_UV_H_
#define _S390X_UV_H_
+#include <sie.h>
+
bool uv_os_is_guest(void);
bool uv_os_is_host(void);
bool uv_query_test_call(unsigned int nr);
+void uv_init(void);
int uv_setup(void);
+void uv_create_guest(struct vm *vm);
+void uv_destroy_guest(struct vm *vm);
+int uv_unpack(struct vm *vm, uint64_t addr, uint64_t len, uint64_t tweak);
+void uv_verify_load(struct vm *vm);
#endif /* UV_H */
@@ -17,11 +17,14 @@
#include <asm/facility.h>
#include <asm/uv.h>
#include <uv.h>
+#include <sie.h>
static struct uv_cb_qui uvcb_qui = {
.header.cmd = UVC_CMD_QUI,
.header.len = sizeof(uvcb_qui),
};
+static uint64_t uv_init_mem;
+
bool uv_os_is_guest(void)
{
@@ -54,3 +57,128 @@ int uv_setup(void)
assert(uvcb_qui.header.rc == 1 || uvcb_qui.header.rc == 0x100);
return 1;
}
+
+void uv_init(void)
+{
+ struct uv_cb_init uvcb_init = {
+ .header.len = sizeof(uvcb_init),
+ .header.cmd = UVC_CMD_INIT_UV,
+ };
+ static bool initialized;
+ int cc;
+
+ /* Let's not do this twice */
+ assert(!initialized);
+ /* Query is done on initialization but let's check anyway */
+ assert(uvcb_qui.header.rc == 1 || uvcb_qui.header.rc == 0x100);
+
+ /* Donated storage needs to be over 2GB aligned to 1MB */
+ uv_init_mem = (uint64_t)memalign_pages_flags(HPAGE_SIZE, uvcb_qui.uv_base_stor_len, AREA_NORMAL);
+ uvcb_init.stor_origin = uv_init_mem;
+ uvcb_init.stor_len = uvcb_qui.uv_base_stor_len;
+
+ cc = uv_call(0, (uint64_t)&uvcb_init);
+ assert(cc == 0);
+ initialized = true;
+}
+
+void uv_create_guest(struct vm *vm)
+{
+ struct uv_cb_cgc uvcb_cgc = {
+ .header.cmd = UVC_CMD_CREATE_SEC_CONF,
+ .header.len = sizeof(uvcb_cgc),
+ };
+ struct uv_cb_csc uvcb_csc = {
+ .header.len = sizeof(uvcb_csc),
+ .header.cmd = UVC_CMD_CREATE_SEC_CPU,
+ .state_origin = (uint64_t)vm->sblk,
+ .num = 0,
+ };
+ unsigned long vsize;
+ int cc;
+
+ uvcb_cgc.guest_stor_origin = vm->sblk->mso;
+ uvcb_cgc.guest_stor_len = vm->sblk->msl;
+
+ /* Config allocation */
+ vsize = uvcb_qui.conf_base_virt_stor_len +
+ ((uvcb_cgc.guest_stor_len / HPAGE_SIZE) * uvcb_qui.conf_virt_var_stor_len);
+
+ vm->uv.conf_base_stor = memalign_pages_flags(PAGE_SIZE * 4, uvcb_qui.conf_base_phys_stor_len, 0);
+ /*
+ * This allocation needs to be below the max guest storage
+ * address so let's simply put it into the physical memory
+ */
+ vm->uv.conf_var_stor = memalign_pages_flags(PAGE_SIZE, vsize,0);
+ uvcb_cgc.conf_base_stor_origin = (uint64_t)vm->uv.conf_base_stor;
+ uvcb_cgc.conf_var_stor_origin = (uint64_t)vm->uv.conf_var_stor;
+
+ /* CPU allocation */
+ vm->uv.cpu_stor = memalign_pages_flags(PAGE_SIZE, uvcb_qui.cpu_stor_len, 0);
+ uvcb_csc.stor_origin = (uint64_t)vm->uv.cpu_stor;
+
+ uvcb_cgc.guest_asce = (uint64_t)stctg(1);
+ uvcb_cgc.guest_sca = (uint64_t)vm->sca;
+
+ cc = uv_call(0, (uint64_t)&uvcb_cgc);
+ assert(!cc);
+
+ vm->uv.vm_handle = uvcb_cgc.guest_handle;
+ uvcb_csc.guest_handle = uvcb_cgc.guest_handle;
+ cc = uv_call(0, (uint64_t)&uvcb_csc);
+ vm->uv.vcpu_handle = uvcb_csc.cpu_handle;
+ assert(!cc);
+
+ /*
+ * Convert guest to format 4:
+ *
+ * - Set format 4
+ * - Write UV handles into sblk
+ * - Allocate and set SIDA
+ */
+ vm->sblk->sdf = 2;
+ vm->sblk->sidad = (uint64_t)alloc_page();
+ vm->sblk->pv_handle_cpu = uvcb_csc.cpu_handle;
+ vm->sblk->pv_handle_config = uvcb_cgc.guest_handle;
+}
+
+void uv_destroy_guest(struct vm *vm)
+{
+ int cc;
+ u16 rc, rrc;
+
+ cc = uv_cmd_nodata(vm->sblk->pv_handle_cpu,
+ UVC_CMD_DESTROY_SEC_CPU, &rc, &rrc);
+ assert(cc == 0);
+ free_page((void *)vm->sblk->sidad);
+ free_pages(vm->uv.cpu_stor);
+
+ cc = uv_cmd_nodata(vm->sblk->pv_handle_config,
+ UVC_CMD_DESTROY_SEC_CONF, &rc, &rrc);
+ assert(cc == 0);
+ free_pages(vm->uv.conf_base_stor);
+ free_pages(vm->uv.conf_var_stor);
+}
+
+int uv_unpack(struct vm *vm, uint64_t addr, uint64_t len, uint64_t tweak)
+{
+ int i, cc;
+
+ for (i = 0; i < len / PAGE_SIZE; i++) {
+ cc = uv_unp_page(vm->uv.vm_handle, addr, tweak, i * PAGE_SIZE);
+ assert(!cc);
+ addr += PAGE_SIZE;
+ }
+ return cc;
+}
+
+void uv_verify_load(struct vm *vm)
+{
+ uint16_t rc, rrc;
+ int cc;
+
+ cc = uv_cmd_nodata(vm->uv.vm_handle, UVC_CMD_VERIFY_IMG, &rc, &rrc);
+ assert(!cc);
+ cc = uv_set_cpu_state(vm->uv.vcpu_handle, PV_CPU_STATE_OPR_LOAD);
+ assert(!cc);
+}