1// SPDX-License-Identifier: GPL-2.0
2
3#include <stdio.h>
4#include <errno.h>
5#include <stdlib.h>
6#include <string.h>
7
8#include "helpers/helpers.h"
9#include "helpers/sysfs.h"
10#include "cpufreq.h"
11
12#if defined(__i386__) || defined(__x86_64__)
13
14#include "cpupower_intern.h"
15
16#define MSR_AMD_HWCR	0xc0010015
17
18int cpufreq_has_boost_support(unsigned int cpu, int *support, int *active,
19			int *states)
20{
21	int ret;
22	unsigned long long val;
23
24	*support = *active = *states = 0;
25
26	if (cpupower_cpu_info.caps & CPUPOWER_CAP_AMD_CPB) {
27		*support = 1;
28
29		/* AMD Family 0x17 does not utilize PCI D18F4 like prior
30		 * families and has no fixed discrete boost states but
31		 * has Hardware determined variable increments instead.
32		 */
33
34		if (cpupower_cpu_info.caps & CPUPOWER_CAP_AMD_CPB_MSR) {
35			if (!read_msr(cpu, MSR_AMD_HWCR, &val)) {
36				if (!(val & CPUPOWER_AMD_CPBDIS))
37					*active = 1;
38			}
39		} else {
40			ret = amd_pci_get_num_boost_states(active, states);
41			if (ret)
42				return ret;
43		}
44	} else if (cpupower_cpu_info.caps & CPUPOWER_CAP_AMD_PSTATE) {
45		amd_pstate_boost_init(cpu, support, active);
46	} else if (cpupower_cpu_info.caps & CPUPOWER_CAP_INTEL_IDA)
47		*support = *active = 1;
48	return 0;
49}
50
51int cpupower_intel_get_perf_bias(unsigned int cpu)
52{
53	char linebuf[MAX_LINE_LEN];
54	char path[SYSFS_PATH_MAX];
55	unsigned long val;
56	char *endp;
57
58	if (!(cpupower_cpu_info.caps & CPUPOWER_CAP_PERF_BIAS))
59		return -1;
60
61	snprintf(path, sizeof(path), PATH_TO_CPU "cpu%u/power/energy_perf_bias", cpu);
62
63	if (cpupower_read_sysfs(path, linebuf, MAX_LINE_LEN) == 0)
64		return -1;
65
66	val = strtol(linebuf, &endp, 0);
67	if (endp == linebuf || errno == ERANGE)
68		return -1;
69
70	return val;
71}
72
73int cpupower_intel_set_perf_bias(unsigned int cpu, unsigned int val)
74{
75	char path[SYSFS_PATH_MAX];
76	char linebuf[3] = {};
77
78	if (!(cpupower_cpu_info.caps & CPUPOWER_CAP_PERF_BIAS))
79		return -1;
80
81	snprintf(path, sizeof(path), PATH_TO_CPU "cpu%u/power/energy_perf_bias", cpu);
82	snprintf(linebuf, sizeof(linebuf), "%d", val);
83
84	if (cpupower_write_sysfs(path, linebuf, 3) <= 0)
85		return -1;
86
87	return 0;
88}
89
90int cpupower_set_epp(unsigned int cpu, char *epp)
91{
92	char path[SYSFS_PATH_MAX];
93	char linebuf[30] = {};
94
95	snprintf(path, sizeof(path),
96		PATH_TO_CPU "cpu%u/cpufreq/energy_performance_preference", cpu);
97
98	if (!is_valid_path(path))
99		return -1;
100
101	snprintf(linebuf, sizeof(linebuf), "%s", epp);
102
103	if (cpupower_write_sysfs(path, linebuf, 30) <= 0)
104		return -1;
105
106	return 0;
107}
108
109int cpupower_set_amd_pstate_mode(char *mode)
110{
111	char path[SYSFS_PATH_MAX];
112	char linebuf[20] = {};
113
114	snprintf(path, sizeof(path), PATH_TO_CPU "amd_pstate/status");
115
116	if (!is_valid_path(path))
117		return -1;
118
119	snprintf(linebuf, sizeof(linebuf), "%s\n", mode);
120
121	if (cpupower_write_sysfs(path, linebuf, 20) <= 0)
122		return -1;
123
124	return 0;
125}
126
127int cpupower_set_turbo_boost(int turbo_boost)
128{
129	char path[SYSFS_PATH_MAX];
130	char linebuf[2] = {};
131
132	snprintf(path, sizeof(path), PATH_TO_CPU "cpufreq/boost");
133
134	if (!is_valid_path(path))
135		return -1;
136
137	snprintf(linebuf, sizeof(linebuf), "%d", turbo_boost);
138
139	if (cpupower_write_sysfs(path, linebuf, 2) <= 0)
140		return -1;
141
142	return 0;
143}
144
145bool cpupower_amd_pstate_enabled(void)
146{
147	char *driver = cpufreq_get_driver(0);
148	bool ret = false;
149
150	if (!driver)
151		return ret;
152
153	if (!strncmp(driver, "amd", 3))
154		ret = true;
155
156	cpufreq_put_driver(driver);
157
158	return ret;
159}
160
161#endif /* #if defined(__i386__) || defined(__x86_64__) */
162
163/* get_cpustate
164 *
165 * Gather the information of all online CPUs into bitmask struct
166 */
167void get_cpustate(void)
168{
169	unsigned int cpu = 0;
170
171	bitmask_clearall(online_cpus);
172	bitmask_clearall(offline_cpus);
173
174	for (cpu = bitmask_first(cpus_chosen);
175		cpu <= bitmask_last(cpus_chosen); cpu++) {
176
177		if (cpupower_is_cpu_online(cpu) == 1)
178			bitmask_setbit(online_cpus, cpu);
179		else
180			bitmask_setbit(offline_cpus, cpu);
181
182		continue;
183	}
184}
185
186/* print_online_cpus
187 *
188 * Print the CPU numbers of all CPUs that are online currently
189 */
190void print_online_cpus(void)
191{
192	int str_len = 0;
193	char *online_cpus_str = NULL;
194
195	str_len = online_cpus->size * 5;
196	online_cpus_str = (void *)malloc(sizeof(char) * str_len);
197
198	if (!bitmask_isallclear(online_cpus)) {
199		bitmask_displaylist(online_cpus_str, str_len, online_cpus);
200		printf(_("Following CPUs are online:\n%s\n"), online_cpus_str);
201	}
202}
203
204/* print_offline_cpus
205 *
206 * Print the CPU numbers of all CPUs that are offline currently
207 */
208void print_offline_cpus(void)
209{
210	int str_len = 0;
211	char *offline_cpus_str = NULL;
212
213	str_len = offline_cpus->size * 5;
214	offline_cpus_str = (void *)malloc(sizeof(char) * str_len);
215
216	if (!bitmask_isallclear(offline_cpus)) {
217		bitmask_displaylist(offline_cpus_str, str_len, offline_cpus);
218		printf(_("Following CPUs are offline:\n%s\n"), offline_cpus_str);
219		printf(_("cpupower set operation was not performed on them\n"));
220	}
221}
222
223/*
224 * print_speed
225 *
226 * Print the exact CPU frequency with appropriate unit
227 */
228void print_speed(unsigned long speed, int no_rounding)
229{
230	unsigned long tmp;
231
232	if (no_rounding) {
233		if (speed > 1000000)
234			printf("%u.%06u GHz", ((unsigned int)speed / 1000000),
235			       ((unsigned int)speed % 1000000));
236		else if (speed > 1000)
237			printf("%u.%03u MHz", ((unsigned int)speed / 1000),
238			       (unsigned int)(speed % 1000));
239		else
240			printf("%lu kHz", speed);
241	} else {
242		if (speed > 1000000) {
243			tmp = speed % 10000;
244			if (tmp >= 5000)
245				speed += 10000;
246			printf("%u.%02u GHz", ((unsigned int)speed / 1000000),
247			       ((unsigned int)(speed % 1000000) / 10000));
248		} else if (speed > 100000) {
249			tmp = speed % 1000;
250			if (tmp >= 500)
251				speed += 1000;
252			printf("%u MHz", ((unsigned int)speed / 1000));
253		} else if (speed > 1000) {
254			tmp = speed % 100;
255			if (tmp >= 50)
256				speed += 100;
257			printf("%u.%01u MHz", ((unsigned int)speed / 1000),
258			       ((unsigned int)(speed % 1000) / 100));
259		}
260	}
261}
262