1 // SPDX-License-Identifier: GPL-2.0
2 #if defined(__i386__) || defined(__x86_64__)
3 #include <unistd.h>
4 #include <errno.h>
5 #include <stdio.h>
6 #include <stdint.h>
7
8 #include <pci/pci.h>
9
10 #include "helpers/helpers.h"
11 #include "cpufreq.h"
12 #include "acpi_cppc.h"
13
14 /* ACPI P-States Helper Functions for AMD Processors ***************/
15 #define MSR_AMD_PSTATE_STATUS 0xc0010063
16 #define MSR_AMD_PSTATE 0xc0010064
17 #define MSR_AMD_PSTATE_LIMIT 0xc0010061
18
19 union core_pstate {
20 /* pre fam 17h: */
21 struct {
22 unsigned fid:6;
23 unsigned did:3;
24 unsigned vid:7;
25 unsigned res1:6;
26 unsigned nbdid:1;
27 unsigned res2:2;
28 unsigned nbvid:7;
29 unsigned iddval:8;
30 unsigned idddiv:2;
31 unsigned res3:21;
32 unsigned en:1;
33 } pstate;
34 /* since fam 17h: */
35 struct {
36 unsigned fid:8;
37 unsigned did:6;
38 unsigned vid:8;
39 unsigned iddval:8;
40 unsigned idddiv:2;
41 unsigned res1:31;
42 unsigned en:1;
43 } pstatedef;
44 /* since fam 1Ah: */
45 struct {
46 unsigned fid:12;
47 unsigned res1:2;
48 unsigned vid:8;
49 unsigned iddval:8;
50 unsigned idddiv:2;
51 unsigned res2:31;
52 unsigned en:1;
53 } pstatedef2;
54 unsigned long long val;
55 };
56
get_did(union core_pstate pstate)57 static int get_did(union core_pstate pstate)
58 {
59 int t;
60
61 /* Fam 1Ah onward do not use did */
62 if (cpupower_cpu_info.family >= 0x1A)
63 return 0;
64
65 if (cpupower_cpu_info.caps & CPUPOWER_CAP_AMD_PSTATEDEF)
66 t = pstate.pstatedef.did;
67 else if (cpupower_cpu_info.family == 0x12)
68 t = pstate.val & 0xf;
69 else
70 t = pstate.pstate.did;
71
72 return t;
73 }
74
get_cof(union core_pstate pstate)75 static int get_cof(union core_pstate pstate)
76 {
77 int t;
78 int fid, did, cof = 0;
79
80 did = get_did(pstate);
81 if (cpupower_cpu_info.caps & CPUPOWER_CAP_AMD_PSTATEDEF) {
82 if (cpupower_cpu_info.family >= 0x1A) {
83 fid = pstate.pstatedef2.fid;
84 if (fid > 0x0f)
85 cof = (fid * 5);
86 } else {
87 fid = pstate.pstatedef.fid;
88 cof = 200 * fid / did;
89 }
90 } else {
91 t = 0x10;
92 fid = pstate.pstate.fid;
93 if (cpupower_cpu_info.family == 0x11)
94 t = 0x8;
95 cof = (100 * (fid + t)) >> did;
96 }
97 return cof;
98 }
99
100 /* Needs:
101 * cpu -> the cpu that gets evaluated
102 * boost_states -> how much boost states the machines support
103 *
104 * Fills up:
105 * pstates -> a pointer to an array of size MAX_HW_PSTATES
106 * must be initialized with zeros.
107 * All available HW pstates (including boost states)
108 * no -> amount of pstates above array got filled up with
109 *
110 * returns zero on success, -1 on failure
111 */
decode_pstates(unsigned int cpu,int boost_states,unsigned long * pstates,int * no)112 int decode_pstates(unsigned int cpu, int boost_states,
113 unsigned long *pstates, int *no)
114 {
115 int i, psmax;
116 union core_pstate pstate;
117 unsigned long long val;
118
119 /* Only read out frequencies from HW if HW Pstate is supported,
120 * otherwise frequencies are exported via ACPI tables.
121 */
122 if (!(cpupower_cpu_info.caps & CPUPOWER_CAP_AMD_HW_PSTATE))
123 return -1;
124
125 if (read_msr(cpu, MSR_AMD_PSTATE_LIMIT, &val))
126 return -1;
127
128 psmax = (val >> 4) & 0x7;
129 psmax += boost_states;
130 for (i = 0; i <= psmax; i++) {
131 if (i >= MAX_HW_PSTATES) {
132 fprintf(stderr, "HW pstates [%d] exceeding max [%d]\n",
133 psmax, MAX_HW_PSTATES);
134 return -1;
135 }
136 if (read_msr(cpu, MSR_AMD_PSTATE + i, &pstate.val))
137 return -1;
138
139 /* The enabled bit (bit 63) is common for all families */
140 if (!pstate.pstatedef.en)
141 continue;
142
143 pstates[i] = get_cof(pstate);
144 }
145 *no = i;
146 return 0;
147 }
148
amd_pci_get_num_boost_states(int * active,int * states)149 int amd_pci_get_num_boost_states(int *active, int *states)
150 {
151 struct pci_access *pci_acc;
152 struct pci_dev *device;
153 uint8_t val = 0;
154
155 *active = *states = 0;
156
157 device = pci_slot_func_init(&pci_acc, 0x18, 4);
158
159 if (device == NULL)
160 return -ENODEV;
161
162 val = pci_read_byte(device, 0x15c);
163 if (val & 3)
164 *active = 1;
165 else
166 *active = 0;
167 *states = (val >> 2) & 7;
168
169 pci_cleanup(pci_acc);
170 return 0;
171 }
172
173 /* ACPI P-States Helper Functions for AMD Processors ***************/
174
175 /* AMD P-State Helper Functions ************************************/
176 enum amd_pstate_value {
177 AMD_PSTATE_HIGHEST_PERF,
178 AMD_PSTATE_MAX_FREQ,
179 AMD_PSTATE_LOWEST_NONLINEAR_FREQ,
180 MAX_AMD_PSTATE_VALUE_READ_FILES,
181 };
182
183 static const char *amd_pstate_value_files[MAX_AMD_PSTATE_VALUE_READ_FILES] = {
184 [AMD_PSTATE_HIGHEST_PERF] = "amd_pstate_highest_perf",
185 [AMD_PSTATE_MAX_FREQ] = "amd_pstate_max_freq",
186 [AMD_PSTATE_LOWEST_NONLINEAR_FREQ] = "amd_pstate_lowest_nonlinear_freq",
187 };
188
amd_pstate_get_data(unsigned int cpu,enum amd_pstate_value value)189 static unsigned long amd_pstate_get_data(unsigned int cpu,
190 enum amd_pstate_value value)
191 {
192 return cpufreq_get_sysfs_value_from_table(cpu,
193 amd_pstate_value_files,
194 value,
195 MAX_AMD_PSTATE_VALUE_READ_FILES);
196 }
197
amd_pstate_boost_init(unsigned int cpu,int * support,int * active)198 void amd_pstate_boost_init(unsigned int cpu, int *support, int *active)
199 {
200 unsigned long highest_perf, nominal_perf, cpuinfo_min,
201 cpuinfo_max, amd_pstate_max;
202
203 highest_perf = amd_pstate_get_data(cpu, AMD_PSTATE_HIGHEST_PERF);
204 nominal_perf = acpi_cppc_get_data(cpu, NOMINAL_PERF);
205
206 *support = highest_perf > nominal_perf ? 1 : 0;
207 if (!(*support))
208 return;
209
210 cpufreq_get_hardware_limits(cpu, &cpuinfo_min, &cpuinfo_max);
211 amd_pstate_max = amd_pstate_get_data(cpu, AMD_PSTATE_MAX_FREQ);
212
213 *active = cpuinfo_max == amd_pstate_max ? 1 : 0;
214 }
215
amd_pstate_show_perf_and_freq(unsigned int cpu,int no_rounding)216 void amd_pstate_show_perf_and_freq(unsigned int cpu, int no_rounding)
217 {
218 printf(_(" AMD PSTATE Highest Performance: %lu. Maximum Frequency: "),
219 amd_pstate_get_data(cpu, AMD_PSTATE_HIGHEST_PERF));
220 /*
221 * If boost isn't active, the cpuinfo_max doesn't indicate real max
222 * frequency. So we read it back from amd-pstate sysfs entry.
223 */
224 print_speed(amd_pstate_get_data(cpu, AMD_PSTATE_MAX_FREQ), no_rounding);
225 printf(".\n");
226
227 printf(_(" AMD PSTATE Nominal Performance: %lu. Nominal Frequency: "),
228 acpi_cppc_get_data(cpu, NOMINAL_PERF));
229 print_speed(acpi_cppc_get_data(cpu, NOMINAL_FREQ) * 1000,
230 no_rounding);
231 printf(".\n");
232
233 printf(_(" AMD PSTATE Lowest Non-linear Performance: %lu. Lowest Non-linear Frequency: "),
234 acpi_cppc_get_data(cpu, LOWEST_NONLINEAR_PERF));
235 print_speed(amd_pstate_get_data(cpu, AMD_PSTATE_LOWEST_NONLINEAR_FREQ),
236 no_rounding);
237 printf(".\n");
238
239 printf(_(" AMD PSTATE Lowest Performance: %lu. Lowest Frequency: "),
240 acpi_cppc_get_data(cpu, LOWEST_PERF));
241 print_speed(acpi_cppc_get_data(cpu, LOWEST_FREQ) * 1000, no_rounding);
242 printf(".\n");
243 }
244
245 /* AMD P-State Helper Functions ************************************/
246 #endif /* defined(__i386__) || defined(__x86_64__) */
247