1*cf604485SWarner Losh /*
2*cf604485SWarner Losh * Copyright (c) 2023 Warner Losh
3*cf604485SWarner Losh *
4*cf604485SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
5*cf604485SWarner Losh */
6*cf604485SWarner Losh
7*cf604485SWarner Losh /*
8*cf604485SWarner Losh * Test program for smbios support in the boot loader. This program will mmap
9*cf604485SWarner Losh * physical memory, and print the smbios table at the passed in PA. This is
10*cf604485SWarner Losh * intended to test the code and debug problems in a debugger friendly
11*cf604485SWarner Losh * environment.
12*cf604485SWarner Losh */
13*cf604485SWarner Losh
14*cf604485SWarner Losh #include <sys/param.h>
15*cf604485SWarner Losh #define setenv my_setenv
16*cf604485SWarner Losh
17*cf604485SWarner Losh #define SMBIOS_SERIAL_NUMBERS 1
18*cf604485SWarner Losh #define SMBIOS_LITTLE_ENDIAN_UUID 1
19*cf604485SWarner Losh
20*cf604485SWarner Losh #include <arpa/inet.h>
21*cf604485SWarner Losh
22*cf604485SWarner Losh #include "smbios.h"
23*cf604485SWarner Losh #include "smbios.c"
24*cf604485SWarner Losh
25*cf604485SWarner Losh #include <sys/mman.h>
26*cf604485SWarner Losh
27*cf604485SWarner Losh #define MAX_MAP 10
28*cf604485SWarner Losh #define PAGE (64<<10)
29*cf604485SWarner Losh
30*cf604485SWarner Losh static struct mapping
31*cf604485SWarner Losh {
32*cf604485SWarner Losh uintptr_t pa;
33*cf604485SWarner Losh caddr_t va;
34*cf604485SWarner Losh } map[MAX_MAP];
35*cf604485SWarner Losh static int fd;
36*cf604485SWarner Losh static int nmap;
37*cf604485SWarner Losh
ptov(uintptr_t pa)38*cf604485SWarner Losh caddr_t ptov(uintptr_t pa)
39*cf604485SWarner Losh {
40*cf604485SWarner Losh caddr_t va;
41*cf604485SWarner Losh uintptr_t pa2;
42*cf604485SWarner Losh struct mapping *m = map;
43*cf604485SWarner Losh
44*cf604485SWarner Losh pa2 = rounddown(pa, PAGE);
45*cf604485SWarner Losh for (int i = 0; i < nmap; i++, m++) {
46*cf604485SWarner Losh if (m->pa == pa2) {
47*cf604485SWarner Losh return (m->va + pa - m->pa);
48*cf604485SWarner Losh }
49*cf604485SWarner Losh }
50*cf604485SWarner Losh if (nmap == MAX_MAP)
51*cf604485SWarner Losh errx(1, "Too many maps");
52*cf604485SWarner Losh va = mmap(0, PAGE, PROT_READ, MAP_SHARED, fd, pa2);
53*cf604485SWarner Losh if (va == MAP_FAILED)
54*cf604485SWarner Losh err(1, "mmap offset %#lx", (long)pa2);
55*cf604485SWarner Losh m = &map[nmap++];
56*cf604485SWarner Losh m->pa = pa2;
57*cf604485SWarner Losh m->va = va;
58*cf604485SWarner Losh return (m->va + pa - m->pa);
59*cf604485SWarner Losh }
60*cf604485SWarner Losh
61*cf604485SWarner Losh static void
cleanup(void)62*cf604485SWarner Losh cleanup(void)
63*cf604485SWarner Losh {
64*cf604485SWarner Losh for (int i = 0; i < nmap; i++) {
65*cf604485SWarner Losh munmap(map[i].va, PAGE);
66*cf604485SWarner Losh }
67*cf604485SWarner Losh }
68*cf604485SWarner Losh
69*cf604485SWarner Losh int
my_setenv(const char * name,const char * value,int overwrite __unused)70*cf604485SWarner Losh my_setenv(const char *name, const char *value, int overwrite __unused)
71*cf604485SWarner Losh {
72*cf604485SWarner Losh printf("%s=%s\n", name, value);
73*cf604485SWarner Losh return 0;
74*cf604485SWarner Losh }
75*cf604485SWarner Losh
76*cf604485SWarner Losh static void
usage(void)77*cf604485SWarner Losh usage(void)
78*cf604485SWarner Losh {
79*cf604485SWarner Losh errx(1, "smbios address");
80*cf604485SWarner Losh }
81*cf604485SWarner Losh
82*cf604485SWarner Losh int
main(int argc,char ** argv)83*cf604485SWarner Losh main(int argc, char **argv)
84*cf604485SWarner Losh {
85*cf604485SWarner Losh uintptr_t addr;
86*cf604485SWarner Losh
87*cf604485SWarner Losh if (argc != 2)
88*cf604485SWarner Losh usage();
89*cf604485SWarner Losh addr = strtoull(argv[1], NULL, 0);
90*cf604485SWarner Losh /* For mmap later */
91*cf604485SWarner Losh fd = open("/dev/mem", O_RDONLY);
92*cf604485SWarner Losh if (fd < 0)
93*cf604485SWarner Losh err(1, "Opening /dev/mem");
94*cf604485SWarner Losh smbios_detect(ptov(addr));
95*cf604485SWarner Losh cleanup();
96*cf604485SWarner Losh }
97