Patrick Georgi | ac95903 | 2020-05-05 22:49:26 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-or-later */ |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 2 | |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 3 | #include <cbfs.h> |
Aaron Durbin | 32ac018 | 2016-07-18 00:35:42 -0500 | [diff] [blame] | 4 | #include <cbmem.h> |
| 5 | #include <commonlib/fsp.h> |
Subrata Banik | 44ffb5d | 2018-05-24 10:51:29 +0530 | [diff] [blame] | 6 | #include <commonlib/stdlib.h> |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 7 | #include <console/console.h> |
| 8 | #include <fsp/api.h> |
| 9 | #include <fsp/util.h> |
Aaron Durbin | 32ac018 | 2016-07-18 00:35:42 -0500 | [diff] [blame] | 10 | #include <program_loading.h> |
Keith Short | c58e3bd | 2019-05-10 11:14:31 -0600 | [diff] [blame] | 11 | #include <soc/intel/common/vbt.h> |
Brandon Breitenstein | c6ec8dd | 2016-11-17 12:23:04 -0800 | [diff] [blame] | 12 | #include <stage_cache.h> |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 13 | #include <string.h> |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 14 | #include <timestamp.h> |
Elyes HAOUAS | bd1683d | 2019-05-15 21:05:37 +0200 | [diff] [blame] | 15 | #include <types.h> |
Patrick Rudolph | 40beb36 | 2020-12-01 10:08:38 +0100 | [diff] [blame] | 16 | #include <mode_switch.h> |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 17 | |
| 18 | struct fsp_header fsps_hdr; |
| 19 | |
Subrata Banik | 33d9c4a | 2020-05-26 18:26:54 +0530 | [diff] [blame] | 20 | struct fsp_multi_phase_get_number_of_phases_params { |
| 21 | uint32_t number_of_phases; |
| 22 | uint32_t phases_executed; |
| 23 | }; |
| 24 | |
| 25 | /* Callbacks for SoC/Mainboard specific overrides */ |
| 26 | void __weak platform_fsp_multi_phase_init_cb(uint32_t phase_index) |
| 27 | { |
| 28 | /* Leave for the SoC/Mainboard to implement if necessary. */ |
| 29 | } |
| 30 | |
| 31 | int __weak soc_fsp_multi_phase_init_is_enable(void) |
| 32 | { |
| 33 | return 1; |
| 34 | } |
| 35 | |
| 36 | /* FSP Specification < 2.2 has only 1 stage like FspSiliconInit. FSP specification >= 2.2 |
| 37 | * has multiple stages as below. |
| 38 | */ |
| 39 | enum fsp_silicon_init_phases { |
| 40 | FSP_SILICON_INIT_API, |
| 41 | FSP_MULTI_PHASE_SI_INIT_GET_NUMBER_OF_PHASES_API, |
| 42 | FSP_MULTI_PHASE_SI_INIT_EXECUTE_PHASE_API |
| 43 | }; |
| 44 | |
| 45 | static void fsps_return_value_handler(enum fsp_silicon_init_phases phases, uint32_t status) |
| 46 | { |
| 47 | uint8_t postcode; |
| 48 | |
| 49 | /* Handle any reset request returned by FSP-S APIs */ |
| 50 | fsp_handle_reset(status); |
| 51 | |
| 52 | if (status == FSP_SUCCESS) |
| 53 | return; |
| 54 | /* Handle all other errors returned by FSP-S APIs */ |
| 55 | /* Assume video failure if attempted to initialize graphics */ |
| 56 | if (CONFIG(RUN_FSP_GOP) && vbt_get()) |
| 57 | postcode = POST_VIDEO_FAILURE; |
| 58 | else |
| 59 | postcode = POST_HW_INIT_FAILURE; /* else generic */ |
| 60 | |
| 61 | switch (phases) { |
| 62 | case FSP_SILICON_INIT_API: |
| 63 | die_with_post_code(postcode, "FspSiliconInit returned with error 0x%08x\n", |
| 64 | status); |
| 65 | break; |
| 66 | case FSP_MULTI_PHASE_SI_INIT_GET_NUMBER_OF_PHASES_API: |
| 67 | printk(BIOS_SPEW, "FspMultiPhaseSiInit NumberOfPhases returned 0x%08x\n", |
| 68 | status); |
| 69 | break; |
| 70 | case FSP_MULTI_PHASE_SI_INIT_EXECUTE_PHASE_API: |
| 71 | printk(BIOS_SPEW, "FspMultiPhaseSiInit ExecutePhase returned 0x%08x\n", |
| 72 | status); |
| 73 | break; |
| 74 | default: |
| 75 | break; |
| 76 | } |
| 77 | } |
| 78 | |
Lee Leahy | 9671faa | 2016-07-24 18:18:52 -0700 | [diff] [blame] | 79 | static void do_silicon_init(struct fsp_header *hdr) |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 80 | { |
Subrata Banik | 44ffb5d | 2018-05-24 10:51:29 +0530 | [diff] [blame] | 81 | FSPS_UPD *upd, *supd; |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 82 | fsp_silicon_init_fn silicon_init; |
Brandon Breitenstein | c31ba0e | 2016-07-27 17:34:45 -0700 | [diff] [blame] | 83 | uint32_t status; |
Wim Vervoorn | d137150 | 2019-12-17 14:10:16 +0100 | [diff] [blame] | 84 | const struct cbmem_entry *logo_entry = NULL; |
Subrata Banik | 33d9c4a | 2020-05-26 18:26:54 +0530 | [diff] [blame] | 85 | fsp_multi_phase_si_init_fn multi_phase_si_init; |
| 86 | struct fsp_multi_phase_params multi_phase_params; |
| 87 | struct fsp_multi_phase_get_number_of_phases_params multi_phase_get_number; |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 88 | |
Brandon Breitenstein | c31ba0e | 2016-07-27 17:34:45 -0700 | [diff] [blame] | 89 | supd = (FSPS_UPD *) (hdr->cfg_region_offset + hdr->image_base); |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 90 | |
Lee Leahy | e686ee8 | 2017-03-10 08:45:30 -0800 | [diff] [blame] | 91 | if (supd->FspUpdHeader.Signature != FSPS_UPD_SIGNATURE) |
Keith Short | bb41aba | 2019-05-16 14:07:43 -0600 | [diff] [blame] | 92 | die_with_post_code(POST_INVALID_VENDOR_BINARY, |
| 93 | "Invalid FSPS signature\n"); |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 94 | |
Marshall Dawson | 71dbcf1 | 2019-09-11 14:02:34 -0600 | [diff] [blame] | 95 | /* Disallow invalid config regions. Default settings are likely bad |
| 96 | * choices for coreboot, and different sized UPD from what the region |
| 97 | * allows is potentially a build problem. |
| 98 | */ |
| 99 | if (!hdr->cfg_region_size || hdr->cfg_region_size != sizeof(FSPS_UPD)) |
| 100 | die_with_post_code(POST_INVALID_VENDOR_BINARY, |
| 101 | "Invalid FSPS UPD region\n"); |
Subrata Banik | 44ffb5d | 2018-05-24 10:51:29 +0530 | [diff] [blame] | 102 | |
Marshall Dawson | 71dbcf1 | 2019-09-11 14:02:34 -0600 | [diff] [blame] | 103 | upd = xmalloc(hdr->cfg_region_size); |
| 104 | |
| 105 | memcpy(upd, supd, hdr->cfg_region_size); |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 106 | |
| 107 | /* Give SoC/mainboard a chance to populate entries */ |
Subrata Banik | 44ffb5d | 2018-05-24 10:51:29 +0530 | [diff] [blame] | 108 | platform_fsp_silicon_init_params_cb(upd); |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 109 | |
Wim Vervoorn | d137150 | 2019-12-17 14:10:16 +0100 | [diff] [blame] | 110 | /* Populate logo related entries */ |
| 111 | if (CONFIG(FSP2_0_DISPLAY_LOGO)) |
| 112 | logo_entry = soc_load_logo(upd); |
Wim Vervoorn | cbc878d2 | 2019-11-28 14:45:12 +0100 | [diff] [blame] | 113 | |
Lee Leahy | 672df16 | 2016-07-24 18:21:13 -0700 | [diff] [blame] | 114 | /* Call SiliconInit */ |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 115 | silicon_init = (void *) (hdr->image_base + |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 116 | hdr->silicon_init_entry_offset); |
Subrata Banik | 44ffb5d | 2018-05-24 10:51:29 +0530 | [diff] [blame] | 117 | fsp_debug_before_silicon_init(silicon_init, supd, upd); |
Lee Leahy | 672df16 | 2016-07-24 18:21:13 -0700 | [diff] [blame] | 118 | |
| 119 | timestamp_add_now(TS_FSP_SILICON_INIT_START); |
| 120 | post_code(POST_FSP_SILICON_INIT); |
Patrick Rudolph | 40beb36 | 2020-12-01 10:08:38 +0100 | [diff] [blame] | 121 | |
| 122 | if (ENV_X86_64) |
| 123 | status = protected_mode_call_1arg(silicon_init, (uintptr_t)upd); |
| 124 | else |
| 125 | status = silicon_init(upd); |
| 126 | |
| 127 | printk(BIOS_ERR, "FSPS returned %x\n", status); |
| 128 | |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 129 | timestamp_add_now(TS_FSP_SILICON_INIT_END); |
Subrata Banik | 0755ab9 | 2017-07-12 15:31:06 +0530 | [diff] [blame] | 130 | post_code(POST_FSP_SILICON_EXIT); |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 131 | |
Wim Vervoorn | d137150 | 2019-12-17 14:10:16 +0100 | [diff] [blame] | 132 | if (logo_entry) |
Wim Vervoorn | cbc878d2 | 2019-11-28 14:45:12 +0100 | [diff] [blame] | 133 | cbmem_entry_remove(logo_entry); |
| 134 | |
Lee Leahy | 672df16 | 2016-07-24 18:21:13 -0700 | [diff] [blame] | 135 | fsp_debug_after_silicon_init(status); |
Subrata Banik | 33d9c4a | 2020-05-26 18:26:54 +0530 | [diff] [blame] | 136 | fsps_return_value_handler(FSP_SILICON_INIT_API, status); |
Aaron Durbin | 35d42c7 | 2016-07-18 12:41:09 -0500 | [diff] [blame] | 137 | |
Subrata Banik | 96b32f1 | 2020-07-31 12:09:11 +0530 | [diff] [blame] | 138 | /* Reinitialize CPUs if FSP-S has done MP Init */ |
| 139 | if (CONFIG(USE_INTEL_FSP_MP_INIT)) |
| 140 | do_mpinit_after_fsp(); |
| 141 | |
Subrata Banik | 33d9c4a | 2020-05-26 18:26:54 +0530 | [diff] [blame] | 142 | if (!CONFIG(PLATFORM_USES_FSP2_2)) |
| 143 | return; |
Marshall Dawson | 7a9e894 | 2019-10-17 07:58:27 -0600 | [diff] [blame] | 144 | |
Subrata Banik | 33d9c4a | 2020-05-26 18:26:54 +0530 | [diff] [blame] | 145 | /* Check if SoC user would like to call Multi Phase Init */ |
| 146 | if (!soc_fsp_multi_phase_init_is_enable()) |
| 147 | return; |
| 148 | |
| 149 | /* Call MultiPhaseSiInit */ |
| 150 | multi_phase_si_init = (void *) (hdr->image_base + |
| 151 | hdr->multi_phase_si_init_entry_offset); |
| 152 | |
| 153 | /* Implementing multi_phase_si_init() is optional as per FSP 2.2 spec */ |
| 154 | if (multi_phase_si_init == NULL) |
| 155 | return; |
| 156 | |
| 157 | post_code(POST_FSP_MULTI_PHASE_SI_INIT_ENTRY); |
| 158 | timestamp_add_now(TS_FSP_MULTI_PHASE_SI_INIT_START); |
| 159 | /* Get NumberOfPhases Value */ |
| 160 | multi_phase_params.multi_phase_action = GET_NUMBER_OF_PHASES; |
| 161 | multi_phase_params.phase_index = 0; |
| 162 | multi_phase_params.multi_phase_param_ptr = &multi_phase_get_number; |
| 163 | status = multi_phase_si_init(&multi_phase_params); |
| 164 | fsps_return_value_handler(FSP_MULTI_PHASE_SI_INIT_GET_NUMBER_OF_PHASES_API, status); |
| 165 | |
| 166 | /* Execute Multi Phase Execution */ |
| 167 | for (int i = 1; i <= multi_phase_get_number.number_of_phases; i++) { |
| 168 | printk(BIOS_SPEW, "Executing Phase %d of FspMultiPhaseSiInit\n", i); |
| 169 | /* |
| 170 | * Give SoC/mainboard a chance to perform any operation before |
| 171 | * Multi Phase Execution |
| 172 | */ |
| 173 | platform_fsp_multi_phase_init_cb(i); |
| 174 | |
| 175 | multi_phase_params.multi_phase_action = EXECUTE_PHASE; |
| 176 | multi_phase_params.phase_index = i; |
| 177 | multi_phase_params.multi_phase_param_ptr = NULL; |
| 178 | status = multi_phase_si_init(&multi_phase_params); |
| 179 | fsps_return_value_handler(FSP_MULTI_PHASE_SI_INIT_EXECUTE_PHASE_API, status); |
Lee Leahy | 9671faa | 2016-07-24 18:18:52 -0700 | [diff] [blame] | 180 | } |
Subrata Banik | 33d9c4a | 2020-05-26 18:26:54 +0530 | [diff] [blame] | 181 | timestamp_add_now(TS_FSP_MULTI_PHASE_SI_INIT_END); |
| 182 | post_code(POST_FSP_MULTI_PHASE_SI_INIT_EXIT); |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 183 | } |
| 184 | |
Aaron Durbin | a85febc | 2020-05-15 15:09:10 -0600 | [diff] [blame] | 185 | static int fsps_get_dest(const struct fsp_load_descriptor *fspld, void **dest, |
| 186 | size_t size, const struct region_device *source) |
| 187 | { |
| 188 | *dest = cbmem_add(CBMEM_ID_REFCODE, size); |
| 189 | |
| 190 | if (*dest == NULL) |
| 191 | return -1; |
| 192 | |
| 193 | return 0; |
| 194 | } |
| 195 | |
Furquan Shaikh | f4b20af | 2017-02-20 13:33:32 -0800 | [diff] [blame] | 196 | void fsps_load(bool s3wake) |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 197 | { |
Aaron Durbin | a85febc | 2020-05-15 15:09:10 -0600 | [diff] [blame] | 198 | struct fsp_load_descriptor fspld = { |
| 199 | .fsp_prog = PROG_INIT(PROG_REFCODE, CONFIG_FSP_S_CBFS), |
| 200 | .get_destination = fsps_get_dest, |
| 201 | }; |
| 202 | struct prog *fsps = &fspld.fsp_prog; |
Furquan Shaikh | f4b20af | 2017-02-20 13:33:32 -0800 | [diff] [blame] | 203 | static int load_done; |
| 204 | |
| 205 | if (load_done) |
| 206 | return; |
Brandon Breitenstein | c6ec8dd | 2016-11-17 12:23:04 -0800 | [diff] [blame] | 207 | |
Kyösti Mälkki | e0165fb | 2021-01-09 13:30:57 +0200 | [diff] [blame^] | 208 | if (resume_from_stage_cache()) { |
Brandon Breitenstein | c6ec8dd | 2016-11-17 12:23:04 -0800 | [diff] [blame] | 209 | printk(BIOS_DEBUG, "Loading FSPS from stage_cache\n"); |
Aaron Durbin | a85febc | 2020-05-15 15:09:10 -0600 | [diff] [blame] | 210 | stage_cache_load_stage(STAGE_REFCODE, fsps); |
| 211 | if (fsp_validate_component(&fsps_hdr, prog_rdev(fsps)) != CB_SUCCESS) |
Brandon Breitenstein | c6ec8dd | 2016-11-17 12:23:04 -0800 | [diff] [blame] | 212 | die("On resume fsps header is invalid\n"); |
Furquan Shaikh | f4b20af | 2017-02-20 13:33:32 -0800 | [diff] [blame] | 213 | load_done = 1; |
Brandon Breitenstein | c6ec8dd | 2016-11-17 12:23:04 -0800 | [diff] [blame] | 214 | return; |
| 215 | } |
| 216 | |
Aaron Durbin | a85febc | 2020-05-15 15:09:10 -0600 | [diff] [blame] | 217 | if (fsp_load_component(&fspld, &fsps_hdr) != CB_SUCCESS) |
| 218 | die("FSP-S failed to load\n"); |
Aaron Durbin | 32ac018 | 2016-07-18 00:35:42 -0500 | [diff] [blame] | 219 | |
Aaron Durbin | a85febc | 2020-05-15 15:09:10 -0600 | [diff] [blame] | 220 | stage_cache_add(STAGE_REFCODE, fsps); |
Aaron Durbin | 32ac018 | 2016-07-18 00:35:42 -0500 | [diff] [blame] | 221 | |
Furquan Shaikh | f4b20af | 2017-02-20 13:33:32 -0800 | [diff] [blame] | 222 | load_done = 1; |
| 223 | } |
Aaron Durbin | 32ac018 | 2016-07-18 00:35:42 -0500 | [diff] [blame] | 224 | |
Furquan Shaikh | f4b20af | 2017-02-20 13:33:32 -0800 | [diff] [blame] | 225 | void fsp_silicon_init(bool s3wake) |
| 226 | { |
| 227 | fsps_load(s3wake); |
| 228 | do_silicon_init(&fsps_hdr); |
Andrey Petrov | 42c4e88 | 2016-02-25 14:17:45 -0800 | [diff] [blame] | 229 | } |
Wim Vervoorn | d137150 | 2019-12-17 14:10:16 +0100 | [diff] [blame] | 230 | |
| 231 | /* Load bmp and set FSP parameters, fsp_load_logo can be used */ |
| 232 | __weak const struct cbmem_entry *soc_load_logo(FSPS_UPD *supd) |
| 233 | { |
| 234 | return NULL; |
| 235 | } |