Patrick Georgi | ac95903 | 2020-05-05 22:49:26 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-or-later */ |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 2 | |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 3 | #include <bootstate.h> |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 4 | #include <console/console.h> |
Nico Huber | d67edca | 2018-11-13 19:28:07 +0100 | [diff] [blame] | 5 | #include <cpu/x86/mtrr.h> |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 6 | #include <fsp/util.h> |
Patrick Rudolph | 40beb36 | 2020-12-01 10:08:38 +0100 | [diff] [blame] | 7 | #include <mode_switch.h> |
Angel Pons | 654930e | 2022-01-01 17:08:00 +0100 | [diff] [blame] | 8 | #include <timestamp.h> |
Angel Pons | 355d844 | 2022-01-01 17:03:10 +0100 | [diff] [blame^] | 9 | #include <types.h> |
| 10 | |
| 11 | struct fsp_notify_phase_data { |
| 12 | enum fsp_notify_phase notify_phase; |
| 13 | uint8_t post_code_before; |
| 14 | uint8_t post_code_after; |
| 15 | enum timestamp_id timestamp_before; |
| 16 | enum timestamp_id timestamp_after; |
| 17 | }; |
| 18 | |
| 19 | static const struct fsp_notify_phase_data notify_data[] = { |
| 20 | { |
| 21 | .notify_phase = AFTER_PCI_ENUM, |
| 22 | .post_code_before = POST_FSP_NOTIFY_BEFORE_ENUMERATE, |
| 23 | .post_code_after = POST_FSP_NOTIFY_AFTER_ENUMERATE, |
| 24 | .timestamp_before = TS_FSP_BEFORE_ENUMERATE, |
| 25 | .timestamp_after = TS_FSP_AFTER_ENUMERATE, |
| 26 | }, |
| 27 | { |
| 28 | .notify_phase = READY_TO_BOOT, |
| 29 | .post_code_before = POST_FSP_NOTIFY_BEFORE_FINALIZE, |
| 30 | .post_code_after = POST_FSP_NOTIFY_AFTER_FINALIZE, |
| 31 | .timestamp_before = TS_FSP_BEFORE_FINALIZE, |
| 32 | .timestamp_after = TS_FSP_AFTER_FINALIZE, |
| 33 | }, |
| 34 | { |
| 35 | .notify_phase = END_OF_FIRMWARE, |
| 36 | .post_code_before = POST_FSP_NOTIFY_BEFORE_END_OF_FIRMWARE, |
| 37 | .post_code_after = POST_FSP_NOTIFY_AFTER_END_OF_FIRMWARE, |
| 38 | .timestamp_before = TS_FSP_BEFORE_END_OF_FIRMWARE, |
| 39 | .timestamp_after = TS_FSP_AFTER_END_OF_FIRMWARE, |
| 40 | }, |
| 41 | }; |
| 42 | |
| 43 | static const struct fsp_notify_phase_data *get_notify_phase_data(enum fsp_notify_phase phase) |
| 44 | { |
| 45 | for (size_t i = 0; i < ARRAY_SIZE(notify_data); i++) { |
| 46 | if (notify_data[i].notify_phase == phase) |
| 47 | return ¬ify_data[i]; |
| 48 | } |
| 49 | die("Unknown FSP notify phase %u\n", phase); |
| 50 | } |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 51 | |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 52 | static void fsp_notify(enum fsp_notify_phase phase) |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 53 | { |
Angel Pons | 355d844 | 2022-01-01 17:03:10 +0100 | [diff] [blame^] | 54 | const struct fsp_notify_phase_data *data = get_notify_phase_data(phase); |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 55 | struct fsp_notify_params notify_params = { .phase = phase }; |
Angel Pons | 654930e | 2022-01-01 17:08:00 +0100 | [diff] [blame] | 56 | fsp_notify_fn fspnotify; |
| 57 | uint32_t ret; |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 58 | |
Lee Leahy | 9671faa | 2016-07-24 18:18:52 -0700 | [diff] [blame] | 59 | if (!fsps_hdr.notify_phase_entry_offset) |
| 60 | die("Notify_phase_entry_offset is zero!\n"); |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 61 | |
Angel Pons | 654930e | 2022-01-01 17:08:00 +0100 | [diff] [blame] | 62 | fspnotify = (void *)(uintptr_t)(fsps_hdr.image_base + |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 63 | fsps_hdr.notify_phase_entry_offset); |
Lee Leahy | 672df16 | 2016-07-24 18:21:13 -0700 | [diff] [blame] | 64 | fsp_before_debug_notify(fspnotify, ¬ify_params); |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 65 | |
Angel Pons | 355d844 | 2022-01-01 17:03:10 +0100 | [diff] [blame^] | 66 | timestamp_add_now(data->timestamp_before); |
| 67 | post_code(data->post_code_before); |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 68 | |
Patrick Rudolph | 31218a4 | 2020-11-30 15:50:06 +0100 | [diff] [blame] | 69 | if (ENV_X86_64 && CONFIG(PLATFORM_USES_FSP2_X86_32)) |
Patrick Rudolph | 40beb36 | 2020-12-01 10:08:38 +0100 | [diff] [blame] | 70 | ret = protected_mode_call_1arg(fspnotify, (uintptr_t)¬ify_params); |
| 71 | else |
| 72 | ret = fspnotify(¬ify_params); |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 73 | |
Angel Pons | 355d844 | 2022-01-01 17:03:10 +0100 | [diff] [blame^] | 74 | timestamp_add_now(data->timestamp_after); |
| 75 | post_code(data->post_code_after); |
| 76 | |
Lee Leahy | 672df16 | 2016-07-24 18:21:13 -0700 | [diff] [blame] | 77 | fsp_debug_after_notify(ret); |
Alexandru Gagniuc | 010225c | 2016-05-06 08:22:45 -0700 | [diff] [blame] | 78 | |
Lee Leahy | 9671faa | 2016-07-24 18:18:52 -0700 | [diff] [blame] | 79 | /* Handle any errors returned by FspNotify */ |
| 80 | fsp_handle_reset(ret); |
Angel Pons | 2b1f8d4 | 2022-01-01 17:20:00 +0100 | [diff] [blame] | 81 | if (ret != FSP_SUCCESS) |
| 82 | die("FspNotify returned with error 0x%08x!\n", ret); |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 83 | |
| 84 | /* Allow the platform to run something after FspNotify */ |
| 85 | platform_fsp_notify_status(phase); |
| 86 | } |
| 87 | |
| 88 | static void fsp_notify_dummy(void *arg) |
| 89 | { |
Patrick Rudolph | 90fda02 | 2020-11-30 13:44:17 +0100 | [diff] [blame] | 90 | enum fsp_notify_phase phase = (uint32_t)(uintptr_t)arg; |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 91 | |
Nico Huber | d67edca | 2018-11-13 19:28:07 +0100 | [diff] [blame] | 92 | display_mtrrs(); |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 93 | |
| 94 | fsp_notify(phase); |
| 95 | if (phase == READY_TO_BOOT) |
| 96 | fsp_notify(END_OF_FIRMWARE); |
| 97 | } |
| 98 | |
Angel Pons | 654930e | 2022-01-01 17:08:00 +0100 | [diff] [blame] | 99 | BOOT_STATE_INIT_ENTRY(BS_DEV_ENABLE, BS_ON_ENTRY, fsp_notify_dummy, (void *)AFTER_PCI_ENUM); |
| 100 | BOOT_STATE_INIT_ENTRY(BS_PAYLOAD_LOAD, BS_ON_EXIT, fsp_notify_dummy, (void *)READY_TO_BOOT); |
| 101 | BOOT_STATE_INIT_ENTRY(BS_OS_RESUME, BS_ON_ENTRY, fsp_notify_dummy, (void *)READY_TO_BOOT); |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 102 | |
Angel Pons | 654930e | 2022-01-01 17:08:00 +0100 | [diff] [blame] | 103 | __weak void platform_fsp_notify_status(enum fsp_notify_phase phase) |
Lee Leahy | 806fa24 | 2016-08-01 13:55:02 -0700 | [diff] [blame] | 104 | { |
Andrey Petrov | 9de55cc | 2016-02-25 14:19:07 -0800 | [diff] [blame] | 105 | } |