Patrick Georgi | afd4c87 | 2020-05-05 23:43:18 +0200 | [diff] [blame] | 1 | /* Taken from depthcharge: src/boot/fit.c */ |
Patrick Georgi | ac95903 | 2020-05-05 22:49:26 +0200 | [diff] [blame] | 2 | /* SPDX-License-Identifier: GPL-2.0-or-later */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 3 | |
| 4 | #include <assert.h> |
Elyes HAOUAS | 351e3e5 | 2019-04-05 18:11:19 +0200 | [diff] [blame] | 5 | #include <console/console.h> |
Joel Kitching | 393c71c | 2019-06-16 16:09:42 +0800 | [diff] [blame] | 6 | #include <ctype.h> |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 7 | #include <endian.h> |
Kyösti Mälkki | b78e462 | 2022-12-15 22:12:29 +0200 | [diff] [blame] | 8 | #include <identity.h> |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 9 | #include <bootmem.h> |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 10 | #include <string.h> |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 11 | #include <program_loading.h> |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 12 | #include <memrange.h> |
| 13 | #include <fit.h> |
| 14 | #include <boardid.h> |
Maximilian Brune | b3e336c | 2023-09-16 19:49:39 +0200 | [diff] [blame] | 15 | #include <stdlib.h> |
Elyes HAOUAS | 93a195c | 2021-12-31 18:46:13 +0100 | [diff] [blame] | 16 | #include <types.h> |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 17 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 18 | static struct list_node image_nodes; |
| 19 | static struct list_node config_nodes; |
| 20 | static struct list_node compat_strings; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 21 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 22 | struct compat_string_entry { |
| 23 | const char *compat_string; |
| 24 | struct list_node list_node; |
| 25 | }; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 26 | |
Jonathan Neuschäfer | bbaae95 | 2018-12-12 01:12:13 +0100 | [diff] [blame] | 27 | /* Convert string to lowercase and replace '_' and spaces with '-'. */ |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 28 | static char *clean_compat_string(char *str) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 29 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 30 | for (size_t i = 0; i < strlen(str); i++) { |
| 31 | str[i] = tolower(str[i]); |
Jonathan Neuschäfer | bbaae95 | 2018-12-12 01:12:13 +0100 | [diff] [blame] | 32 | if (str[i] == '_' || str[i] == ' ') |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 33 | str[i] = '-'; |
| 34 | } |
| 35 | |
| 36 | return str; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 37 | } |
| 38 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 39 | static void fit_add_default_compat_strings(void) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 40 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 41 | char compat_string[80] = {}; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 42 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 43 | if ((board_id() != UNDEFINED_STRAPPING_ID) && |
| 44 | (sku_id() != UNDEFINED_STRAPPING_ID)) { |
| 45 | snprintf(compat_string, sizeof(compat_string), |
Kyösti Mälkki | b78e462 | 2022-12-15 22:12:29 +0200 | [diff] [blame] | 46 | "%s,%s-rev%u-sku%u", mainboard_vendor, mainboard_part_number, |
| 47 | board_id(), sku_id()); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 48 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 49 | fit_add_compat_string(compat_string); |
| 50 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 51 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 52 | if (board_id() != UNDEFINED_STRAPPING_ID) { |
| 53 | snprintf(compat_string, sizeof(compat_string), "%s,%s-rev%u", |
Kyösti Mälkki | b78e462 | 2022-12-15 22:12:29 +0200 | [diff] [blame] | 54 | mainboard_vendor, mainboard_part_number, board_id()); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 55 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 56 | fit_add_compat_string(compat_string); |
| 57 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 58 | |
Julius Werner | 11217de | 2020-05-21 10:39:58 -0700 | [diff] [blame] | 59 | if (sku_id() != UNDEFINED_STRAPPING_ID) { |
| 60 | snprintf(compat_string, sizeof(compat_string), "%s,%s-sku%u", |
Kyösti Mälkki | b78e462 | 2022-12-15 22:12:29 +0200 | [diff] [blame] | 61 | mainboard_vendor, mainboard_part_number, sku_id()); |
Julius Werner | 11217de | 2020-05-21 10:39:58 -0700 | [diff] [blame] | 62 | |
| 63 | fit_add_compat_string(compat_string); |
| 64 | } |
| 65 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 66 | snprintf(compat_string, sizeof(compat_string), "%s,%s", |
Kyösti Mälkki | b78e462 | 2022-12-15 22:12:29 +0200 | [diff] [blame] | 67 | mainboard_vendor, mainboard_part_number); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 68 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 69 | fit_add_compat_string(compat_string); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 70 | } |
| 71 | |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 72 | static struct fit_image_node *find_image(const char *name) |
| 73 | { |
| 74 | struct fit_image_node *image; |
| 75 | list_for_each(image, image_nodes, list_node) { |
| 76 | if (!strcmp(image->name, name)) |
| 77 | return image; |
| 78 | } |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 79 | printk(BIOS_ERR, "Cannot find image node %s!\n", name); |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 80 | return NULL; |
| 81 | } |
| 82 | |
Julius Werner | 21b0b1a | 2019-05-16 16:12:04 -0700 | [diff] [blame] | 83 | static struct fit_image_node *find_image_with_overlays(const char *name, |
| 84 | int bytes, struct list_node *prev) |
| 85 | { |
| 86 | struct fit_image_node *base = find_image(name); |
| 87 | if (!base) |
| 88 | return NULL; |
| 89 | |
| 90 | int len = strnlen(name, bytes) + 1; |
| 91 | bytes -= len; |
| 92 | name += len; |
| 93 | while (bytes > 0) { |
| 94 | struct fit_overlay_chain *next = xzalloc(sizeof(*next)); |
| 95 | next->overlay = find_image(name); |
| 96 | if (!next->overlay) |
| 97 | return NULL; |
| 98 | list_insert_after(&next->list_node, prev); |
| 99 | prev = &next->list_node; |
| 100 | len = strnlen(name, bytes) + 1; |
| 101 | bytes -= len; |
| 102 | name += len; |
| 103 | } |
| 104 | |
| 105 | return base; |
| 106 | } |
| 107 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 108 | static void image_node(struct device_tree_node *node) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 109 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 110 | struct fit_image_node *image = xzalloc(sizeof(*image)); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 111 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 112 | image->compression = CBFS_COMPRESS_NONE; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 113 | image->name = node->name; |
| 114 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 115 | struct device_tree_property *prop; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 116 | list_for_each(prop, node->properties, list_node) { |
| 117 | if (!strcmp("data", prop->prop.name)) { |
| 118 | image->data = prop->prop.data; |
| 119 | image->size = prop->prop.size; |
| 120 | } else if (!strcmp("compression", prop->prop.name)) { |
| 121 | if (!strcmp("none", prop->prop.data)) |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 122 | image->compression = CBFS_COMPRESS_NONE; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 123 | else if (!strcmp("lzma", prop->prop.data)) |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 124 | image->compression = CBFS_COMPRESS_LZMA; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 125 | else if (!strcmp("lz4", prop->prop.data)) |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 126 | image->compression = CBFS_COMPRESS_LZ4; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 127 | else |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 128 | image->compression = -1; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 129 | } |
| 130 | } |
| 131 | |
| 132 | list_insert_after(&image->list_node, &image_nodes); |
| 133 | } |
| 134 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 135 | static void config_node(struct device_tree_node *node) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 136 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 137 | struct fit_config_node *config = xzalloc(sizeof(*config)); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 138 | config->name = node->name; |
| 139 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 140 | struct device_tree_property *prop; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 141 | list_for_each(prop, node->properties, list_node) { |
| 142 | if (!strcmp("kernel", prop->prop.name)) |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 143 | config->kernel = find_image(prop->prop.data); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 144 | else if (!strcmp("fdt", prop->prop.name)) |
Julius Werner | 21b0b1a | 2019-05-16 16:12:04 -0700 | [diff] [blame] | 145 | config->fdt = find_image_with_overlays(prop->prop.data, |
| 146 | prop->prop.size, &config->overlays); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 147 | else if (!strcmp("ramdisk", prop->prop.name)) |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 148 | config->ramdisk = find_image(prop->prop.data); |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 149 | else if (!strcmp("compatible", prop->prop.name)) |
| 150 | config->compat = prop->prop; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 151 | } |
| 152 | |
| 153 | list_insert_after(&config->list_node, &config_nodes); |
| 154 | } |
| 155 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 156 | static void fit_unpack(struct device_tree *tree, const char **default_config) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 157 | { |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 158 | struct device_tree_node *child; |
| 159 | struct device_tree_node *images = dt_find_node_by_path(tree, "/images", |
| 160 | NULL, NULL, 0); |
| 161 | if (images) |
| 162 | list_for_each(child, images->children, list_node) |
| 163 | image_node(child); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 164 | |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 165 | struct device_tree_node *configs = dt_find_node_by_path(tree, |
| 166 | "/configurations", NULL, NULL, 0); |
| 167 | if (configs) { |
| 168 | *default_config = dt_find_string_prop(configs, "default"); |
| 169 | list_for_each(child, configs->children, list_node) |
| 170 | config_node(child); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 171 | } |
| 172 | } |
| 173 | |
Patrick Rudolph | 0a7d690 | 2018-08-22 09:55:15 +0200 | [diff] [blame] | 174 | static int fdt_find_compat(const void *blob, uint32_t start_offset, |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 175 | struct fdt_property *prop) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 176 | { |
| 177 | int offset = start_offset; |
| 178 | int size; |
| 179 | |
| 180 | size = fdt_node_name(blob, offset, NULL); |
| 181 | if (!size) |
| 182 | return -1; |
| 183 | offset += size; |
| 184 | |
| 185 | while ((size = fdt_next_property(blob, offset, prop))) { |
| 186 | if (!strcmp("compatible", prop->name)) |
| 187 | return 0; |
| 188 | |
| 189 | offset += size; |
| 190 | } |
| 191 | |
| 192 | prop->name = NULL; |
| 193 | return -1; |
| 194 | } |
| 195 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 196 | static int fit_check_compat(struct fdt_property *compat_prop, |
| 197 | const char *compat_name) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 198 | { |
| 199 | int bytes = compat_prop->size; |
| 200 | const char *compat_str = compat_prop->data; |
| 201 | |
| 202 | for (int pos = 0; bytes && compat_str[0]; pos++) { |
| 203 | if (!strncmp(compat_str, compat_name, bytes)) |
| 204 | return pos; |
| 205 | int len = strlen(compat_str) + 1; |
| 206 | compat_str += len; |
| 207 | bytes -= len; |
| 208 | } |
| 209 | return -1; |
| 210 | } |
| 211 | |
Patrick Rudolph | 0a7d690 | 2018-08-22 09:55:15 +0200 | [diff] [blame] | 212 | void fit_update_chosen(struct device_tree *tree, const char *cmd_line) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 213 | { |
| 214 | const char *path[] = { "chosen", NULL }; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 215 | struct device_tree_node *node; |
| 216 | node = dt_find_node(tree->root, path, NULL, NULL, 1); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 217 | |
| 218 | dt_add_string_prop(node, "bootargs", cmd_line); |
| 219 | } |
| 220 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 221 | void fit_add_ramdisk(struct device_tree *tree, void *ramdisk_addr, |
| 222 | size_t ramdisk_size) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 223 | { |
| 224 | const char *path[] = { "chosen", NULL }; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 225 | struct device_tree_node *node; |
| 226 | node = dt_find_node(tree->root, path, NULL, NULL, 1); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 227 | |
Patrick Rudolph | 3fca4ed | 2018-08-10 10:12:35 +0200 | [diff] [blame] | 228 | u64 start = (uintptr_t)ramdisk_addr; |
| 229 | u64 end = start + ramdisk_size; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 230 | |
Patrick Rudolph | 3fca4ed | 2018-08-10 10:12:35 +0200 | [diff] [blame] | 231 | dt_add_u64_prop(node, "linux,initrd-start", start); |
| 232 | dt_add_u64_prop(node, "linux,initrd-end", end); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 233 | } |
| 234 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 235 | static void update_reserve_map(uint64_t start, uint64_t end, |
| 236 | struct device_tree *tree) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 237 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 238 | struct device_tree_reserve_map_entry *entry = xzalloc(sizeof(*entry)); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 239 | |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 240 | entry->start = start; |
| 241 | entry->size = end - start; |
| 242 | |
| 243 | list_insert_after(&entry->list_node, &tree->reserve_map); |
| 244 | } |
| 245 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 246 | struct entry_params { |
Martin Roth | 38ddbfb | 2019-10-23 21:41:00 -0600 | [diff] [blame] | 247 | unsigned int addr_cells; |
| 248 | unsigned int size_cells; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 249 | void *data; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 250 | }; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 251 | |
Martin Roth | 38ddbfb | 2019-10-23 21:41:00 -0600 | [diff] [blame] | 252 | static uint64_t max_range(unsigned int size_cells) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 253 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 254 | /* |
| 255 | * Split up ranges who's sizes are too large to fit in #size-cells. |
| 256 | * The largest value we can store isn't a power of two, so we'll round |
| 257 | * down to make the math easier. |
| 258 | */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 259 | return 0x1ULL << (size_cells * 32 - 1); |
| 260 | } |
| 261 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 262 | static void update_mem_property(u64 start, u64 end, struct entry_params *params) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 263 | { |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 264 | u8 *data = (u8 *)params->data; |
| 265 | u64 full_size = end - start; |
| 266 | while (full_size) { |
| 267 | const u64 max_size = max_range(params->size_cells); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 268 | const u64 size = MIN(max_size, full_size); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 269 | |
| 270 | dt_write_int(data, start, params->addr_cells * sizeof(u32)); |
| 271 | data += params->addr_cells * sizeof(uint32_t); |
| 272 | start += size; |
| 273 | |
| 274 | dt_write_int(data, size, params->size_cells * sizeof(u32)); |
| 275 | data += params->size_cells * sizeof(uint32_t); |
| 276 | full_size -= size; |
| 277 | } |
| 278 | params->data = data; |
| 279 | } |
| 280 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 281 | struct mem_map { |
| 282 | struct memranges mem; |
| 283 | struct memranges reserved; |
| 284 | }; |
| 285 | |
| 286 | static bool walk_memory_table(const struct range_entry *r, void *arg) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 287 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 288 | struct mem_map *arg_map = arg; |
Arthur Heymans | 1793eb4 | 2022-07-01 15:45:56 +0200 | [diff] [blame] | 289 | struct memranges *ranges; |
| 290 | enum bootmem_type tag; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 291 | |
Arthur Heymans | 1793eb4 | 2022-07-01 15:45:56 +0200 | [diff] [blame] | 292 | ranges = range_entry_tag(r) == BM_MEM_RAM ? &arg_map->mem : &arg_map->reserved; |
| 293 | tag = range_entry_tag(r) == BM_MEM_RAM ? BM_MEM_RAM : BM_MEM_RESERVED; |
| 294 | memranges_insert(ranges, range_entry_base(r), range_entry_size(r), tag); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 295 | return true; |
| 296 | } |
| 297 | |
| 298 | void fit_add_compat_string(const char *str) |
| 299 | { |
| 300 | struct compat_string_entry *compat_node; |
| 301 | |
| 302 | compat_node = xzalloc(sizeof(*compat_node)); |
| 303 | compat_node->compat_string = strdup(str); |
| 304 | |
| 305 | clean_compat_string((char *)compat_node->compat_string); |
| 306 | |
| 307 | list_insert_after(&compat_node->list_node, &compat_strings); |
| 308 | } |
| 309 | |
| 310 | void fit_update_memory(struct device_tree *tree) |
| 311 | { |
| 312 | const struct range_entry *r; |
| 313 | struct device_tree_node *node; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 314 | u32 addr_cells = 1, size_cells = 1; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 315 | struct mem_map map; |
| 316 | |
| 317 | printk(BIOS_INFO, "FIT: Updating devicetree memory entries\n"); |
| 318 | |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 319 | dt_read_cell_props(tree->root, &addr_cells, &size_cells); |
| 320 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 321 | /* |
| 322 | * First remove all existing device_type="memory" nodes, then add ours. |
| 323 | */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 324 | list_for_each(node, tree->root->children, list_node) { |
| 325 | const char *devtype = dt_find_string_prop(node, "device_type"); |
| 326 | if (devtype && !strcmp(devtype, "memory")) |
| 327 | list_remove(&node->list_node); |
| 328 | } |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 329 | |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 330 | node = xzalloc(sizeof(*node)); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 331 | |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 332 | node->name = "memory"; |
| 333 | list_insert_after(&node->list_node, &tree->root->children); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 334 | dt_add_string_prop(node, "device_type", (char *)"memory"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 335 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 336 | memranges_init_empty(&map.mem, NULL, 0); |
| 337 | memranges_init_empty(&map.reserved, NULL, 0); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 338 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 339 | bootmem_walk_os_mem(walk_memory_table, &map); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 340 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 341 | /* CBMEM regions are both carved out and explicitly reserved. */ |
| 342 | memranges_each_entry(r, &map.reserved) { |
| 343 | update_reserve_map(range_entry_base(r), range_entry_end(r), |
| 344 | tree); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 345 | } |
| 346 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 347 | /* |
| 348 | * Count the amount of 'reg' entries we need (account for size limits). |
| 349 | */ |
| 350 | size_t count = 0; |
| 351 | memranges_each_entry(r, &map.mem) { |
| 352 | uint64_t size = range_entry_size(r); |
| 353 | uint64_t max_size = max_range(size_cells); |
| 354 | count += DIV_ROUND_UP(size, max_size); |
| 355 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 356 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 357 | /* Allocate the right amount of space and fill up the entries. */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 358 | size_t length = count * (addr_cells + size_cells) * sizeof(u32); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 359 | |
| 360 | void *data = xzalloc(length); |
| 361 | |
| 362 | struct entry_params add_params = { addr_cells, size_cells, data }; |
| 363 | memranges_each_entry(r, &map.mem) { |
| 364 | update_mem_property(range_entry_base(r), range_entry_end(r), |
| 365 | &add_params); |
| 366 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 367 | assert(add_params.data - data == length); |
| 368 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 369 | /* Assemble the final property and add it to the device tree. */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 370 | dt_add_bin_prop(node, "reg", data, length); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 371 | |
| 372 | memranges_teardown(&map.mem); |
| 373 | memranges_teardown(&map.reserved); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 374 | } |
| 375 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 376 | /* |
| 377 | * Finds a compat string and updates the compat position and rank. |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 378 | * @param config The current config node to operate on |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 379 | * @return 0 if compat updated, -1 if this FDT cannot be used. |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 380 | */ |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 381 | static int fit_update_compat(struct fit_config_node *config) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 382 | { |
Julius Werner | 23df477 | 2019-05-17 22:50:18 -0700 | [diff] [blame] | 383 | /* If there was no "compatible" property in config node, this is a |
| 384 | legacy FIT image. Must extract compat prop from FDT itself. */ |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 385 | if (!config->compat.name) { |
| 386 | void *fdt_blob = config->fdt->data; |
| 387 | const struct fdt_header *fdt_header = fdt_blob; |
| 388 | uint32_t fdt_offset = be32_to_cpu(fdt_header->structure_offset); |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 389 | |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 390 | if (config->fdt->compression != CBFS_COMPRESS_NONE) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 391 | printk(BIOS_ERR, "config %s has a compressed FDT without " |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 392 | "external compatible property, skipping.\n", |
| 393 | config->name); |
| 394 | return -1; |
| 395 | } |
| 396 | |
Julius Werner | 23df477 | 2019-05-17 22:50:18 -0700 | [diff] [blame] | 397 | /* FDT overlays are not supported in legacy FIT images. */ |
Julius Werner | 21b0b1a | 2019-05-16 16:12:04 -0700 | [diff] [blame] | 398 | if (config->overlays.next) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 399 | printk(BIOS_ERR, "config %s has overlay but no compat!\n", |
Julius Werner | 21b0b1a | 2019-05-16 16:12:04 -0700 | [diff] [blame] | 400 | config->name); |
| 401 | return -1; |
| 402 | } |
| 403 | |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 404 | if (fdt_find_compat(fdt_blob, fdt_offset, &config->compat)) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 405 | printk(BIOS_ERR, "Can't find compat string in FDT %s " |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 406 | "for config %s, skipping.\n", |
| 407 | config->fdt->name, config->name); |
| 408 | return -1; |
| 409 | } |
| 410 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 411 | |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 412 | config->compat_pos = -1; |
| 413 | config->compat_rank = -1; |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 414 | size_t i = 0; |
| 415 | struct compat_string_entry *compat_node; |
| 416 | list_for_each(compat_node, compat_strings, list_node) { |
| 417 | int pos = fit_check_compat(&config->compat, |
| 418 | compat_node->compat_string); |
| 419 | if (pos >= 0) { |
| 420 | config->compat_pos = pos; |
| 421 | config->compat_rank = i; |
| 422 | config->compat_string = |
| 423 | compat_node->compat_string; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 424 | } |
Julius Werner | fec4206 | 2019-05-16 16:04:19 -0700 | [diff] [blame] | 425 | i++; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 426 | } |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 427 | |
| 428 | return 0; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 429 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 430 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 431 | struct fit_config_node *fit_load(void *fit) |
| 432 | { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 433 | struct fit_image_node *image; |
| 434 | struct fit_config_node *config; |
| 435 | struct compat_string_entry *compat_node; |
Julius Werner | 21b0b1a | 2019-05-16 16:12:04 -0700 | [diff] [blame] | 436 | struct fit_overlay_chain *overlay_chain; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 437 | |
| 438 | printk(BIOS_DEBUG, "FIT: Loading FIT from %p\n", fit); |
| 439 | |
Julius Werner | 73eaec8 | 2019-05-03 17:58:07 -0700 | [diff] [blame] | 440 | struct device_tree *tree = fdt_unflatten(fit); |
| 441 | if (!tree) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 442 | printk(BIOS_ERR, "Failed to unflatten FIT image!\n"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 443 | return NULL; |
| 444 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 445 | |
| 446 | const char *default_config_name = NULL; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 447 | struct fit_config_node *default_config = NULL; |
| 448 | struct fit_config_node *compat_config = NULL; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 449 | |
| 450 | fit_unpack(tree, &default_config_name); |
| 451 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 452 | /* List the images we found. */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 453 | list_for_each(image, image_nodes, list_node) |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 454 | printk(BIOS_DEBUG, "FIT: Image %s has %d bytes.\n", image->name, |
| 455 | image->size); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 456 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 457 | fit_add_default_compat_strings(); |
| 458 | |
| 459 | printk(BIOS_DEBUG, "FIT: Compat preference " |
| 460 | "(lowest to highest priority) :"); |
| 461 | |
| 462 | list_for_each(compat_node, compat_strings, list_node) { |
| 463 | printk(BIOS_DEBUG, " %s", compat_node->compat_string); |
| 464 | } |
| 465 | printk(BIOS_DEBUG, "\n"); |
| 466 | /* Process and list the configs. */ |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 467 | list_for_each(config, config_nodes, list_node) { |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 468 | if (!config->kernel) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 469 | printk(BIOS_ERR, "config %s has no kernel, skipping.\n", |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 470 | config->name); |
| 471 | continue; |
| 472 | } |
| 473 | if (!config->fdt) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 474 | printk(BIOS_ERR, "config %s has no FDT, skipping.\n", |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 475 | config->name); |
| 476 | continue; |
| 477 | } |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 478 | |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 479 | if (config->ramdisk && |
| 480 | config->ramdisk->compression < 0) { |
Julius Werner | e966595 | 2022-01-21 17:06:20 -0800 | [diff] [blame] | 481 | printk(BIOS_WARNING, "Ramdisk is compressed with " |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 482 | "an unsupported algorithm, discarding config %s." |
| 483 | "\n", config->name); |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 484 | continue; |
| 485 | } |
| 486 | |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 487 | if (fit_update_compat(config)) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 488 | continue; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 489 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 490 | printk(BIOS_DEBUG, "FIT: config %s", config->name); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 491 | if (default_config_name && |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 492 | !strcmp(config->name, default_config_name)) { |
| 493 | printk(BIOS_DEBUG, " (default)"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 494 | default_config = config; |
| 495 | } |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 496 | printk(BIOS_DEBUG, ", kernel %s", config->kernel->name); |
| 497 | printk(BIOS_DEBUG, ", fdt %s", config->fdt->name); |
Julius Werner | 21b0b1a | 2019-05-16 16:12:04 -0700 | [diff] [blame] | 498 | list_for_each(overlay_chain, config->overlays, list_node) |
| 499 | printk(BIOS_DEBUG, " %s", overlay_chain->overlay->name); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 500 | if (config->ramdisk) |
Julius Werner | b379f19 | 2019-05-13 16:34:16 -0700 | [diff] [blame] | 501 | printk(BIOS_DEBUG, ", ramdisk %s", |
| 502 | config->ramdisk->name); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 503 | if (config->compat.name) { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 504 | printk(BIOS_DEBUG, ", compat"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 505 | int bytes = config->compat.size; |
| 506 | const char *compat_str = config->compat.data; |
| 507 | for (int pos = 0; bytes && compat_str[0]; pos++) { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 508 | printk(BIOS_DEBUG, " %s", compat_str); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 509 | if (pos == config->compat_pos) |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 510 | printk(BIOS_DEBUG, " (match)"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 511 | int len = strlen(compat_str) + 1; |
| 512 | compat_str += len; |
| 513 | bytes -= len; |
| 514 | } |
| 515 | |
| 516 | if (config->compat_rank >= 0 && (!compat_config || |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 517 | config->compat_rank > compat_config->compat_rank)) |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 518 | compat_config = config; |
| 519 | } |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 520 | printk(BIOS_DEBUG, "\n"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 521 | } |
| 522 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 523 | struct fit_config_node *to_boot = NULL; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 524 | if (compat_config) { |
| 525 | to_boot = compat_config; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 526 | printk(BIOS_INFO, "FIT: Choosing best match %s for compat " |
| 527 | "%s.\n", to_boot->name, to_boot->compat_string); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 528 | } else if (default_config) { |
| 529 | to_boot = default_config; |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 530 | printk(BIOS_INFO, "FIT: No match, choosing default %s.\n", |
| 531 | to_boot->name); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 532 | } else { |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 533 | printk(BIOS_ERR, "FIT: No compatible or default configs. " |
| 534 | "Giving up.\n"); |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 535 | return NULL; |
| 536 | } |
| 537 | |
Patrick Rudolph | a892cde | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 538 | return to_boot; |
Patrick Rudolph | a45e9f8 | 2018-04-19 14:39:07 +0200 | [diff] [blame] | 539 | } |