bootindex: rework add_boot_device_path function
[qemu/ar7.git] / bootdevice.c
blobaac0ffbcefcb2788b1f4caeeebb215ad550b1c52
1 /*
2 * QEMU Boot Device Implement
4 * Copyright (c) 2014 HUAWEI TECHNOLOGIES CO.,LTD.
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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.
25 #include "sysemu/sysemu.h"
27 typedef struct FWBootEntry FWBootEntry;
29 struct FWBootEntry {
30 QTAILQ_ENTRY(FWBootEntry) link;
31 int32_t bootindex;
32 DeviceState *dev;
33 char *suffix;
36 static QTAILQ_HEAD(, FWBootEntry) fw_boot_order =
37 QTAILQ_HEAD_INITIALIZER(fw_boot_order);
39 void check_boot_index(int32_t bootindex, Error **errp)
41 FWBootEntry *i;
43 if (bootindex >= 0) {
44 QTAILQ_FOREACH(i, &fw_boot_order, link) {
45 if (i->bootindex == bootindex) {
46 error_setg(errp, "The bootindex %d has already been used",
47 bootindex);
48 return;
54 void del_boot_device_path(DeviceState *dev, const char *suffix)
56 FWBootEntry *i;
58 if (dev == NULL) {
59 return;
62 QTAILQ_FOREACH(i, &fw_boot_order, link) {
63 if ((!suffix || !g_strcmp0(i->suffix, suffix)) &&
64 i->dev == dev) {
65 QTAILQ_REMOVE(&fw_boot_order, i, link);
66 g_free(i->suffix);
67 g_free(i);
69 break;
74 void add_boot_device_path(int32_t bootindex, DeviceState *dev,
75 const char *suffix)
77 FWBootEntry *node, *i;
79 if (bootindex < 0) {
80 return;
83 assert(dev != NULL || suffix != NULL);
85 del_boot_device_path(dev, suffix);
87 node = g_malloc0(sizeof(FWBootEntry));
88 node->bootindex = bootindex;
89 node->suffix = g_strdup(suffix);
90 node->dev = dev;
92 QTAILQ_FOREACH(i, &fw_boot_order, link) {
93 if (i->bootindex == bootindex) {
94 fprintf(stderr, "Two devices with same boot index %d\n", bootindex);
95 exit(1);
96 } else if (i->bootindex < bootindex) {
97 continue;
99 QTAILQ_INSERT_BEFORE(i, node, link);
100 return;
102 QTAILQ_INSERT_TAIL(&fw_boot_order, node, link);
105 DeviceState *get_boot_device(uint32_t position)
107 uint32_t counter = 0;
108 FWBootEntry *i = NULL;
109 DeviceState *res = NULL;
111 if (!QTAILQ_EMPTY(&fw_boot_order)) {
112 QTAILQ_FOREACH(i, &fw_boot_order, link) {
113 if (counter == position) {
114 res = i->dev;
115 break;
117 counter++;
120 return res;
124 * This function returns null terminated string that consist of new line
125 * separated device paths.
127 * memory pointed by "size" is assigned total length of the array in bytes
130 char *get_boot_devices_list(size_t *size, bool ignore_suffixes)
132 FWBootEntry *i;
133 size_t total = 0;
134 char *list = NULL;
136 QTAILQ_FOREACH(i, &fw_boot_order, link) {
137 char *devpath = NULL, *bootpath;
138 size_t len;
140 if (i->dev) {
141 devpath = qdev_get_fw_dev_path(i->dev);
142 assert(devpath);
145 if (i->suffix && !ignore_suffixes && devpath) {
146 size_t bootpathlen = strlen(devpath) + strlen(i->suffix) + 1;
148 bootpath = g_malloc(bootpathlen);
149 snprintf(bootpath, bootpathlen, "%s%s", devpath, i->suffix);
150 g_free(devpath);
151 } else if (devpath) {
152 bootpath = devpath;
153 } else if (!ignore_suffixes) {
154 assert(i->suffix);
155 bootpath = g_strdup(i->suffix);
156 } else {
157 bootpath = g_strdup("");
160 if (total) {
161 list[total-1] = '\n';
163 len = strlen(bootpath) + 1;
164 list = g_realloc(list, total + len);
165 memcpy(&list[total], bootpath, len);
166 total += len;
167 g_free(bootpath);
170 *size = total;
172 if (boot_strict && *size > 0) {
173 list[total-1] = '\n';
174 list = g_realloc(list, total + 5);
175 memcpy(&list[total], "HALT", 5);
176 *size = total + 5;
178 return list;