Angel Pons | 0612b27 | 2020-04-05 15:46:56 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 2 | |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 3 | #include <bootstate.h> |
| 4 | #include <cbfs.h> |
| 5 | #include <cbmem.h> |
| 6 | #include <console/console.h> |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 7 | #include <soc/intel/common/mma.h> |
Elyes HAOUAS | a1e22b8 | 2019-03-18 22:49:36 +0100 | [diff] [blame] | 8 | #include <string.h> |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 9 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 10 | #define MMA_TEST_METADATA_FILENAME "mma_test_metadata.bin" |
| 11 | #define MMA_TEST_NAME_TAG "MMA_TEST_NAME" |
| 12 | #define MMA_TEST_PARAM_TAG "MMA_TEST_PARAM" |
| 13 | #define TEST_NAME_MAX_SIZE 30 |
| 14 | #define TEST_PARAM_MAX_SIZE 100 |
| 15 | #define MMA_DATA_SIGNATURE (('M' << 0) | ('M' << 8) | \ |
| 16 | ('A' << 16) | ('D' << 24)) |
Pratik Prajapati | de62e0f | 2016-02-22 16:50:31 -0800 | [diff] [blame] | 17 | #define MMA_CBFS_REGION "COREBOOT" |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 18 | |
| 19 | struct mma_data_container { |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 20 | uint32_t mma_signature; /* "MMAD" */ |
| 21 | uint8_t mma_data[0]; /* Variable size, platform/run time dependent. */ |
Stefan Reinauer | 6a00113 | 2017-07-13 02:20:27 +0200 | [diff] [blame] | 22 | } __packed; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 23 | |
| 24 | /* |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 25 | * Format of the MMA test metadata file, stored under CBFS |
| 26 | * MMA_TEST_NAME=xxxxxx.efi;MMA_TEST_PARAM=xxxxxx.bin; |
| 27 | */ |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 28 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 29 | /* Returns index in haystack after 'LABEL=' |
| 30 | * string is found, < 0 on error. |
| 31 | */ |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 32 | static int find_label(const char *haystack, size_t haystack_sz, |
| 33 | const char *label) |
| 34 | { |
| 35 | size_t label_sz; |
| 36 | size_t i; |
| 37 | size_t search_sz; |
| 38 | |
| 39 | label_sz = strlen(label); |
| 40 | |
| 41 | if (label_sz + 1 >= haystack_sz) |
| 42 | return -1; |
| 43 | |
| 44 | /* Handle '=' follow label. i.e. LABEL= */ |
| 45 | search_sz = haystack_sz - label_sz - 1; |
| 46 | for (i = 0; i < search_sz; i++) { |
| 47 | if (!strncmp(&haystack[i], label, label_sz)) |
| 48 | break; |
| 49 | } |
| 50 | |
| 51 | if (i == search_sz) |
| 52 | return -1; |
| 53 | |
| 54 | if (haystack[i + label_sz] != '=') |
| 55 | return -1; |
| 56 | |
| 57 | return i + label_sz + 1; |
| 58 | } |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 59 | |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 60 | /* |
| 61 | * Fill in value in dest field located by LABEL=. |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 62 | * Returns 0 on success, < 0 on error. |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 63 | */ |
| 64 | static int label_value(const char *haystack, size_t haystack_sz, |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 65 | const char *label, char *dest, size_t dest_sz) |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 66 | { |
| 67 | size_t val_begin; |
| 68 | size_t val_end; |
| 69 | size_t val_sz; |
| 70 | int val_index; |
| 71 | |
| 72 | memset(dest, 0, dest_sz); |
| 73 | |
| 74 | /* Allow for NULL termination. */ |
| 75 | dest_sz--; |
| 76 | val_index = find_label(haystack, haystack_sz, label); |
| 77 | if (val_index < 0) |
| 78 | return -1; |
| 79 | |
| 80 | val_begin = val_index; |
| 81 | val_end = val_begin; |
| 82 | val_sz = 0; |
| 83 | |
| 84 | for (val_end = val_begin; val_end < haystack_sz; val_end++) { |
| 85 | if (haystack[val_end] == ';') { |
| 86 | val_sz = val_end - val_begin; |
| 87 | break; |
| 88 | } |
| 89 | } |
| 90 | |
| 91 | if (val_end == haystack_sz) |
| 92 | return -1; |
| 93 | |
| 94 | if (dest_sz < val_sz) |
| 95 | return -1; |
| 96 | |
| 97 | memcpy(dest, &haystack[val_begin], val_sz); |
| 98 | |
| 99 | return 0; |
| 100 | } |
| 101 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 102 | int mma_locate_param(struct mma_config_param *mma_cfg) |
Pratik Prajapati | de62e0f | 2016-02-22 16:50:31 -0800 | [diff] [blame] | 103 | { |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 104 | void *mma_test_metadata; |
| 105 | size_t mma_test_metadata_file_len; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 106 | char test_filename[TEST_NAME_MAX_SIZE], |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 107 | test_param_filename[TEST_PARAM_MAX_SIZE]; |
| 108 | struct cbfsf metadata_fh, test_content_fh, test_param_fh; |
| 109 | uint32_t mma_type = CBFS_TYPE_MMA; |
| 110 | uint32_t efi_type = CBFS_TYPE_EFI; |
| 111 | bool metadata_parse_flag = true; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 112 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 113 | printk(BIOS_DEBUG, "MMA: Entry %s\n", __func__); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 114 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 115 | if (cbfs_locate_file_in_region(&metadata_fh, MMA_CBFS_REGION, |
Julius Werner | 834b3ec | 2020-03-04 16:52:08 -0800 | [diff] [blame^] | 116 | MMA_TEST_METADATA_FILENAME)) { |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 117 | printk(BIOS_DEBUG, "MMA: Failed to locate %s\n", |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 118 | MMA_TEST_METADATA_FILENAME); |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 119 | return -1; |
| 120 | } |
| 121 | |
| 122 | mma_test_metadata = rdev_mmap_full(&metadata_fh.data); |
| 123 | mma_test_metadata_file_len = region_device_sz(&metadata_fh.data); |
| 124 | |
| 125 | if (!mma_test_metadata || !mma_test_metadata_file_len) { |
| 126 | printk(BIOS_DEBUG, "MMA: Failed to read %s\n", |
| 127 | MMA_TEST_METADATA_FILENAME); |
| 128 | return -1; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 129 | } |
| 130 | |
| 131 | if (label_value(mma_test_metadata, mma_test_metadata_file_len, |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 132 | MMA_TEST_NAME_TAG, test_filename, |
| 133 | TEST_NAME_MAX_SIZE)) { |
| 134 | printk(BIOS_DEBUG, "MMA: Failed to get %s\n", |
| 135 | MMA_TEST_NAME_TAG); |
| 136 | metadata_parse_flag = false; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 137 | } |
| 138 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 139 | if (metadata_parse_flag && |
| 140 | label_value(mma_test_metadata, mma_test_metadata_file_len, |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 141 | MMA_TEST_PARAM_TAG, test_param_filename, |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 142 | TEST_PARAM_MAX_SIZE)) { |
| 143 | printk(BIOS_DEBUG, "MMA: Failed to get %s\n", |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 144 | MMA_TEST_PARAM_TAG); |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 145 | metadata_parse_flag = false; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 146 | } |
| 147 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 148 | rdev_munmap(&metadata_fh.data, mma_test_metadata); |
| 149 | |
| 150 | if (!metadata_parse_flag) |
| 151 | return -1; |
| 152 | |
| 153 | printk(BIOS_DEBUG, "MMA: Got MMA_TEST_NAME=%s MMA_TEST_PARAM=%s\n", |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 154 | test_filename, test_param_filename); |
| 155 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 156 | if (cbfs_locate_file_in_region(&test_content_fh, MMA_CBFS_REGION, |
Julius Werner | 834b3ec | 2020-03-04 16:52:08 -0800 | [diff] [blame^] | 157 | test_filename)) { |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 158 | printk(BIOS_DEBUG, "MMA: Failed to locate %s\n", |
| 159 | test_filename); |
| 160 | return -1; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 161 | } |
| 162 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 163 | cbfs_file_data(&mma_cfg->test_content, &test_content_fh); |
| 164 | |
| 165 | if (cbfs_locate_file_in_region(&test_param_fh, MMA_CBFS_REGION, |
Julius Werner | 834b3ec | 2020-03-04 16:52:08 -0800 | [diff] [blame^] | 166 | test_param_filename)) { |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 167 | printk(BIOS_DEBUG, "MMA: Failed to locate %s\n", |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 168 | test_param_filename); |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 169 | return -1; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 170 | } |
| 171 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 172 | cbfs_file_data(&mma_cfg->test_param, &test_param_fh); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 173 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 174 | printk(BIOS_DEBUG, "MMA: %s exit success\n", __func__); |
Pratik Prajapati | ad8c35c | 2016-04-11 16:44:15 -0700 | [diff] [blame] | 175 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 176 | return 0; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 177 | } |
| 178 | |
| 179 | static void save_mma_results_data(void *unused) |
| 180 | { |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 181 | const void *mma_hob; |
| 182 | size_t mma_hob_size; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 183 | struct mma_data_container *mma_data; |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 184 | size_t mma_data_size; |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 185 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 186 | printk(BIOS_DEBUG, "MMA: Entry %s\n", __func__); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 187 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 188 | if (fsp_locate_mma_results(&mma_hob, &mma_hob_size)) { |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 189 | printk(BIOS_DEBUG, |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 190 | "MMA: results data Hob not present\n"); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 191 | return; |
| 192 | } |
| 193 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 194 | mma_data_size = ALIGN(mma_hob_size, 16) + |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 195 | sizeof(struct mma_data_container); |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 196 | |
| 197 | mma_data = cbmem_add(CBMEM_ID_MMA_DATA, mma_data_size); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 198 | |
| 199 | if (mma_data == NULL) { |
| 200 | printk(BIOS_DEBUG, |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 201 | "MMA: CBMEM was not available to save the MMA data.\n"); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 202 | return; |
| 203 | } |
| 204 | |
| 205 | /*clear the mma_data before coping the actual data */ |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 206 | memset(mma_data, 0, mma_data_size); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 207 | |
| 208 | printk(BIOS_DEBUG, |
Julius Werner | 540a980 | 2019-12-09 13:03:29 -0800 | [diff] [blame] | 209 | "MMA: copy MMA data to CBMEM(src %p, dest %p, %u bytes)\n", |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 210 | mma_hob, mma_data, mma_hob_size); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 211 | |
| 212 | mma_data->mma_signature = MMA_DATA_SIGNATURE; |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 213 | memcpy(mma_data->mma_data, mma_hob, mma_hob_size); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 214 | |
Pratik Prajapati | ffc934d | 2016-11-18 14:36:34 -0800 | [diff] [blame] | 215 | printk(BIOS_DEBUG, "MMA: %s exit successfully\n", __func__); |
Pratik Prajapati | b90b94d | 2015-09-11 13:51:38 -0700 | [diff] [blame] | 216 | } |
| 217 | |
| 218 | BOOT_STATE_INIT_ENTRY(BS_WRITE_TABLES, BS_ON_ENTRY, |
| 219 | save_mma_results_data, NULL); |