/*
 * Copyright (c) 2023 Warner Losh
 *
 * SPDX-License-Identifier: BSD-2-Clause
 */

/*
 * Test program for smbios support in the boot loader. This program will mmap
 * physical memory, and print the smbios table at the passed in PA. This is
 * intended to test the code and debug problems in a debugger friendly
 * environment.
 */

#include <sys/param.h>
#define setenv my_setenv

#define SMBIOS_SERIAL_NUMBERS 1
#define SMBIOS_LITTLE_ENDIAN_UUID 1

#include <arpa/inet.h>

#include "smbios.h"
#include "smbios.c"

#include <sys/mman.h>

#define MAX_MAP	10
#define PAGE	(64<<10)

static struct mapping 
{
	uintptr_t pa;
	caddr_t va;
} map[MAX_MAP];
static int fd;
static int nmap;

caddr_t ptov(uintptr_t pa)
{
	caddr_t va;
	uintptr_t pa2;
	struct mapping *m = map;

	pa2 = rounddown(pa, PAGE);
	for (int i = 0; i < nmap; i++, m++) {
		if (m->pa == pa2) {
			return (m->va + pa - m->pa);
		}
	}
	if (nmap == MAX_MAP)
		errx(1, "Too many maps");
	va = mmap(0, PAGE, PROT_READ, MAP_SHARED, fd, pa2);
	if (va == MAP_FAILED)
		err(1, "mmap offset %#lx", (long)pa2);
	m = &map[nmap++];
	m->pa = pa2;
	m->va = va;
	return (m->va + pa - m->pa);
}

static void
cleanup(void)
{
	for (int i = 0; i < nmap; i++) {
		munmap(map[i].va, PAGE);
	}
}

int
my_setenv(const char *name, const char *value, int overwrite __unused)
{
	printf("%s=%s\n", name, value);
	return 0;
}

static void
usage(void)
{
	errx(1, "smbios address");
}

int
main(int argc, char **argv)
{
	uintptr_t addr;
	
	if (argc != 2)
		usage();
	addr = strtoull(argv[1], NULL, 0);
	/* For mmap later */
	fd = open("/dev/mem", O_RDONLY);
	if (fd < 0)
		err(1, "Opening /dev/mem");
	smbios_detect(ptov(addr));
	cleanup();
}