1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
|
/*-
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
*
* Copyright (c) 2021 Beckhoff Automation GmbH & Co. KG
* Author: Corvin Köhne <c.koehne@beckhoff.com>
*/
#include <sys/param.h>
#include <machine/vmm.h>
#include <err.h>
#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include "acpi_device.h"
#include "inout.h"
#include "qemu_fwcfg.h"
#define QEMU_FWCFG_ACPI_DEVICE_NAME "FWCF"
#define QEMU_FWCFG_ACPI_HARDWARE_ID "QEMU0002"
#define QEMU_FWCFG_SELECTOR_PORT_NUMBER 0x510
#define QEMU_FWCFG_SELECTOR_PORT_SIZE 1
#define QEMU_FWCFG_SELECTOR_PORT_FLAGS IOPORT_F_INOUT
#define QEMU_FWCFG_DATA_PORT_NUMBER 0x511
#define QEMU_FWCFG_DATA_PORT_SIZE 1
#define QEMU_FWCFG_DATA_PORT_FLAGS \
IOPORT_F_INOUT /* QEMU v2.4+ ignores writes */
#define QEMU_FWCFG_ARCHITECTURE_MASK 0x0001
#define QEMU_FWCFG_INDEX_MASK 0x3FFF
#define QEMU_FWCFG_SELECT_READ 0
#define QEMU_FWCFG_SELECT_WRITE 1
#define QEMU_FWCFG_ARCHITECTURE_GENERIC 0
#define QEMU_FWCFG_ARCHITECTURE_SPECIFIC 1
#pragma pack(1)
union qemu_fwcfg_selector {
struct {
uint16_t index : 14;
uint16_t writeable : 1;
uint16_t architecture : 1;
};
uint16_t bits;
};
#pragma pack()
struct qemu_fwcfg_softc {
struct acpi_device *acpi_dev;
uint32_t data_offset;
union qemu_fwcfg_selector selector;
struct qemu_fwcfg_item items[QEMU_FWCFG_MAX_ARCHS]
[QEMU_FWCFG_MAX_ENTRIES];
};
static struct qemu_fwcfg_softc fwcfg_sc;
static int
qemu_fwcfg_selector_port_handler(struct vmctx *const ctx __unused, const int in,
const int port __unused, const int bytes, uint32_t *const eax,
void *const arg __unused)
{
if (bytes != sizeof(uint16_t)) {
warnx("%s: invalid size (%d) of IO port access", __func__,
bytes);
return (-1);
}
if (in) {
*eax = htole16(fwcfg_sc.selector.bits);
return (0);
}
fwcfg_sc.data_offset = 0;
fwcfg_sc.selector.bits = le16toh(*eax);
return (0);
}
static int
qemu_fwcfg_data_port_handler(struct vmctx *const ctx __unused, const int in,
const int port __unused, const int bytes, uint32_t *const eax,
void *const arg __unused)
{
if (bytes != sizeof(uint8_t)) {
warnx("%s: invalid size (%d) of IO port access", __func__,
bytes);
return (-1);
}
if (!in) {
warnx("%s: Writes to qemu fwcfg data port aren't allowed",
__func__);
return (-1);
}
/* get fwcfg item */
struct qemu_fwcfg_item *const item =
&fwcfg_sc.items[fwcfg_sc.selector.architecture]
[fwcfg_sc.selector.index];
if (item->data == NULL) {
warnx(
"%s: qemu fwcfg item doesn't exist (architecture %s index 0x%x)",
__func__,
fwcfg_sc.selector.architecture ? "specific" : "generic",
fwcfg_sc.selector.index);
*eax = 0x00;
return (0);
} else if (fwcfg_sc.data_offset >= item->size) {
warnx(
"%s: qemu fwcfg item read exceeds size (architecture %s index 0x%x size 0x%x offset 0x%x)",
__func__,
fwcfg_sc.selector.architecture ? "specific" : "generic",
fwcfg_sc.selector.index, item->size, fwcfg_sc.data_offset);
*eax = 0x00;
return (0);
}
/* return item data */
*eax = item->data[fwcfg_sc.data_offset];
fwcfg_sc.data_offset++;
return (0);
}
static int
qemu_fwcfg_register_port(const char *const name, const int port, const int size,
const int flags, const inout_func_t handler)
{
struct inout_port iop;
bzero(&iop, sizeof(iop));
iop.name = name;
iop.port = port;
iop.size = size;
iop.flags = flags;
iop.handler = handler;
return (register_inout(&iop));
}
int
qemu_fwcfg_init(struct vmctx *const ctx)
{
int error;
error = acpi_device_create(&fwcfg_sc.acpi_dev, ctx,
QEMU_FWCFG_ACPI_DEVICE_NAME, QEMU_FWCFG_ACPI_HARDWARE_ID);
if (error) {
warnx("%s: failed to create ACPI device for QEMU FwCfg",
__func__);
goto done;
}
error = acpi_device_add_res_fixed_ioport(fwcfg_sc.acpi_dev,
QEMU_FWCFG_SELECTOR_PORT_NUMBER, 2);
if (error) {
warnx("%s: failed to add fixed IO port for QEMU FwCfg",
__func__);
goto done;
}
/* add handlers for fwcfg ports */
if ((error = qemu_fwcfg_register_port("qemu_fwcfg_selector",
QEMU_FWCFG_SELECTOR_PORT_NUMBER, QEMU_FWCFG_SELECTOR_PORT_SIZE,
QEMU_FWCFG_SELECTOR_PORT_FLAGS,
qemu_fwcfg_selector_port_handler)) != 0) {
warnx("%s: Unable to register qemu fwcfg selector port 0x%x",
__func__, QEMU_FWCFG_SELECTOR_PORT_NUMBER);
goto done;
}
if ((error = qemu_fwcfg_register_port("qemu_fwcfg_data",
QEMU_FWCFG_DATA_PORT_NUMBER, QEMU_FWCFG_DATA_PORT_SIZE,
QEMU_FWCFG_DATA_PORT_FLAGS, qemu_fwcfg_data_port_handler)) != 0) {
warnx("%s: Unable to register qemu fwcfg data port 0x%x",
__func__, QEMU_FWCFG_DATA_PORT_NUMBER);
goto done;
}
done:
if (error) {
acpi_device_destroy(fwcfg_sc.acpi_dev);
}
return (error);
}
|
