1
2
3
4
5
6
7
8
9
10
11
12
13
14#include "sysemu.h"
15#include "smbios.h"
16#include "loader.h"
17
18
19
20
21struct smbios_header {
22 uint16_t length;
23 uint8_t type;
24} __attribute__((__packed__));
25
26struct smbios_field {
27 struct smbios_header header;
28 uint8_t type;
29 uint16_t offset;
30 uint8_t data[];
31} __attribute__((__packed__));
32
33struct smbios_table {
34 struct smbios_header header;
35 uint8_t data[];
36} __attribute__((__packed__));
37
38#define SMBIOS_FIELD_ENTRY 0
39#define SMBIOS_TABLE_ENTRY 1
40
41
42static uint8_t *smbios_entries;
43static size_t smbios_entries_len;
44static int smbios_type4_count = 0;
45
46static void smbios_validate_table(void)
47{
48 if (smbios_type4_count && smbios_type4_count != smp_cpus) {
49 fprintf(stderr,
50 "Number of SMBIOS Type 4 tables must match cpu count.\n");
51 exit(1);
52 }
53}
54
55uint8_t *smbios_get_table(size_t *length)
56{
57 smbios_validate_table();
58 *length = smbios_entries_len;
59 return smbios_entries;
60}
61
62
63
64
65
66static void smbios_check_collision(int type, int entry)
67{
68 uint16_t *num_entries = (uint16_t *)smbios_entries;
69 struct smbios_header *header;
70 char *p;
71 int i;
72
73 if (!num_entries)
74 return;
75
76 p = (char *)(num_entries + 1);
77
78 for (i = 0; i < *num_entries; i++) {
79 header = (struct smbios_header *)p;
80 if (entry == SMBIOS_TABLE_ENTRY && header->type == SMBIOS_FIELD_ENTRY) {
81 struct smbios_field *field = (void *)header;
82 if (type == field->type) {
83 fprintf(stderr, "SMBIOS type %d field already defined, "
84 "cannot add table\n", type);
85 exit(1);
86 }
87 } else if (entry == SMBIOS_FIELD_ENTRY &&
88 header->type == SMBIOS_TABLE_ENTRY) {
89 struct smbios_structure_header *table = (void *)(header + 1);
90 if (type == table->type) {
91 fprintf(stderr, "SMBIOS type %d table already defined, "
92 "cannot add field\n", type);
93 exit(1);
94 }
95 }
96 p += le16_to_cpu(header->length);
97 }
98}
99
100void smbios_add_field(int type, int offset, int len, void *data)
101{
102 struct smbios_field *field;
103
104 smbios_check_collision(type, SMBIOS_FIELD_ENTRY);
105
106 if (!smbios_entries) {
107 smbios_entries_len = sizeof(uint16_t);
108 smbios_entries = qemu_mallocz(smbios_entries_len);
109 }
110 smbios_entries = qemu_realloc(smbios_entries, smbios_entries_len +
111 sizeof(*field) + len);
112 field = (struct smbios_field *)(smbios_entries + smbios_entries_len);
113 field->header.type = SMBIOS_FIELD_ENTRY;
114 field->header.length = cpu_to_le16(sizeof(*field) + len);
115
116 field->type = type;
117 field->offset = cpu_to_le16(offset);
118 memcpy(field->data, data, len);
119
120 smbios_entries_len += sizeof(*field) + len;
121 (*(uint16_t *)smbios_entries) =
122 cpu_to_le16(le16_to_cpu(*(uint16_t *)smbios_entries) + 1);
123}
124
125static void smbios_build_type_0_fields(const char *t)
126{
127 char buf[1024];
128
129 if (get_param_value(buf, sizeof(buf), "vendor", t))
130 smbios_add_field(0, offsetof(struct smbios_type_0, vendor_str),
131 strlen(buf) + 1, buf);
132 if (get_param_value(buf, sizeof(buf), "version", t))
133 smbios_add_field(0, offsetof(struct smbios_type_0, bios_version_str),
134 strlen(buf) + 1, buf);
135 if (get_param_value(buf, sizeof(buf), "date", t))
136 smbios_add_field(0, offsetof(struct smbios_type_0,
137 bios_release_date_str),
138 strlen(buf) + 1, buf);
139 if (get_param_value(buf, sizeof(buf), "release", t)) {
140 int major, minor;
141 sscanf(buf, "%d.%d", &major, &minor);
142 smbios_add_field(0, offsetof(struct smbios_type_0,
143 system_bios_major_release), 1, &major);
144 smbios_add_field(0, offsetof(struct smbios_type_0,
145 system_bios_minor_release), 1, &minor);
146 }
147}
148
149static void smbios_build_type_1_fields(const char *t)
150{
151 char buf[1024];
152
153 if (get_param_value(buf, sizeof(buf), "manufacturer", t))
154 smbios_add_field(1, offsetof(struct smbios_type_1, manufacturer_str),
155 strlen(buf) + 1, buf);
156 if (get_param_value(buf, sizeof(buf), "product", t))
157 smbios_add_field(1, offsetof(struct smbios_type_1, product_name_str),
158 strlen(buf) + 1, buf);
159 if (get_param_value(buf, sizeof(buf), "version", t))
160 smbios_add_field(1, offsetof(struct smbios_type_1, version_str),
161 strlen(buf) + 1, buf);
162 if (get_param_value(buf, sizeof(buf), "serial", t))
163 smbios_add_field(1, offsetof(struct smbios_type_1, serial_number_str),
164 strlen(buf) + 1, buf);
165 if (get_param_value(buf, sizeof(buf), "uuid", t)) {
166 if (qemu_uuid_parse(buf, qemu_uuid) != 0) {
167 fprintf(stderr, "Invalid SMBIOS UUID string\n");
168 exit(1);
169 }
170 }
171 if (get_param_value(buf, sizeof(buf), "sku", t))
172 smbios_add_field(1, offsetof(struct smbios_type_1, sku_number_str),
173 strlen(buf) + 1, buf);
174 if (get_param_value(buf, sizeof(buf), "family", t))
175 smbios_add_field(1, offsetof(struct smbios_type_1, family_str),
176 strlen(buf) + 1, buf);
177}
178
179int smbios_entry_add(const char *t)
180{
181 char buf[1024];
182
183 if (get_param_value(buf, sizeof(buf), "file", t)) {
184 struct smbios_structure_header *header;
185 struct smbios_table *table;
186 int size = get_image_size(buf);
187
188 if (size == -1 || size < sizeof(struct smbios_structure_header)) {
189 fprintf(stderr, "Cannot read smbios file %s\n", buf);
190 exit(1);
191 }
192
193 if (!smbios_entries) {
194 smbios_entries_len = sizeof(uint16_t);
195 smbios_entries = qemu_mallocz(smbios_entries_len);
196 }
197
198 smbios_entries = qemu_realloc(smbios_entries, smbios_entries_len +
199 sizeof(*table) + size);
200 table = (struct smbios_table *)(smbios_entries + smbios_entries_len);
201 table->header.type = SMBIOS_TABLE_ENTRY;
202 table->header.length = cpu_to_le16(sizeof(*table) + size);
203
204 if (load_image(buf, table->data) != size) {
205 fprintf(stderr, "Failed to load smbios file %s", buf);
206 exit(1);
207 }
208
209 header = (struct smbios_structure_header *)(table->data);
210 smbios_check_collision(header->type, SMBIOS_TABLE_ENTRY);
211 if (header->type == 4) {
212 smbios_type4_count++;
213 }
214
215 smbios_entries_len += sizeof(*table) + size;
216 (*(uint16_t *)smbios_entries) =
217 cpu_to_le16(le16_to_cpu(*(uint16_t *)smbios_entries) + 1);
218 return 0;
219 }
220
221 if (get_param_value(buf, sizeof(buf), "type", t)) {
222 unsigned long type = strtoul(buf, NULL, 0);
223 switch (type) {
224 case 0:
225 smbios_build_type_0_fields(t);
226 return 0;
227 case 1:
228 smbios_build_type_1_fields(t);
229 return 0;
230 default:
231 fprintf(stderr, "Don't know how to build fields for SMBIOS type "
232 "%ld\n", type);
233 exit(1);
234 }
235 }
236
237 fprintf(stderr, "smbios: must specify type= or file=\n");
238 return -1;
239}
240