1 /*
2 * QEMU Boot Device Implement
3 *
4 * Copyright (c) 2014 HUAWEI TECHNOLOGIES CO., LTD.
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
23 */
24
25 #include "qemu/osdep.h"
26 #include "qapi/error.h"
27 #include "sysemu/sysemu.h"
28 #include "qapi/visitor.h"
29 #include "qemu/error-report.h"
30 #include "sysemu/reset.h"
31 #include "hw/qdev-core.h"
32 #include "hw/boards.h"
33
34 typedef struct FWBootEntry FWBootEntry;
35
36 struct FWBootEntry {
37 QTAILQ_ENTRY(FWBootEntry) link;
38 int32_t bootindex;
39 DeviceState *dev;
40 char *suffix;
41 };
42
43 static QTAILQ_HEAD(, FWBootEntry) fw_boot_order =
44 QTAILQ_HEAD_INITIALIZER(fw_boot_order);
45 static QEMUBootSetHandler *boot_set_handler;
46 static void *boot_set_opaque;
47
qemu_register_boot_set(QEMUBootSetHandler * func,void * opaque)48 void qemu_register_boot_set(QEMUBootSetHandler *func, void *opaque)
49 {
50 boot_set_handler = func;
51 boot_set_opaque = opaque;
52 }
53
qemu_boot_set(const char * boot_order,Error ** errp)54 void qemu_boot_set(const char *boot_order, Error **errp)
55 {
56 Error *local_err = NULL;
57
58 if (!boot_set_handler) {
59 error_setg(errp, "no function defined to set boot device list for"
60 " this architecture");
61 return;
62 }
63
64 validate_bootdevices(boot_order, &local_err);
65 if (local_err) {
66 error_propagate(errp, local_err);
67 return;
68 }
69
70 boot_set_handler(boot_set_opaque, boot_order, errp);
71 }
72
validate_bootdevices(const char * devices,Error ** errp)73 void validate_bootdevices(const char *devices, Error **errp)
74 {
75 /* We just do some generic consistency checks */
76 const char *p;
77 int bitmap = 0;
78
79 for (p = devices; *p != '\0'; p++) {
80 /* Allowed boot devices are:
81 * a-b: floppy disk drives
82 * c-f: IDE disk drives
83 * g-m: machine implementation dependent drives
84 * n-p: network devices
85 * It's up to each machine implementation to check if the given boot
86 * devices match the actual hardware implementation and firmware
87 * features.
88 */
89 if (*p < 'a' || *p > 'p') {
90 error_setg(errp, "Invalid boot device '%c'", *p);
91 return;
92 }
93 if (bitmap & (1 << (*p - 'a'))) {
94 error_setg(errp, "Boot device '%c' was given twice", *p);
95 return;
96 }
97 bitmap |= 1 << (*p - 'a');
98 }
99 }
100
restore_boot_order(void * opaque)101 void restore_boot_order(void *opaque)
102 {
103 char *normal_boot_order = opaque;
104 static int first = 1;
105
106 /* Restore boot order and remove ourselves after the first boot */
107 if (first) {
108 first = 0;
109 return;
110 }
111
112 if (boot_set_handler) {
113 qemu_boot_set(normal_boot_order, &error_abort);
114 }
115
116 qemu_unregister_reset(restore_boot_order, normal_boot_order);
117 g_free(normal_boot_order);
118 }
119
check_boot_index(int32_t bootindex,Error ** errp)120 void check_boot_index(int32_t bootindex, Error **errp)
121 {
122 FWBootEntry *i;
123
124 if (bootindex >= 0) {
125 QTAILQ_FOREACH(i, &fw_boot_order, link) {
126 if (i->bootindex == bootindex) {
127 error_setg(errp, "The bootindex %d has already been used",
128 bootindex);
129 return;
130 }
131 }
132 }
133 }
134
del_boot_device_path(DeviceState * dev,const char * suffix)135 void del_boot_device_path(DeviceState *dev, const char *suffix)
136 {
137 FWBootEntry *i;
138
139 if (dev == NULL) {
140 return;
141 }
142
143 QTAILQ_FOREACH(i, &fw_boot_order, link) {
144 if ((!suffix || !g_strcmp0(i->suffix, suffix)) &&
145 i->dev == dev) {
146 QTAILQ_REMOVE(&fw_boot_order, i, link);
147 g_free(i->suffix);
148 g_free(i);
149
150 break;
151 }
152 }
153 }
154
add_boot_device_path(int32_t bootindex,DeviceState * dev,const char * suffix)155 void add_boot_device_path(int32_t bootindex, DeviceState *dev,
156 const char *suffix)
157 {
158 FWBootEntry *node, *i;
159
160 if (bootindex < 0) {
161 del_boot_device_path(dev, suffix);
162 return;
163 }
164
165 assert(dev != NULL || suffix != NULL);
166
167 del_boot_device_path(dev, suffix);
168
169 node = g_malloc0(sizeof(FWBootEntry));
170 node->bootindex = bootindex;
171 node->suffix = g_strdup(suffix);
172 node->dev = dev;
173
174 QTAILQ_FOREACH(i, &fw_boot_order, link) {
175 if (i->bootindex == bootindex) {
176 error_report("Two devices with same boot index %d", bootindex);
177 exit(1);
178 } else if (i->bootindex < bootindex) {
179 continue;
180 }
181 QTAILQ_INSERT_BEFORE(i, node, link);
182 return;
183 }
184 QTAILQ_INSERT_TAIL(&fw_boot_order, node, link);
185 }
186
get_boot_device(uint32_t position)187 DeviceState *get_boot_device(uint32_t position)
188 {
189 uint32_t counter = 0;
190 FWBootEntry *i = NULL;
191 DeviceState *res = NULL;
192
193 if (!QTAILQ_EMPTY(&fw_boot_order)) {
194 QTAILQ_FOREACH(i, &fw_boot_order, link) {
195 if (counter == position) {
196 res = i->dev;
197 break;
198 }
199 counter++;
200 }
201 }
202 return res;
203 }
204
get_boot_device_path(DeviceState * dev,bool ignore_suffixes,const char * suffix)205 static char *get_boot_device_path(DeviceState *dev, bool ignore_suffixes,
206 const char *suffix)
207 {
208 char *devpath = NULL, *s = NULL, *d, *bootpath;
209
210 if (dev) {
211 devpath = qdev_get_fw_dev_path(dev);
212 assert(devpath);
213 }
214
215 if (!ignore_suffixes) {
216 if (dev) {
217 d = qdev_get_own_fw_dev_path_from_handler(dev->parent_bus, dev);
218 if (d) {
219 assert(!suffix);
220 s = d;
221 } else {
222 s = g_strdup(suffix);
223 }
224 } else {
225 s = g_strdup(suffix);
226 }
227 }
228
229 bootpath = g_strdup_printf("%s%s",
230 devpath ? devpath : "",
231 s ? s : "");
232 g_free(devpath);
233 g_free(s);
234
235 return bootpath;
236 }
237
238 /*
239 * This function returns null terminated string that consist of new line
240 * separated device paths.
241 *
242 * memory pointed by "size" is assigned total length of the array in bytes
243 *
244 */
get_boot_devices_list(size_t * size)245 char *get_boot_devices_list(size_t *size)
246 {
247 FWBootEntry *i;
248 size_t total = 0;
249 char *list = NULL;
250 MachineClass *mc = MACHINE_GET_CLASS(qdev_get_machine());
251 bool ignore_suffixes = mc->ignore_boot_device_suffixes;
252
253 QTAILQ_FOREACH(i, &fw_boot_order, link) {
254 char *bootpath;
255 size_t len;
256
257 bootpath = get_boot_device_path(i->dev, ignore_suffixes, i->suffix);
258
259 if (total) {
260 list[total-1] = '\n';
261 }
262 len = strlen(bootpath) + 1;
263 list = g_realloc(list, total + len);
264 memcpy(&list[total], bootpath, len);
265 total += len;
266 g_free(bootpath);
267 }
268
269 *size = total;
270
271 if (boot_strict && *size > 0) {
272 list[total-1] = '\n';
273 list = g_realloc(list, total + 5);
274 memcpy(&list[total], "HALT", 5);
275 *size = total + 5;
276 }
277 return list;
278 }
279
280 typedef struct {
281 int32_t *bootindex;
282 const char *suffix;
283 DeviceState *dev;
284 } BootIndexProperty;
285
device_get_bootindex(Object * obj,Visitor * v,const char * name,void * opaque,Error ** errp)286 static void device_get_bootindex(Object *obj, Visitor *v, const char *name,
287 void *opaque, Error **errp)
288 {
289 BootIndexProperty *prop = opaque;
290 visit_type_int32(v, name, prop->bootindex, errp);
291 }
292
device_set_bootindex(Object * obj,Visitor * v,const char * name,void * opaque,Error ** errp)293 static void device_set_bootindex(Object *obj, Visitor *v, const char *name,
294 void *opaque, Error **errp)
295 {
296 BootIndexProperty *prop = opaque;
297 int32_t boot_index;
298 Error *local_err = NULL;
299
300 visit_type_int32(v, name, &boot_index, &local_err);
301 if (local_err) {
302 goto out;
303 }
304 /* check whether bootindex is present in fw_boot_order list */
305 check_boot_index(boot_index, &local_err);
306 if (local_err) {
307 goto out;
308 }
309 /* change bootindex to a new one */
310 *prop->bootindex = boot_index;
311
312 add_boot_device_path(*prop->bootindex, prop->dev, prop->suffix);
313
314 out:
315 error_propagate(errp, local_err);
316 }
317
property_release_bootindex(Object * obj,const char * name,void * opaque)318 static void property_release_bootindex(Object *obj, const char *name,
319 void *opaque)
320
321 {
322 BootIndexProperty *prop = opaque;
323
324 del_boot_device_path(prop->dev, prop->suffix);
325 g_free(prop);
326 }
327
device_add_bootindex_property(Object * obj,int32_t * bootindex,const char * name,const char * suffix,DeviceState * dev,Error ** errp)328 void device_add_bootindex_property(Object *obj, int32_t *bootindex,
329 const char *name, const char *suffix,
330 DeviceState *dev, Error **errp)
331 {
332 Error *local_err = NULL;
333 BootIndexProperty *prop = g_malloc0(sizeof(*prop));
334
335 prop->bootindex = bootindex;
336 prop->suffix = suffix;
337 prop->dev = dev;
338
339 object_property_add(obj, name, "int32",
340 device_get_bootindex,
341 device_set_bootindex,
342 property_release_bootindex,
343 prop, &local_err);
344
345 if (local_err) {
346 error_propagate(errp, local_err);
347 g_free(prop);
348 return;
349 }
350 /* initialize devices' bootindex property to -1 */
351 object_property_set_int(obj, -1, name, NULL);
352 }
353
354 typedef struct FWLCHSEntry FWLCHSEntry;
355
356 struct FWLCHSEntry {
357 QTAILQ_ENTRY(FWLCHSEntry) link;
358 DeviceState *dev;
359 char *suffix;
360 uint32_t lcyls;
361 uint32_t lheads;
362 uint32_t lsecs;
363 };
364
365 static QTAILQ_HEAD(, FWLCHSEntry) fw_lchs =
366 QTAILQ_HEAD_INITIALIZER(fw_lchs);
367
add_boot_device_lchs(DeviceState * dev,const char * suffix,uint32_t lcyls,uint32_t lheads,uint32_t lsecs)368 void add_boot_device_lchs(DeviceState *dev, const char *suffix,
369 uint32_t lcyls, uint32_t lheads, uint32_t lsecs)
370 {
371 FWLCHSEntry *node;
372
373 if (!lcyls && !lheads && !lsecs) {
374 return;
375 }
376
377 assert(dev != NULL || suffix != NULL);
378
379 node = g_malloc0(sizeof(FWLCHSEntry));
380 node->suffix = g_strdup(suffix);
381 node->dev = dev;
382 node->lcyls = lcyls;
383 node->lheads = lheads;
384 node->lsecs = lsecs;
385
386 QTAILQ_INSERT_TAIL(&fw_lchs, node, link);
387 }
388
del_boot_device_lchs(DeviceState * dev,const char * suffix)389 void del_boot_device_lchs(DeviceState *dev, const char *suffix)
390 {
391 FWLCHSEntry *i;
392
393 if (dev == NULL) {
394 return;
395 }
396
397 QTAILQ_FOREACH(i, &fw_lchs, link) {
398 if ((!suffix || !g_strcmp0(i->suffix, suffix)) &&
399 i->dev == dev) {
400 QTAILQ_REMOVE(&fw_lchs, i, link);
401 g_free(i->suffix);
402 g_free(i);
403
404 break;
405 }
406 }
407 }
408
get_boot_devices_lchs_list(size_t * size)409 char *get_boot_devices_lchs_list(size_t *size)
410 {
411 FWLCHSEntry *i;
412 size_t total = 0;
413 char *list = NULL;
414
415 QTAILQ_FOREACH(i, &fw_lchs, link) {
416 char *bootpath;
417 char *chs_string;
418 size_t len;
419
420 bootpath = get_boot_device_path(i->dev, false, i->suffix);
421 chs_string = g_strdup_printf("%s %" PRIu32 " %" PRIu32 " %" PRIu32,
422 bootpath, i->lcyls, i->lheads, i->lsecs);
423
424 if (total) {
425 list[total - 1] = '\n';
426 }
427 len = strlen(chs_string) + 1;
428 list = g_realloc(list, total + len);
429 memcpy(&list[total], chs_string, len);
430 total += len;
431 g_free(chs_string);
432 g_free(bootpath);
433 }
434
435 *size = total;
436
437 return list;
438 }
439