Changeset View
Changeset View
Standalone View
Standalone View
usr.sbin/bhyve/arm64/bootrom.c
- This file was added.
/*- | |||||
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD | |||||
* | |||||
* Copyright (c) 2015 Neel Natu <neel@freebsd.org> | |||||
* All rights reserved. | |||||
* | |||||
* 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 THE AUTHOR ``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 THE AUTHOR 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 <sys/param.h> | |||||
__FBSDID("$FreeBSD$"); | |||||
#include <sys/types.h> | |||||
#include <sys/mman.h> | |||||
#include <sys/stat.h> | |||||
#include <machine/vmm.h> | |||||
#include <err.h> | |||||
#include <errno.h> | |||||
#include <fcntl.h> | |||||
#include <stdio.h> | |||||
#include <string.h> | |||||
#include <unistd.h> | |||||
#include <stdbool.h> | |||||
#include <vmmapi.h> | |||||
#include "bhyverun.h" | |||||
#include "bootrom.h" | |||||
#include "debug.h" | |||||
int | |||||
bootrom_alloc(struct vmctx *ctx, uint64_t *gpa, size_t len, char **base) | |||||
{ | |||||
if (len == 0) { | |||||
warnx("ROM size %zu is invalid", len); | |||||
return (EINVAL); | |||||
} | |||||
len = roundup2(len, PAGE_SIZE); | |||||
*base = vm_map_ipa(ctx, *gpa, len); | |||||
printf("%s: gpa=%#lx base=%#lx\n", __func__, *gpa, (uint64_t)*base); | |||||
return (0); | |||||
} | |||||
int | |||||
bootrom_loadrom(struct vmctx *ctx, const char *romfile, uint64_t *gpa) | |||||
{ | |||||
struct stat sbuf; | |||||
ssize_t rlen; | |||||
char *base; | |||||
int fd, i, rv; | |||||
rv = -1; | |||||
fd = open(romfile, O_RDONLY); | |||||
if (fd < 0) { | |||||
EPRINTLN("Error opening bootrom \"%s\": %s", | |||||
romfile, strerror(errno)); | |||||
goto done; | |||||
} | |||||
if (fstat(fd, &sbuf) < 0) { | |||||
EPRINTLN("Could not fstat bootrom file \"%s\": %s", | |||||
romfile, strerror(errno)); | |||||
goto done; | |||||
} | |||||
/* Map the bootrom into the guest address space */ | |||||
if (bootrom_alloc(ctx, gpa, sbuf.st_size, &base) != 0) | |||||
goto done; | |||||
/* Read 'romfile' into the guest address space */ | |||||
for (i = 0; i < sbuf.st_size / PAGE_SIZE; i++) { | |||||
rlen = read(fd, base + i * PAGE_SIZE, PAGE_SIZE); | |||||
if (rlen != PAGE_SIZE) { | |||||
perror("read"); | |||||
EPRINTLN("Incomplete read of page %d of bootrom " | |||||
"file %s: %ld bytes", i, romfile, rlen); | |||||
goto done; | |||||
} | |||||
} | |||||
if (sbuf.st_size % PAGE_SIZE != 0) { | |||||
rlen = read(fd, base + i * PAGE_SIZE, sbuf.st_size % PAGE_SIZE); | |||||
if (rlen != sbuf.st_size % PAGE_SIZE) { | |||||
perror("read"); | |||||
EPRINTLN("Incomplete read of page %d of bootrom " | |||||
"file %s: %ld bytes", i, romfile, rlen); | |||||
goto done; | |||||
} | |||||
} | |||||
printf("Finished reading bootrom\n"); | |||||
rv = 0; | |||||
done: | |||||
if (fd >= 0) | |||||
close(fd); | |||||
return (rv); | |||||
} |