acrn-hypervisor/devicemodel/core/sw_load_ovmf.c

384 lines
9.8 KiB
C

/*-
* Copyright (c) 2018 Intel Corporation
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY NETAPP, INC ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL NETAPP, INC OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
*/
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <errno.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/mman.h>
#include "dm.h"
#include "vmmapi.h"
#include "sw_load.h"
#include "log.h"
/* ovmf binary layout:
*
* +--------------------------------------------------+ <--OVMF Top
* | |offset: Top - 0x10 (reset vector) |
* + SECFV |------------------------------------+
* | |other |
* +--------------------------------------------------+
* | |
* + FVMAIN_COMPACT +
* | |
* +--------------------------------------------------+
* | |
* + NV data storage +
* | |
* +--------------------------------------------------+ <--OVMF offset 0
*/
/* ovmf real entry is reset vector, which is (OVMF_TOP - 16) */
#define OVMF_TOP(ctx) (4*GB)
/* ovmf image size limit */
#define OVMF_SZ_LIMIT (2*MB)
/* ovmf split images size limit */
#define OVMF_VARS_SZ_LIMIT (128*KB)
#define OVMF_CODE_SZ_LIMIT (OVMF_SZ_LIMIT - OVMF_VARS_SZ_LIMIT)
/* ovmf NV storage begins at offset 0 */
#define OVMF_NVSTORAGE_OFFSET (OVMF_TOP(ctx) - ovmf_image_size())
/* ovmf NV storage size */
#define OVMF_NVSTORAGE_SZ (ovmf_file_name ? OVMF_VARS_SZ_LIMIT : ovmf_vars_size)
/* located in the ROM area */
#define OVMF_E820_BASE 0x000EF000UL
static char ovmf_path[STR_LEN];
static char ovmf_code_path[STR_LEN];
static char ovmf_vars_path[STR_LEN];
static size_t ovmf_size;
static size_t ovmf_code_size;
static size_t ovmf_vars_size;
static char *mmap_vars;
static bool writeback_nv_storage;
extern int init_cmos_vrpmb(struct vmctx *ctx);
size_t
ovmf_image_size(void)
{
size_t size = 0;
if (ovmf_file_name)
size = ovmf_size;
else if (ovmf_code_file_name && ovmf_vars_file_name)
size = ovmf_code_size + ovmf_vars_size;
return size;
}
int
acrn_parse_ovmf(char *arg)
{
int error = -1;
char *str, *cp, *token;
if (strnlen(arg, STR_LEN) < STR_LEN) {
str = cp = strdup(arg);
while ((token = strsep(&cp, ",")) != NULL) {
if (!strcmp(token, "w")) {
writeback_nv_storage = true;
} else if (!strncmp(token, "code=", sizeof("code=") - 1)) {
token += sizeof("code=") - 1;
strncpy(ovmf_code_path, token, sizeof(ovmf_code_path));
if (check_image(ovmf_code_path, OVMF_CODE_SZ_LIMIT,
&ovmf_code_size) != 0)
break;
ovmf_code_file_name = ovmf_code_path;
pr_notice("SW_LOAD: get ovmf code path %s, size 0x%lx\n",
ovmf_code_path, ovmf_code_size);
} else if (!strncmp(token, "vars=", sizeof("vars=") - 1)) {
token += sizeof("vars=") - 1;
strncpy(ovmf_vars_path, token, sizeof(ovmf_vars_path));
if (check_image(ovmf_vars_path, OVMF_VARS_SZ_LIMIT,
&ovmf_vars_size) != 0)
break;
ovmf_vars_file_name = ovmf_vars_path;
pr_notice("SW_LOAD: get ovmf vars path %s, size 0x%lx\n",
ovmf_vars_path, ovmf_vars_size);
} else {
strncpy(ovmf_path, token, sizeof(ovmf_path));
if (check_image(ovmf_path, OVMF_SZ_LIMIT, &ovmf_size) != 0)
break;
ovmf_file_name = ovmf_path;
pr_notice("SW_LOAD: get ovmf path %s, size 0x%lx\n",
ovmf_path, ovmf_size);
}
}
free(str);
}
if ((ovmf_file_name != NULL) ^ (ovmf_code_file_name && ovmf_vars_file_name))
error = 0;
return error;
}
static int
acrn_prepare_ovmf(struct vmctx *ctx)
{
int i, flags, fd;
char *path, *addr;
size_t size, size_limit, cur_size, read;
struct flock fl;
FILE *fp;
if (ovmf_file_name) {
path = ovmf_file_name;
size = ovmf_size;
size_limit = OVMF_SZ_LIMIT;
} else {
path = ovmf_vars_file_name;
size = ovmf_vars_size;
size_limit = OVMF_VARS_SZ_LIMIT;
}
flags = writeback_nv_storage ? O_RDWR : O_RDONLY;
addr = ctx->baseaddr + OVMF_TOP(ctx) - ovmf_image_size();
for (i = 0; i < 2; i++) {
fd = open(path, flags);
if (fd == -1) {
pr_err("SW_LOAD ERR: could not open ovmf file: %s (%s)\n",
path, strerror(errno));
return -1;
}
/* acquire read lock over the entire file */
memset(&fl, 0, sizeof(fl));
fl.l_type = F_RDLCK;
fl.l_whence = SEEK_SET;
fl.l_start = 0;
fl.l_len = 0;
if (fcntl(fd, F_SETLK, &fl)) {
pr_err("SW_LOAD ERR: could not fcntl(F_RDLCK) "
"ovmf file: %s (%s)\n",
path, strerror(errno));
close(fd);
return -1;
}
if (check_image(path, size_limit, &cur_size) != 0) {
close(fd);
return -1;
}
if (cur_size != size) {
pr_err("SW_LOAD ERR: ovmf file %s changed\n", path);
close(fd);
return -1;
}
if (flags == O_RDWR) {
/* upgrade to write lock */
memset(&fl, 0, sizeof(fl));
fl.l_type = F_WRLCK;
fl.l_whence = SEEK_SET;
fl.l_start = 0;
fl.l_len = OVMF_NVSTORAGE_SZ;
if (fcntl(fd, F_SETLK, &fl)) {
pr_err("SW_LOAD ERR: could not fcntl(F_WRLCK) "
"ovmf file: %s (%s)\n",
path, strerror(errno));
close(fd);
return -1;
}
mmap_vars = mmap(NULL, OVMF_NVSTORAGE_SZ, PROT_WRITE,
MAP_SHARED, fd, 0);
if (mmap_vars == MAP_FAILED) {
pr_err("SW_LOAD ERR: could not mmap "
"ovmf file: %s (%s)\n",
path, strerror(errno));
close(fd);
return -1;
}
}
fp = fdopen(fd, "r");
if (fp == NULL) {
pr_err("SW_LOAD ERR: could not fdopen "
"ovmf file: %s (%s)\n",
path, strerror(errno));
close(fd);
return -1;
}
fseek(fp, 0, SEEK_SET);
read = fread(addr, sizeof(char), size, fp);
fclose(fp);
if (read < size) {
pr_err("SW_LOAD ERR: could not read whole partition blob %s\n",
path);
return -1;
}
pr_info("SW_LOAD: partition blob %s size 0x%lx copied to addr %p\n",
path, size, addr);
if (!ovmf_file_name) {
addr += size;
path = ovmf_code_file_name;
size = ovmf_code_size;
size_limit = OVMF_CODE_SZ_LIMIT;
flags = O_RDONLY;
} else
break;
}
return 0;
}
int
acrn_sw_load_ovmf(struct vmctx *ctx)
{
int ret;
struct {
char signature[4];
uint32_t nentries;
struct e820_entry map[];
} __attribute__((packed)) *e820;
init_cmos_vrpmb(ctx);
ret = acrn_prepare_ovmf(ctx);
if (ret)
return ret;
e820 = paddr_guest2host(ctx, OVMF_E820_BASE,
e820_default_entries[LOWRAM_E820_ENTRY].baseaddr -
OVMF_E820_BASE);
if (e820 == NULL)
return -1;
strncpy(e820->signature, "820", sizeof(e820->signature));
e820->nentries = acrn_create_e820_table(ctx, e820->map);
pr_info("SW_LOAD: ovmf_entry 0x%lx\n", OVMF_TOP(ctx) - 16);
/* set guest bsp state. Will call hypercall set bsp state
* after bsp is created.
*/
memset(&ctx->bsp_regs, 0, sizeof(struct acrn_vcpu_regs));
ctx->bsp_regs.vcpu_id = 0;
/* CR0_ET | CR0_NE */
ctx->bsp_regs.vcpu_regs.cr0 = 0x30U;
ctx->bsp_regs.vcpu_regs.cs_ar = 0x009FU;
ctx->bsp_regs.vcpu_regs.cs_sel = 0xF000U;
ctx->bsp_regs.vcpu_regs.cs_limit = 0xFFFFU;
ctx->bsp_regs.vcpu_regs.cs_base = (OVMF_TOP(ctx) - 16) & 0xFFFF0000UL;
ctx->bsp_regs.vcpu_regs.rip = (OVMF_TOP(ctx) - 16) & 0xFFFFUL;
return 0;
}
/*
* The NV data section is the first 128KB in the OVMF image. At runtime,
* it's copied into guest memory and behave as RAM to OVMF. It can be
* accessed and updated by OVMF. To preserve NV section (referred to
* as Non-Volatile Data Store section in the OVMF spec), we're flushing
* in-memory data back to the NV data section of the OVMF image file
* at designated points.
*/
int
acrn_writeback_ovmf_nvstorage(struct vmctx *ctx)
{
int i, fd, ret = 0;
char *path;
struct flock fl;
if (!writeback_nv_storage)
return 0;
memcpy(mmap_vars, ctx->baseaddr + OVMF_NVSTORAGE_OFFSET,
OVMF_NVSTORAGE_SZ);
if (munmap(mmap_vars, OVMF_NVSTORAGE_SZ)) {
pr_err("SW_LOAD ERR: could not munmap (%s)\n",
strerror(errno));
ret = -1;
}
mmap_vars = NULL;
path = ovmf_file_name ? ovmf_file_name : ovmf_vars_file_name;
pr_info("OVMF_WRITEBACK: OVMF has been written back "
"to partition blob %s size 0x%lx @ gpa %p\n",
path, OVMF_NVSTORAGE_SZ, (void *)OVMF_NVSTORAGE_OFFSET);
for (i = 0; i < 2; i++) {
fd = open(path, O_RDONLY);
if (fd == -1) {
pr_err("SW_LOAD ERR: could not open ovmf file: %s (%s)\n",
path, strerror(errno));
ret = -1;
goto next;
}
/* unlock the entire file */
memset(&fl, 0, sizeof(fl));
fl.l_type = F_UNLCK;
fl.l_whence = SEEK_SET;
fl.l_start = 0;
fl.l_len = 0;
if (fcntl(fd, F_SETLK, &fl)) {
pr_err("SW_LOAD ERR: could not fcntl(F_UNLCK) "
"ovmf file: %s (%s)\n",
path, strerror(errno));
ret = -1;
}
close(fd);
next:
if (!ovmf_file_name)
path = ovmf_code_file_name;
else
break;
}
return ret;
}