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