Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-or-later */ |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 2 | #include <acpi/acpi.h> |
Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 3 | #include <acpi/acpigen.h> |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 4 | #include <bootstate.h> |
| 5 | #include <commonlib/sort.h> |
Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 6 | #include <cpu/x86/lapic.h> |
| 7 | #include <cpu/x86/mp.h> |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 8 | #include <cpu/cpu.h> |
| 9 | #include <device/path.h> |
| 10 | #include <intelblocks/acpi.h> |
| 11 | #include <soc/cpu.h> |
Elyes Haouas | bdd03c2 | 2024-05-27 11:20:07 +0200 | [diff] [blame^] | 12 | #include <stdio.h> |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 13 | #include <types.h> |
Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 14 | |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 15 | #define CPPC_NOM_FREQ_IDX 22 |
| 16 | #define CPPC_NOM_PERF_IDX 3 |
| 17 | |
Sridhar Siricilla | 51c75ac | 2022-01-29 14:26:22 +0530 | [diff] [blame] | 18 | enum cpu_perf_eff_type { |
Sridhar Siricilla | 4c3014f | 2023-01-03 11:29:08 +0530 | [diff] [blame] | 19 | CPU_TYPE_EFF, |
| 20 | CPU_TYPE_PERF, |
Sridhar Siricilla | 51c75ac | 2022-01-29 14:26:22 +0530 | [diff] [blame] | 21 | }; |
| 22 | |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 23 | struct cpu_apic_info_type { |
| 24 | /* |
| 25 | * Ordered APIC IDs based on core type. |
| 26 | * Array begins with Performance Cores' APIC IDs, |
| 27 | * then followed by Efficeint Cores's APIC IDs. |
| 28 | */ |
| 29 | int32_t apic_ids[CONFIG_MAX_CPUS]; |
Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 30 | |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 31 | /* Total CPU count */ |
Sridhar Siricilla | 02b39ef | 2023-04-09 17:40:43 +0530 | [diff] [blame] | 32 | uint16_t total_cpu_cnt; |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 33 | |
| 34 | /* |
| 35 | * Total Performance core count. This will be used |
| 36 | * to identify the start of Efficient Cores's |
| 37 | * APIC ID list |
| 38 | */ |
Sridhar Siricilla | 02b39ef | 2023-04-09 17:40:43 +0530 | [diff] [blame] | 39 | uint16_t perf_cpu_cnt; |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 40 | }; |
| 41 | |
| 42 | static struct cpu_apic_info_type cpu_apic_info; |
| 43 | |
| 44 | /* |
| 45 | * The function orders APIC IDs such that orders first Performance cores and then |
| 46 | * Efficient cores' APIC IDs in ascending order. Also calculates total number of |
| 47 | * Performance cores and all cores count in the system and populates the information |
| 48 | * in the cpu_apic_info sturct. |
| 49 | */ |
| 50 | static void acpi_set_hybrid_cpu_apicid_order(void *unused) |
Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 51 | { |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 52 | size_t perf_core_cnt = 0, eff_core_cnt = 0; |
| 53 | int32_t eff_apic_ids[CONFIG_MAX_CPUS] = {0}; |
| 54 | extern struct cpu_info cpu_infos[]; |
| 55 | uint32_t i, j = 0; |
| 56 | |
| 57 | for (i = 0; i < ARRAY_SIZE(cpu_apic_info.apic_ids); i++) { |
Jeremy Compostella | ba7a9ee | 2023-09-01 16:17:51 -0700 | [diff] [blame] | 58 | if (!cpu_infos[i].cpu) |
| 59 | continue; |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 60 | if (cpu_infos[i].cpu->path.apic.core_type == CPU_TYPE_PERF) |
| 61 | cpu_apic_info.apic_ids[perf_core_cnt++] = |
| 62 | cpu_infos[i].cpu->path.apic.apic_id; |
| 63 | else |
| 64 | eff_apic_ids[eff_core_cnt++] = |
| 65 | cpu_infos[i].cpu->path.apic.apic_id; |
| 66 | } |
| 67 | |
| 68 | if (perf_core_cnt > 1) |
| 69 | bubblesort(cpu_apic_info.apic_ids, perf_core_cnt, NUM_ASCENDING); |
| 70 | |
| 71 | for (i = perf_core_cnt; j < eff_core_cnt; i++, j++) |
| 72 | cpu_apic_info.apic_ids[i] = eff_apic_ids[j]; |
| 73 | |
| 74 | if (eff_core_cnt > 1) |
| 75 | bubblesort(&cpu_apic_info.apic_ids[perf_core_cnt], eff_core_cnt, NUM_ASCENDING); |
| 76 | |
| 77 | /* Populate total core count */ |
| 78 | cpu_apic_info.total_cpu_cnt = perf_core_cnt + eff_core_cnt; |
| 79 | |
| 80 | cpu_apic_info.perf_cpu_cnt = perf_core_cnt; |
Sridahr Siricilla | cd1cd8d | 2021-11-11 01:29:40 +0530 | [diff] [blame] | 81 | } |
| 82 | |
Sridhar Siricilla | 7301cfa | 2023-01-19 18:50:09 +0530 | [diff] [blame] | 83 | static unsigned long acpi_create_madt_lapics_hybrid(unsigned long current) |
| 84 | { |
| 85 | size_t index; |
| 86 | |
Kyösti Mälkki | 2e9f0d3 | 2023-04-07 23:05:46 +0300 | [diff] [blame] | 87 | for (index = 0; index < cpu_apic_info.total_cpu_cnt; index++) |
| 88 | current = acpi_create_madt_one_lapic(current, index, |
| 89 | cpu_apic_info.apic_ids[index]); |
Sridhar Siricilla | 7301cfa | 2023-01-19 18:50:09 +0530 | [diff] [blame] | 90 | |
| 91 | return current; |
| 92 | } |
| 93 | |
| 94 | unsigned long acpi_create_madt_lapics_with_nmis_hybrid(unsigned long current) |
| 95 | { |
Sridhar Siricilla | 7301cfa | 2023-01-19 18:50:09 +0530 | [diff] [blame] | 96 | current = acpi_create_madt_lapics_hybrid(current); |
Kyösti Mälkki | 9ac1fb7 | 2023-04-07 22:39:53 +0300 | [diff] [blame] | 97 | current = acpi_create_madt_lapic_nmis(current); |
Sridhar Siricilla | 7301cfa | 2023-01-19 18:50:09 +0530 | [diff] [blame] | 98 | return current; |
| 99 | } |
| 100 | |
Sridhar Siricilla | 1b04e81 | 2023-03-30 09:51:28 +0530 | [diff] [blame] | 101 | static enum cpu_perf_eff_type get_core_type(void) |
| 102 | { |
| 103 | return (get_soc_cpu_type() == CPUID_CORE_TYPE_INTEL_CORE) ? |
| 104 | CPU_TYPE_PERF : CPU_TYPE_EFF; |
| 105 | } |
| 106 | |
| 107 | void set_dev_core_type(void) |
| 108 | { |
| 109 | struct cpu_info *info = cpu_info(); |
| 110 | info->cpu->path.apic.core_type = get_core_type(); |
| 111 | } |
| 112 | |
Sridhar Siricilla | 4c3014f | 2023-01-03 11:29:08 +0530 | [diff] [blame] | 113 | static void acpi_get_cpu_nomi_perf(u16 *eff_core_nom_perf, u16 *perf_core_nom_perf) |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 114 | { |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 115 | u8 max_non_turbo_ratio = cpu_get_max_non_turbo_ratio(); |
| 116 | |
Sridhar Siricilla | d9c8269 | 2023-01-05 17:08:17 +0530 | [diff] [blame] | 117 | _Static_assert(CONFIG_SOC_INTEL_PERFORMANCE_CORE_SCALE_FACTOR != 0, |
| 118 | "CONFIG_SOC_INTEL_PERFORMANCE_CORE_SCALE_FACTOR must not be zero"); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 119 | |
Sridhar Siricilla | d9c8269 | 2023-01-05 17:08:17 +0530 | [diff] [blame] | 120 | _Static_assert(CONFIG_SOC_INTEL_EFFICIENT_CORE_SCALE_FACTOR != 0, |
| 121 | "CONFIG_SOC_INTEL_EFFICIENT_CORE_SCALE_FACTOR must not be zero"); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 122 | |
Sridhar Siricilla | d9c8269 | 2023-01-05 17:08:17 +0530 | [diff] [blame] | 123 | *perf_core_nom_perf = (u16)((max_non_turbo_ratio * |
| 124 | CONFIG_SOC_INTEL_PERFORMANCE_CORE_SCALE_FACTOR) / 100); |
| 125 | |
| 126 | *eff_core_nom_perf = (u16)((max_non_turbo_ratio * |
| 127 | CONFIG_SOC_INTEL_EFFICIENT_CORE_SCALE_FACTOR) / 100); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 128 | } |
| 129 | |
| 130 | static u16 acpi_get_cpu_nominal_freq(void) |
| 131 | { |
| 132 | return cpu_get_max_non_turbo_ratio() * cpu_get_bus_frequency(); |
| 133 | } |
| 134 | |
| 135 | /* Updates Nominal Frequency and Nominal Performance */ |
| 136 | static void acpigen_cppc_update_nominal_freq_perf(const char *pkg_path, s32 core_id) |
| 137 | { |
Sridhar Siricilla | 4c3014f | 2023-01-03 11:29:08 +0530 | [diff] [blame] | 138 | u16 eff_core_nom_perf, perf_core_nom_perf; |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 139 | |
| 140 | if (!soc_is_nominal_freq_supported()) |
| 141 | return; |
| 142 | |
Sridhar Siricilla | 4c3014f | 2023-01-03 11:29:08 +0530 | [diff] [blame] | 143 | acpi_get_cpu_nomi_perf(&eff_core_nom_perf, &perf_core_nom_perf); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 144 | |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 145 | if (core_id < cpu_apic_info.perf_cpu_cnt) |
Sridhar Siricilla | 4c3014f | 2023-01-03 11:29:08 +0530 | [diff] [blame] | 146 | acpigen_set_package_element_int(pkg_path, CPPC_NOM_PERF_IDX, perf_core_nom_perf); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 147 | else |
| 148 | acpigen_set_package_element_int(pkg_path, CPPC_NOM_PERF_IDX, |
Sridhar Siricilla | 4c3014f | 2023-01-03 11:29:08 +0530 | [diff] [blame] | 149 | eff_core_nom_perf); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 150 | |
| 151 | /* Update CPU's nominal frequency */ |
| 152 | acpigen_set_package_element_int(pkg_path, CPPC_NOM_FREQ_IDX, |
| 153 | acpi_get_cpu_nominal_freq()); |
| 154 | } |
| 155 | |
| 156 | void acpigen_write_CPPC_hybrid_method(s32 core_id) |
| 157 | { |
| 158 | char pkg_path[16]; |
| 159 | |
| 160 | if (core_id == 0) |
| 161 | snprintf(pkg_path, sizeof(pkg_path), CPPC_PACKAGE_NAME, 0); |
| 162 | else |
| 163 | snprintf(pkg_path, sizeof(pkg_path), |
Felix Held | f0a8b04 | 2023-05-12 15:55:06 +0200 | [diff] [blame] | 164 | "\\_SB." CONFIG_ACPI_CPU_STRING "." CPPC_PACKAGE_NAME, 0); |
Sridhar Siricilla | 1173612 | 2021-11-15 17:12:49 +0530 | [diff] [blame] | 165 | |
| 166 | acpigen_write_method("_CPC", 0); |
| 167 | |
| 168 | /* Update nominal performance and nominal frequency */ |
| 169 | acpigen_cppc_update_nominal_freq_perf(pkg_path, core_id); |
| 170 | acpigen_emit_byte(RETURN_OP); |
| 171 | acpigen_emit_namestring(pkg_path); |
| 172 | acpigen_pop_len(); |
| 173 | } |
| 174 | |
Sridhar Siricilla | f8ac3dd | 2023-03-30 11:25:36 +0530 | [diff] [blame] | 175 | BOOT_STATE_INIT_ENTRY(BS_DEV_INIT_CHIPS, BS_ON_EXIT, acpi_set_hybrid_cpu_apicid_order, NULL); |