xref: /linux/drivers/acpi/cppc_acpi.c (revision d7c8087a9cd8979d70edfe7c7feda9423feae3ab)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * CPPC (Collaborative Processor Performance Control) methods used by CPUfreq drivers.
4  *
5  * (C) Copyright 2014, 2015 Linaro Ltd.
6  * Author: Ashwin Chaugule <ashwin.chaugule@linaro.org>
7  *
8  * CPPC describes a few methods for controlling CPU performance using
9  * information from a per CPU table called CPC. This table is described in
10  * the ACPI v5.0+ specification. The table consists of a list of
11  * registers which may be memory mapped or hardware registers and also may
12  * include some static integer values.
13  *
14  * CPU performance is on an abstract continuous scale as against a discretized
15  * P-state scale which is tied to CPU frequency only. In brief, the basic
16  * operation involves:
17  *
18  * - OS makes a CPU performance request. (Can provide min and max bounds)
19  *
20  * - Platform (such as BMC) is free to optimize request within requested bounds
21  *   depending on power/thermal budgets etc.
22  *
23  * - Platform conveys its decision back to OS
24  *
25  * The communication between OS and platform occurs through another medium
26  * called (PCC) Platform Communication Channel. This is a generic mailbox like
27  * mechanism which includes doorbell semantics to indicate register updates.
28  * See drivers/mailbox/pcc.c for details on PCC.
29  *
30  * Finer details about the PCC and CPPC spec are available in the ACPI v5.1 and
31  * above specifications.
32  */
33 
34 #define pr_fmt(fmt)	"ACPI CPPC: " fmt
35 
36 #include <linux/delay.h>
37 #include <linux/iopoll.h>
38 #include <linux/ktime.h>
39 #include <linux/rwsem.h>
40 #include <linux/wait.h>
41 #include <linux/topology.h>
42 #include <linux/dmi.h>
43 #include <linux/units.h>
44 #include <linux/unaligned.h>
45 
46 #include <acpi/cppc_acpi.h>
47 
48 struct cppc_pcc_data {
49 	struct pcc_mbox_chan *pcc_channel;
50 	bool pcc_channel_acquired;
51 	unsigned int deadline_us;
52 	unsigned int pcc_mpar, pcc_mrtt, pcc_nominal;
53 
54 	bool pending_pcc_write_cmd;	/* Any pending/batched PCC write cmds? */
55 	bool platform_owns_pcc;		/* Ownership of PCC subspace */
56 	unsigned int pcc_write_cnt;	/* Running count of PCC write commands */
57 
58 	/*
59 	 * Lock to provide controlled access to the PCC channel.
60 	 *
61 	 * For performance critical usecases(currently cppc_set_perf)
62 	 *	We need to take read_lock and check if channel belongs to OSPM
63 	 * before reading or writing to PCC subspace
64 	 *	We need to take write_lock before transferring the channel
65 	 * ownership to the platform via a Doorbell
66 	 *	This allows us to batch a number of CPPC requests if they happen
67 	 * to originate in about the same time
68 	 *
69 	 * For non-performance critical usecases(init)
70 	 *	Take write_lock for all purposes which gives exclusive access
71 	 */
72 	struct rw_semaphore pcc_lock;
73 
74 	/* Wait queue for CPUs whose requests were batched */
75 	wait_queue_head_t pcc_write_wait_q;
76 	ktime_t last_cmd_cmpl_time;
77 	ktime_t last_mpar_reset;
78 	int mpar_count;
79 	int refcount;
80 };
81 
82 /* Array to represent the PCC channel per subspace ID */
83 static struct cppc_pcc_data *pcc_data[MAX_PCC_SUBSPACES];
84 /* The cpu_pcc_subspace_idx contains per CPU subspace ID */
85 static DEFINE_PER_CPU(int, cpu_pcc_subspace_idx);
86 
87 /*
88  * The cpc_desc structure contains the ACPI register details
89  * as described in the per CPU _CPC tables. The details
90  * include the type of register (e.g. PCC, System IO, FFH etc.)
91  * and destination addresses which lets us READ/WRITE CPU performance
92  * information using the appropriate I/O methods.
93  */
94 static DEFINE_PER_CPU(struct cpc_desc *, cpc_desc_ptr);
95 
96 /* pcc mapped address + header size + offset within PCC subspace */
97 #define GET_PCC_VADDR(offs, pcc_ss_id) (pcc_data[pcc_ss_id]->pcc_channel->shmem + \
98 						0x8 + (offs))
99 
100 /* Check if a CPC register is in PCC */
101 #define CPC_IN_PCC(cpc) ((cpc)->type == ACPI_TYPE_BUFFER &&		\
102 				(cpc)->cpc_entry.reg.space_id ==	\
103 				ACPI_ADR_SPACE_PLATFORM_COMM)
104 
105 /* Check if a CPC register is in FFH */
106 #define CPC_IN_FFH(cpc) ((cpc)->type == ACPI_TYPE_BUFFER &&		\
107 				(cpc)->cpc_entry.reg.space_id ==	\
108 				ACPI_ADR_SPACE_FIXED_HARDWARE)
109 
110 /* Check if a CPC register is in SystemMemory */
111 #define CPC_IN_SYSTEM_MEMORY(cpc) ((cpc)->type == ACPI_TYPE_BUFFER &&	\
112 				(cpc)->cpc_entry.reg.space_id ==	\
113 				ACPI_ADR_SPACE_SYSTEM_MEMORY)
114 
115 /* Check if a CPC register is in SystemIo */
116 #define CPC_IN_SYSTEM_IO(cpc) ((cpc)->type == ACPI_TYPE_BUFFER &&	\
117 				(cpc)->cpc_entry.reg.space_id ==	\
118 				ACPI_ADR_SPACE_SYSTEM_IO)
119 
120 /* Evaluates to True if reg is a NULL register descriptor */
121 #define IS_NULL_REG(reg) ((reg)->space_id ==  ACPI_ADR_SPACE_SYSTEM_MEMORY && \
122 				(reg)->address == 0 &&			\
123 				(reg)->bit_width == 0 &&		\
124 				(reg)->bit_offset == 0 &&		\
125 				(reg)->access_width == 0)
126 
127 /* Evaluates to True if an optional cpc field is supported */
128 #define CPC_SUPPORTED(cpc) ((cpc)->type == ACPI_TYPE_INTEGER ?		\
129 				!!(cpc)->cpc_entry.int_value :		\
130 				!IS_NULL_REG(&(cpc)->cpc_entry.reg))
131 
132 /*
133  * Each bit indicates the optionality of the register in per-cpu
134  * cpc_regs[] with the corresponding index. 0 means mandatory and 1
135  * means optional.
136  */
137 #define REG_OPTIONAL (0x1FC7D0)
138 
139 /*
140  * Use the index of the register in per-cpu cpc_regs[] to check if
141  * it's an optional one.
142  */
143 #define IS_OPTIONAL_CPC_REG(reg_idx) (REG_OPTIONAL & (1U << (reg_idx)))
144 
145 /*
146  * Arbitrary Retries in case the remote processor is slow to respond
147  * to PCC commands. Keeping it high enough to cover emulators where
148  * the processors run painfully slow.
149  */
150 #define NUM_RETRIES 500ULL
151 
152 #define OVER_16BTS_MASK ~0xFFFFULL
153 
154 #define define_one_cppc_ro(_name)		\
155 static struct kobj_attribute _name =		\
156 __ATTR(_name, 0444, show_##_name, NULL)
157 
158 #define to_cpc_desc(a) container_of(a, struct cpc_desc, kobj)
159 
160 #define show_cppc_data(access_fn, struct_name, member_name)		\
161 	static ssize_t show_##member_name(struct kobject *kobj,		\
162 				struct kobj_attribute *attr, char *buf)	\
163 	{								\
164 		struct cpc_desc *cpc_ptr = to_cpc_desc(kobj);		\
165 		struct struct_name st_name = {0};			\
166 		int ret;						\
167 									\
168 		ret = access_fn(cpc_ptr->cpu_id, &st_name);		\
169 		if (ret)						\
170 			return ret;					\
171 									\
172 		return sysfs_emit(buf, "%llu\n",		\
173 				(u64)st_name.member_name);		\
174 	}								\
175 	define_one_cppc_ro(member_name)
176 
177 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, highest_perf);
178 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, lowest_perf);
179 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, nominal_perf);
180 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, reference_perf);
181 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, lowest_nonlinear_perf);
182 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, guaranteed_perf);
183 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, lowest_freq);
184 show_cppc_data(cppc_get_perf_caps, cppc_perf_caps, nominal_freq);
185 
186 show_cppc_data(cppc_get_perf_ctrs, cppc_perf_fb_ctrs, wraparound_time);
187 
188 /* Check for valid access_width, otherwise, fallback to using bit_width */
189 #define GET_BIT_WIDTH(reg) ((reg)->access_width ? (8 << ((reg)->access_width - 1)) : (reg)->bit_width)
190 
191 /* Shift and apply the mask for CPC reads/writes */
192 #define MASK_VAL_READ(reg, val) (((val) >> (reg)->bit_offset) &				\
193 					GENMASK(((reg)->bit_width) - 1, 0))
194 #define MASK_VAL_WRITE(reg, prev_val, val)						\
195 	((((val) & GENMASK(((reg)->bit_width) - 1, 0)) << (reg)->bit_offset) |		\
196 	((prev_val) & ~(GENMASK(((reg)->bit_width) - 1, 0) << (reg)->bit_offset)))	\
197 
show_feedback_ctrs(struct kobject * kobj,struct kobj_attribute * attr,char * buf)198 static ssize_t show_feedback_ctrs(struct kobject *kobj,
199 		struct kobj_attribute *attr, char *buf)
200 {
201 	struct cpc_desc *cpc_ptr = to_cpc_desc(kobj);
202 	struct cppc_perf_fb_ctrs fb_ctrs = {0};
203 	int ret;
204 
205 	ret = cppc_get_perf_ctrs(cpc_ptr->cpu_id, &fb_ctrs);
206 	if (ret)
207 		return ret;
208 
209 	return sysfs_emit(buf, "ref:%llu del:%llu\n",
210 			fb_ctrs.reference, fb_ctrs.delivered);
211 }
212 define_one_cppc_ro(feedback_ctrs);
213 
214 static struct attribute *cppc_attrs[] = {
215 	&feedback_ctrs.attr,
216 	&reference_perf.attr,
217 	&wraparound_time.attr,
218 	&highest_perf.attr,
219 	&lowest_perf.attr,
220 	&lowest_nonlinear_perf.attr,
221 	&guaranteed_perf.attr,
222 	&nominal_perf.attr,
223 	&nominal_freq.attr,
224 	&lowest_freq.attr,
225 	NULL
226 };
227 ATTRIBUTE_GROUPS(cppc);
228 
229 static const struct kobj_type cppc_ktype = {
230 	.sysfs_ops = &kobj_sysfs_ops,
231 	.default_groups = cppc_groups,
232 };
233 
check_pcc_chan(int pcc_ss_id,bool chk_err_bit)234 static int check_pcc_chan(int pcc_ss_id, bool chk_err_bit)
235 {
236 	int ret, status;
237 	struct cppc_pcc_data *pcc_ss_data = pcc_data[pcc_ss_id];
238 	struct acpi_pcct_shared_memory __iomem *generic_comm_base =
239 					pcc_ss_data->pcc_channel->shmem;
240 
241 	if (!pcc_ss_data->platform_owns_pcc)
242 		return 0;
243 
244 	/*
245 	 * Poll PCC status register every 3us(delay_us) for maximum of
246 	 * deadline_us(timeout_us) until PCC command complete bit is set(cond)
247 	 */
248 	ret = readw_relaxed_poll_timeout(&generic_comm_base->status, status,
249 					status & PCC_CMD_COMPLETE_MASK, 3,
250 					pcc_ss_data->deadline_us);
251 
252 	if (likely(!ret)) {
253 		pcc_ss_data->platform_owns_pcc = false;
254 		if (chk_err_bit && (status & PCC_ERROR_MASK))
255 			ret = -EIO;
256 	}
257 
258 	if (unlikely(ret))
259 		pr_err("PCC check channel failed for ss: %d. ret=%d\n",
260 		       pcc_ss_id, ret);
261 
262 	return ret;
263 }
264 
265 /*
266  * This function transfers the ownership of the PCC to the platform
267  * So it must be called while holding write_lock(pcc_lock)
268  */
send_pcc_cmd(int pcc_ss_id,u16 cmd)269 static int send_pcc_cmd(int pcc_ss_id, u16 cmd)
270 {
271 	int ret = -EIO, i;
272 	struct cppc_pcc_data *pcc_ss_data = pcc_data[pcc_ss_id];
273 	struct acpi_pcct_shared_memory __iomem *generic_comm_base =
274 					pcc_ss_data->pcc_channel->shmem;
275 	unsigned int time_delta;
276 
277 	/*
278 	 * For CMD_WRITE we know for a fact the caller should have checked
279 	 * the channel before writing to PCC space
280 	 */
281 	if (cmd == CMD_READ) {
282 		/*
283 		 * If there are pending cpc_writes, then we stole the channel
284 		 * before write completion, so first send a WRITE command to
285 		 * platform
286 		 */
287 		if (pcc_ss_data->pending_pcc_write_cmd)
288 			send_pcc_cmd(pcc_ss_id, CMD_WRITE);
289 
290 		ret = check_pcc_chan(pcc_ss_id, false);
291 		if (ret)
292 			goto end;
293 	} else /* CMD_WRITE */
294 		pcc_ss_data->pending_pcc_write_cmd = FALSE;
295 
296 	/*
297 	 * Handle the Minimum Request Turnaround Time(MRTT)
298 	 * "The minimum amount of time that OSPM must wait after the completion
299 	 * of a command before issuing the next command, in microseconds"
300 	 */
301 	if (pcc_ss_data->pcc_mrtt) {
302 		time_delta = ktime_us_delta(ktime_get(),
303 					    pcc_ss_data->last_cmd_cmpl_time);
304 		if (pcc_ss_data->pcc_mrtt > time_delta)
305 			udelay(pcc_ss_data->pcc_mrtt - time_delta);
306 	}
307 
308 	/*
309 	 * Handle the non-zero Maximum Periodic Access Rate(MPAR)
310 	 * "The maximum number of periodic requests that the subspace channel can
311 	 * support, reported in commands per minute. 0 indicates no limitation."
312 	 *
313 	 * This parameter should be ideally zero or large enough so that it can
314 	 * handle maximum number of requests that all the cores in the system can
315 	 * collectively generate. If it is not, we will follow the spec and just
316 	 * not send the request to the platform after hitting the MPAR limit in
317 	 * any 60s window
318 	 */
319 	if (pcc_ss_data->pcc_mpar) {
320 		if (pcc_ss_data->mpar_count == 0) {
321 			time_delta = ktime_ms_delta(ktime_get(),
322 						    pcc_ss_data->last_mpar_reset);
323 			if ((time_delta < 60 * MSEC_PER_SEC) && pcc_ss_data->last_mpar_reset) {
324 				pr_debug("PCC cmd for subspace %d not sent due to MPAR limit",
325 					 pcc_ss_id);
326 				ret = -EIO;
327 				goto end;
328 			}
329 			pcc_ss_data->last_mpar_reset = ktime_get();
330 			pcc_ss_data->mpar_count = pcc_ss_data->pcc_mpar;
331 		}
332 		pcc_ss_data->mpar_count--;
333 	}
334 
335 	/* Write to the shared comm region. */
336 	writew_relaxed(cmd, &generic_comm_base->command);
337 
338 	/* Flip CMD COMPLETE bit */
339 	writew_relaxed(0, &generic_comm_base->status);
340 
341 	pcc_ss_data->platform_owns_pcc = true;
342 
343 	/* Ring doorbell */
344 	ret = mbox_send_message(pcc_ss_data->pcc_channel->mchan, &cmd);
345 	if (ret < 0) {
346 		pr_err("Err sending PCC mbox message. ss: %d cmd:%d, ret:%d\n",
347 		       pcc_ss_id, cmd, ret);
348 		goto end;
349 	}
350 
351 	/* wait for completion and check for PCC error bit */
352 	ret = check_pcc_chan(pcc_ss_id, true);
353 
354 	if (pcc_ss_data->pcc_mrtt)
355 		pcc_ss_data->last_cmd_cmpl_time = ktime_get();
356 
357 	if (pcc_ss_data->pcc_channel->mchan->mbox->txdone_irq)
358 		mbox_chan_txdone(pcc_ss_data->pcc_channel->mchan, ret);
359 	else
360 		mbox_client_txdone(pcc_ss_data->pcc_channel->mchan, ret);
361 
362 end:
363 	if (cmd == CMD_WRITE) {
364 		if (unlikely(ret)) {
365 			for_each_online_cpu(i) {
366 				struct cpc_desc *desc = per_cpu(cpc_desc_ptr, i);
367 
368 				if (!desc)
369 					continue;
370 
371 				if (desc->write_cmd_id == pcc_ss_data->pcc_write_cnt)
372 					desc->write_cmd_status = ret;
373 			}
374 		}
375 		pcc_ss_data->pcc_write_cnt++;
376 		wake_up_all(&pcc_ss_data->pcc_write_wait_q);
377 	}
378 
379 	return ret;
380 }
381 
cppc_chan_tx_done(struct mbox_client * cl,void * msg,int ret)382 static void cppc_chan_tx_done(struct mbox_client *cl, void *msg, int ret)
383 {
384 	if (ret < 0)
385 		pr_debug("TX did not complete: CMD sent:%x, ret:%d\n",
386 				*(u16 *)msg, ret);
387 	else
388 		pr_debug("TX completed. CMD sent:%x, ret:%d\n",
389 				*(u16 *)msg, ret);
390 }
391 
392 static struct mbox_client cppc_mbox_cl = {
393 	.tx_done = cppc_chan_tx_done,
394 	.knows_txdone = true,
395 };
396 
acpi_get_psd(struct cpc_desc * cpc_ptr,acpi_handle handle)397 static int acpi_get_psd(struct cpc_desc *cpc_ptr, acpi_handle handle)
398 {
399 	int result = -EFAULT;
400 	acpi_status status = AE_OK;
401 	struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
402 	struct acpi_buffer format = {sizeof("NNNNN"), "NNNNN"};
403 	struct acpi_buffer state = {0, NULL};
404 	union acpi_object  *psd = NULL;
405 	struct acpi_psd_package *pdomain;
406 
407 	status = acpi_evaluate_object_typed(handle, "_PSD", NULL,
408 					    &buffer, ACPI_TYPE_PACKAGE);
409 	if (status == AE_NOT_FOUND)	/* _PSD is optional */
410 		return 0;
411 	if (ACPI_FAILURE(status))
412 		return -ENODEV;
413 
414 	psd = buffer.pointer;
415 	if (!psd || psd->package.count != 1) {
416 		pr_debug("Invalid _PSD data\n");
417 		goto end;
418 	}
419 
420 	pdomain = &(cpc_ptr->domain_info);
421 
422 	state.length = sizeof(struct acpi_psd_package);
423 	state.pointer = pdomain;
424 
425 	status = acpi_extract_package(&(psd->package.elements[0]),
426 		&format, &state);
427 	if (ACPI_FAILURE(status)) {
428 		pr_debug("Invalid _PSD data for CPU:%d\n", cpc_ptr->cpu_id);
429 		goto end;
430 	}
431 
432 	if (pdomain->num_entries != ACPI_PSD_REV0_ENTRIES) {
433 		pr_debug("Unknown _PSD:num_entries for CPU:%d\n", cpc_ptr->cpu_id);
434 		goto end;
435 	}
436 
437 	if (pdomain->revision != ACPI_PSD_REV0_REVISION) {
438 		pr_debug("Unknown _PSD:revision for CPU: %d\n", cpc_ptr->cpu_id);
439 		goto end;
440 	}
441 
442 	if (pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ALL &&
443 	    pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ANY &&
444 	    pdomain->coord_type != DOMAIN_COORD_TYPE_HW_ALL) {
445 		pr_debug("Invalid _PSD:coord_type for CPU:%d\n", cpc_ptr->cpu_id);
446 		goto end;
447 	}
448 
449 	result = 0;
450 end:
451 	kfree(buffer.pointer);
452 	return result;
453 }
454 
acpi_cpc_valid(void)455 bool acpi_cpc_valid(void)
456 {
457 	struct cpc_desc *cpc_ptr;
458 	int cpu;
459 
460 	if (acpi_disabled)
461 		return false;
462 
463 	for_each_online_cpu(cpu) {
464 		cpc_ptr = per_cpu(cpc_desc_ptr, cpu);
465 		if (!cpc_ptr)
466 			return false;
467 	}
468 
469 	return true;
470 }
471 EXPORT_SYMBOL_GPL(acpi_cpc_valid);
472 
cppc_allow_fast_switch(void)473 bool cppc_allow_fast_switch(void)
474 {
475 	struct cpc_register_resource *desired_reg;
476 	struct cpc_desc *cpc_ptr;
477 	int cpu;
478 
479 	for_each_online_cpu(cpu) {
480 		cpc_ptr = per_cpu(cpc_desc_ptr, cpu);
481 		desired_reg = &cpc_ptr->cpc_regs[DESIRED_PERF];
482 		if (!CPC_IN_SYSTEM_MEMORY(desired_reg) &&
483 				!CPC_IN_SYSTEM_IO(desired_reg))
484 			return false;
485 	}
486 
487 	return true;
488 }
489 EXPORT_SYMBOL_GPL(cppc_allow_fast_switch);
490 
491 /**
492  * acpi_get_psd_map - Map the CPUs in the freq domain of a given cpu
493  * @cpu: Find all CPUs that share a domain with cpu.
494  * @cpu_data: Pointer to CPU specific CPPC data including PSD info.
495  *
496  *	Return: 0 for success or negative value for err.
497  */
acpi_get_psd_map(unsigned int cpu,struct cppc_cpudata * cpu_data)498 int acpi_get_psd_map(unsigned int cpu, struct cppc_cpudata *cpu_data)
499 {
500 	struct cpc_desc *cpc_ptr, *match_cpc_ptr;
501 	struct acpi_psd_package *match_pdomain;
502 	struct acpi_psd_package *pdomain;
503 	int count_target, i;
504 
505 	/*
506 	 * Now that we have _PSD data from all CPUs, let's setup P-state
507 	 * domain info.
508 	 */
509 	cpc_ptr = per_cpu(cpc_desc_ptr, cpu);
510 	if (!cpc_ptr)
511 		return -EFAULT;
512 
513 	pdomain = &(cpc_ptr->domain_info);
514 	cpumask_set_cpu(cpu, cpu_data->shared_cpu_map);
515 	if (pdomain->num_processors <= 1)
516 		return 0;
517 
518 	/* Validate the Domain info */
519 	count_target = pdomain->num_processors;
520 	if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ALL)
521 		cpu_data->shared_type = CPUFREQ_SHARED_TYPE_ALL;
522 	else if (pdomain->coord_type == DOMAIN_COORD_TYPE_HW_ALL)
523 		cpu_data->shared_type = CPUFREQ_SHARED_TYPE_HW;
524 	else if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ANY)
525 		cpu_data->shared_type = CPUFREQ_SHARED_TYPE_ANY;
526 
527 	for_each_online_cpu(i) {
528 		if (i == cpu)
529 			continue;
530 
531 		match_cpc_ptr = per_cpu(cpc_desc_ptr, i);
532 		if (!match_cpc_ptr)
533 			goto err_fault;
534 
535 		match_pdomain = &(match_cpc_ptr->domain_info);
536 		if (match_pdomain->domain != pdomain->domain)
537 			continue;
538 
539 		/* Here i and cpu are in the same domain */
540 		if (match_pdomain->num_processors != count_target)
541 			goto err_fault;
542 
543 		if (pdomain->coord_type != match_pdomain->coord_type)
544 			goto err_fault;
545 
546 		cpumask_set_cpu(i, cpu_data->shared_cpu_map);
547 	}
548 
549 	return 0;
550 
551 err_fault:
552 	/* Assume no coordination on any error parsing domain info */
553 	cpumask_clear(cpu_data->shared_cpu_map);
554 	cpumask_set_cpu(cpu, cpu_data->shared_cpu_map);
555 	cpu_data->shared_type = CPUFREQ_SHARED_TYPE_NONE;
556 
557 	return -EFAULT;
558 }
559 EXPORT_SYMBOL_GPL(acpi_get_psd_map);
560 
register_pcc_channel(int pcc_ss_idx)561 static int register_pcc_channel(int pcc_ss_idx)
562 {
563 	struct pcc_mbox_chan *pcc_chan;
564 	u64 usecs_lat;
565 
566 	if (pcc_ss_idx >= 0) {
567 		pcc_chan = pcc_mbox_request_channel(&cppc_mbox_cl, pcc_ss_idx);
568 
569 		if (IS_ERR(pcc_chan)) {
570 			pr_err("Failed to find PCC channel for subspace %d\n",
571 			       pcc_ss_idx);
572 			return -ENODEV;
573 		}
574 
575 		pcc_data[pcc_ss_idx]->pcc_channel = pcc_chan;
576 		/*
577 		 * cppc_ss->latency is just a Nominal value. In reality
578 		 * the remote processor could be much slower to reply.
579 		 * So add an arbitrary amount of wait on top of Nominal.
580 		 */
581 		usecs_lat = NUM_RETRIES * pcc_chan->latency;
582 		pcc_data[pcc_ss_idx]->deadline_us = usecs_lat;
583 		pcc_data[pcc_ss_idx]->pcc_mrtt = pcc_chan->min_turnaround_time;
584 		pcc_data[pcc_ss_idx]->pcc_mpar = pcc_chan->max_access_rate;
585 		pcc_data[pcc_ss_idx]->pcc_nominal = pcc_chan->latency;
586 
587 		/* Set flag so that we don't come here for each CPU. */
588 		pcc_data[pcc_ss_idx]->pcc_channel_acquired = true;
589 	}
590 
591 	return 0;
592 }
593 
594 /**
595  * cpc_ffh_supported() - check if FFH reading supported
596  *
597  * Check if the architecture has support for functional fixed hardware
598  * read/write capability.
599  *
600  * Return: true for supported, false for not supported
601  */
cpc_ffh_supported(void)602 bool __weak cpc_ffh_supported(void)
603 {
604 	return false;
605 }
606 
607 /**
608  * cpc_supported_by_cpu() - check if CPPC is supported by CPU
609  *
610  * Check if the architectural support for CPPC is present even
611  * if the _OSC hasn't prescribed it
612  *
613  * Return: true for supported, false for not supported
614  */
cpc_supported_by_cpu(void)615 bool __weak cpc_supported_by_cpu(void)
616 {
617 	return false;
618 }
619 
620 /**
621  * pcc_data_alloc() - Allocate the pcc_data memory for pcc subspace
622  * @pcc_ss_id: PCC Subspace index as in the PCC client ACPI package.
623  *
624  * Check and allocate the cppc_pcc_data memory.
625  * In some processor configurations it is possible that same subspace
626  * is shared between multiple CPUs. This is seen especially in CPUs
627  * with hardware multi-threading support.
628  *
629  * Return: 0 for success, errno for failure
630  */
pcc_data_alloc(int pcc_ss_id)631 static int pcc_data_alloc(int pcc_ss_id)
632 {
633 	if (pcc_ss_id < 0 || pcc_ss_id >= MAX_PCC_SUBSPACES)
634 		return -EINVAL;
635 
636 	if (pcc_data[pcc_ss_id]) {
637 		pcc_data[pcc_ss_id]->refcount++;
638 	} else {
639 		pcc_data[pcc_ss_id] = kzalloc_obj(struct cppc_pcc_data);
640 		if (!pcc_data[pcc_ss_id])
641 			return -ENOMEM;
642 		pcc_data[pcc_ss_id]->refcount++;
643 	}
644 
645 	return 0;
646 }
647 
648 /*
649  * An example CPC table looks like the following.
650  *
651  *  Name (_CPC, Package() {
652  *      17,							// NumEntries
653  *      1,							// Revision
654  *      ResourceTemplate() {Register(PCC, 32, 0, 0x120, 2)},	// Highest Performance
655  *      ResourceTemplate() {Register(PCC, 32, 0, 0x124, 2)},	// Nominal Performance
656  *      ResourceTemplate() {Register(PCC, 32, 0, 0x128, 2)},	// Lowest Nonlinear Performance
657  *      ResourceTemplate() {Register(PCC, 32, 0, 0x12C, 2)},	// Lowest Performance
658  *      ResourceTemplate() {Register(PCC, 32, 0, 0x130, 2)},	// Guaranteed Performance Register
659  *      ResourceTemplate() {Register(PCC, 32, 0, 0x110, 2)},	// Desired Performance Register
660  *      ResourceTemplate() {Register(SystemMemory, 0, 0, 0, 0)},
661  *      ...
662  *      ...
663  *      ...
664  *  }
665  * Each Register() encodes how to access that specific register.
666  * e.g. a sample PCC entry has the following encoding:
667  *
668  *  Register (
669  *      PCC,	// AddressSpaceKeyword
670  *      8,	// RegisterBitWidth
671  *      8,	// RegisterBitOffset
672  *      0x30,	// RegisterAddress
673  *      9,	// AccessSize (subspace ID)
674  *  )
675  */
676 
677 /**
678  * acpi_cppc_processor_probe - Search for per CPU _CPC objects.
679  * @pr: Ptr to acpi_processor containing this CPU's logical ID.
680  *
681  *	Return: 0 for success or negative value for err.
682  */
acpi_cppc_processor_probe(struct acpi_processor * pr)683 int acpi_cppc_processor_probe(struct acpi_processor *pr)
684 {
685 	struct acpi_buffer output = {ACPI_ALLOCATE_BUFFER, NULL};
686 	union acpi_object *out_obj, *cpc_obj;
687 	struct cpc_desc *cpc_ptr;
688 	struct cpc_reg *gas_t;
689 	struct device *cpu_dev;
690 	acpi_handle handle = pr->handle;
691 	unsigned int num_ent, i, cpc_rev;
692 	int pcc_subspace_id = -1;
693 	acpi_status status;
694 	int ret = -ENODATA;
695 
696 	if (!osc_sb_cppc2_support_acked) {
697 		pr_debug("CPPC v2 _OSC not acked\n");
698 		if (!cpc_supported_by_cpu()) {
699 			pr_debug("CPPC is not supported by the CPU\n");
700 			return -ENODEV;
701 		}
702 	}
703 
704 	/* Parse the ACPI _CPC table for this CPU. */
705 	status = acpi_evaluate_object_typed(handle, "_CPC", NULL, &output,
706 			ACPI_TYPE_PACKAGE);
707 	if (ACPI_FAILURE(status)) {
708 		ret = -ENODEV;
709 		goto out_buf_free;
710 	}
711 
712 	out_obj = (union acpi_object *) output.pointer;
713 
714 	cpc_ptr = kzalloc_obj(struct cpc_desc);
715 	if (!cpc_ptr) {
716 		ret = -ENOMEM;
717 		goto out_buf_free;
718 	}
719 
720 	/* First entry is NumEntries. */
721 	cpc_obj = &out_obj->package.elements[0];
722 	if (cpc_obj->type == ACPI_TYPE_INTEGER)	{
723 		num_ent = cpc_obj->integer.value;
724 		if (num_ent <= 1) {
725 			pr_debug("Unexpected _CPC NumEntries value (%d) for CPU:%d\n",
726 				 num_ent, pr->id);
727 			goto out_free;
728 		}
729 	} else {
730 		pr_debug("Unexpected _CPC NumEntries entry type (%d) for CPU:%d\n",
731 			 cpc_obj->type, pr->id);
732 		goto out_free;
733 	}
734 
735 	/* Second entry should be revision. */
736 	cpc_obj = &out_obj->package.elements[1];
737 	if (cpc_obj->type == ACPI_TYPE_INTEGER)	{
738 		cpc_rev = cpc_obj->integer.value;
739 	} else {
740 		pr_debug("Unexpected _CPC Revision entry type (%d) for CPU:%d\n",
741 			 cpc_obj->type, pr->id);
742 		goto out_free;
743 	}
744 
745 	if (cpc_rev < CPPC_V2_REV) {
746 		pr_debug("Unsupported _CPC Revision (%d) for CPU:%d\n", cpc_rev,
747 			 pr->id);
748 		goto out_free;
749 	}
750 
751 	/*
752 	 * Disregard _CPC if the number of entries in the return package is not
753 	 * as expected, but support future revisions being proper supersets of
754 	 * the v3 and only causing more entries to be returned by _CPC.
755 	 */
756 	if ((cpc_rev == CPPC_V2_REV && num_ent != CPPC_V2_NUM_ENT) ||
757 	    (cpc_rev == CPPC_V3_REV && num_ent != CPPC_V3_NUM_ENT) ||
758 	    (cpc_rev > CPPC_V3_REV && num_ent <= CPPC_V3_NUM_ENT)) {
759 		pr_debug("Unexpected number of _CPC return package entries (%d) for CPU:%d\n",
760 			 num_ent, pr->id);
761 		goto out_free;
762 	}
763 	if (cpc_rev > CPPC_V3_REV) {
764 		num_ent = CPPC_V3_NUM_ENT;
765 		cpc_rev = CPPC_V3_REV;
766 	}
767 
768 	cpc_ptr->num_entries = num_ent;
769 	cpc_ptr->version = cpc_rev;
770 
771 	/* Iterate through remaining entries in _CPC */
772 	for (i = 2; i < num_ent; i++) {
773 		cpc_obj = &out_obj->package.elements[i];
774 
775 		if (cpc_obj->type == ACPI_TYPE_INTEGER)	{
776 			cpc_ptr->cpc_regs[i-2].type = ACPI_TYPE_INTEGER;
777 			cpc_ptr->cpc_regs[i-2].cpc_entry.int_value = cpc_obj->integer.value;
778 		} else if (cpc_obj->type == ACPI_TYPE_BUFFER) {
779 			gas_t = (struct cpc_reg *)
780 				cpc_obj->buffer.pointer;
781 
782 			/*
783 			 * The PCC Subspace index is encoded inside
784 			 * the CPC table entries. The same PCC index
785 			 * will be used for all the PCC entries,
786 			 * so extract it only once.
787 			 */
788 			if (gas_t->space_id == ACPI_ADR_SPACE_PLATFORM_COMM) {
789 				if (pcc_subspace_id < 0) {
790 					pcc_subspace_id = gas_t->access_width;
791 					if (pcc_data_alloc(pcc_subspace_id))
792 						goto out_free;
793 				} else if (pcc_subspace_id != gas_t->access_width) {
794 					pr_debug("Mismatched PCC ids in _CPC for CPU:%d\n",
795 						 pr->id);
796 					goto out_free;
797 				}
798 			} else if (gas_t->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY) {
799 				if (gas_t->address) {
800 					void __iomem *addr;
801 					size_t access_width;
802 
803 					if (!osc_cpc_flexible_adr_space_confirmed) {
804 						pr_debug("Flexible address space capability not supported\n");
805 						if (!cpc_supported_by_cpu())
806 							goto out_free;
807 					}
808 
809 					access_width = GET_BIT_WIDTH(gas_t) / 8;
810 					addr = ioremap(gas_t->address, access_width);
811 					if (!addr)
812 						goto out_free;
813 					cpc_ptr->cpc_regs[i-2].sys_mem_vaddr = addr;
814 				}
815 			} else if (gas_t->space_id == ACPI_ADR_SPACE_SYSTEM_IO) {
816 				if (gas_t->access_width < 1 || gas_t->access_width > 3) {
817 					/*
818 					 * 1 = 8-bit, 2 = 16-bit, and 3 = 32-bit.
819 					 * SystemIO doesn't implement 64-bit
820 					 * registers.
821 					 */
822 					pr_debug("Invalid access width %d for SystemIO register in _CPC\n",
823 						 gas_t->access_width);
824 					goto out_free;
825 				}
826 				if (gas_t->address & OVER_16BTS_MASK) {
827 					/* SystemIO registers use 16-bit integer addresses */
828 					pr_debug("Invalid IO port %llu for SystemIO register in _CPC\n",
829 						 gas_t->address);
830 					goto out_free;
831 				}
832 				if (!osc_cpc_flexible_adr_space_confirmed) {
833 					pr_debug("Flexible address space capability not supported\n");
834 					if (!cpc_supported_by_cpu())
835 						goto out_free;
836 				}
837 			} else {
838 				if (gas_t->space_id != ACPI_ADR_SPACE_FIXED_HARDWARE || !cpc_ffh_supported()) {
839 					/* Support only PCC, SystemMemory, SystemIO, and FFH type regs. */
840 					pr_debug("Unsupported register type (%d) in _CPC\n",
841 						 gas_t->space_id);
842 					goto out_free;
843 				}
844 			}
845 
846 			cpc_ptr->cpc_regs[i-2].type = ACPI_TYPE_BUFFER;
847 			memcpy(&cpc_ptr->cpc_regs[i-2].cpc_entry.reg, gas_t, sizeof(*gas_t));
848 		} else {
849 			pr_debug("Invalid entry type (%d) in _CPC for CPU:%d\n",
850 				 i, pr->id);
851 			goto out_free;
852 		}
853 	}
854 	per_cpu(cpu_pcc_subspace_idx, pr->id) = pcc_subspace_id;
855 
856 	/*
857 	 * In CPPC v1, DESIRED_PERF is mandatory. In CPPC v2, it is optional
858 	 * only when AUTO_SEL_ENABLE is supported.
859 	 */
860 	if (!CPC_SUPPORTED(&cpc_ptr->cpc_regs[DESIRED_PERF]) &&
861 	    (!osc_sb_cppc2_support_acked ||
862 	     !CPC_SUPPORTED(&cpc_ptr->cpc_regs[AUTO_SEL_ENABLE])))
863 		pr_warn("Desired perf. register is mandatory if CPPC v2 is not supported "
864 			"or autonomous selection is disabled\n");
865 
866 	/*
867 	 * Initialize the remaining cpc_regs as unsupported.
868 	 * Example: In case FW exposes CPPC v2, the below loop will initialize
869 	 * LOWEST_FREQ and NOMINAL_FREQ regs as unsupported
870 	 */
871 	for (i = num_ent - 2; i < MAX_CPC_REG_ENT; i++) {
872 		cpc_ptr->cpc_regs[i].type = ACPI_TYPE_INTEGER;
873 		cpc_ptr->cpc_regs[i].cpc_entry.int_value = 0;
874 	}
875 
876 
877 	/* Store CPU Logical ID */
878 	cpc_ptr->cpu_id = pr->id;
879 	raw_spin_lock_init(&cpc_ptr->rmw_lock);
880 
881 	/* Parse PSD data for this CPU */
882 	ret = acpi_get_psd(cpc_ptr, handle);
883 	if (ret)
884 		goto out_free;
885 
886 	/* Register PCC channel once for all PCC subspace ID. */
887 	if (pcc_subspace_id >= 0 && !pcc_data[pcc_subspace_id]->pcc_channel_acquired) {
888 		ret = register_pcc_channel(pcc_subspace_id);
889 		if (ret)
890 			goto out_free;
891 
892 		init_rwsem(&pcc_data[pcc_subspace_id]->pcc_lock);
893 		init_waitqueue_head(&pcc_data[pcc_subspace_id]->pcc_write_wait_q);
894 	}
895 
896 	/* Everything looks okay */
897 	pr_debug("Parsed CPC struct for CPU: %d\n", pr->id);
898 
899 	/* Add per logical CPU nodes for reading its feedback counters. */
900 	cpu_dev = get_cpu_device(pr->id);
901 	if (!cpu_dev) {
902 		ret = -EINVAL;
903 		goto out_free;
904 	}
905 
906 	/* Plug PSD data into this CPU's CPC descriptor. */
907 	per_cpu(cpc_desc_ptr, pr->id) = cpc_ptr;
908 
909 	ret = kobject_init_and_add(&cpc_ptr->kobj, &cppc_ktype, &cpu_dev->kobj,
910 			"acpi_cppc");
911 	if (ret) {
912 		per_cpu(cpc_desc_ptr, pr->id) = NULL;
913 		kobject_put(&cpc_ptr->kobj);
914 		goto out_free;
915 	}
916 
917 	kfree(output.pointer);
918 	return 0;
919 
920 out_free:
921 	/* Free all the mapped sys mem areas for this CPU */
922 	for (i = 2; i < cpc_ptr->num_entries; i++) {
923 		void __iomem *addr = cpc_ptr->cpc_regs[i-2].sys_mem_vaddr;
924 
925 		if (addr)
926 			iounmap(addr);
927 	}
928 	kfree(cpc_ptr);
929 
930 out_buf_free:
931 	kfree(output.pointer);
932 	return ret;
933 }
934 EXPORT_SYMBOL_GPL(acpi_cppc_processor_probe);
935 
936 /**
937  * acpi_cppc_processor_exit - Cleanup CPC structs.
938  * @pr: Ptr to acpi_processor containing this CPU's logical ID.
939  *
940  * Return: Void
941  */
acpi_cppc_processor_exit(struct acpi_processor * pr)942 void acpi_cppc_processor_exit(struct acpi_processor *pr)
943 {
944 	struct cpc_desc *cpc_ptr;
945 	unsigned int i;
946 	void __iomem *addr;
947 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, pr->id);
948 
949 	if (pcc_ss_id >= 0 && pcc_data[pcc_ss_id]) {
950 		if (pcc_data[pcc_ss_id]->pcc_channel_acquired) {
951 			pcc_data[pcc_ss_id]->refcount--;
952 			if (!pcc_data[pcc_ss_id]->refcount) {
953 				pcc_mbox_free_channel(pcc_data[pcc_ss_id]->pcc_channel);
954 				kfree(pcc_data[pcc_ss_id]);
955 				pcc_data[pcc_ss_id] = NULL;
956 			}
957 		}
958 	}
959 
960 	cpc_ptr = per_cpu(cpc_desc_ptr, pr->id);
961 	if (!cpc_ptr)
962 		return;
963 
964 	/* Free all the mapped sys mem areas for this CPU */
965 	for (i = 2; i < cpc_ptr->num_entries; i++) {
966 		addr = cpc_ptr->cpc_regs[i-2].sys_mem_vaddr;
967 		if (addr)
968 			iounmap(addr);
969 	}
970 
971 	kobject_put(&cpc_ptr->kobj);
972 	kfree(cpc_ptr);
973 }
974 EXPORT_SYMBOL_GPL(acpi_cppc_processor_exit);
975 
976 /**
977  * cpc_read_ffh() - Read FFH register
978  * @cpunum:	CPU number to read
979  * @reg:	cppc register information
980  * @val:	place holder for return value
981  *
982  * Read bit_width bits from a specified address and bit_offset
983  *
984  * Return: 0 for success and error code
985  */
cpc_read_ffh(int cpunum,struct cpc_reg * reg,u64 * val)986 int __weak cpc_read_ffh(int cpunum, struct cpc_reg *reg, u64 *val)
987 {
988 	return -ENOTSUPP;
989 }
990 
991 /**
992  * cpc_write_ffh() - Write FFH register
993  * @cpunum:	CPU number to write
994  * @reg:	cppc register information
995  * @val:	value to write
996  *
997  * Write value of bit_width bits to a specified address and bit_offset
998  *
999  * Return: 0 for success and error code
1000  */
cpc_write_ffh(int cpunum,struct cpc_reg * reg,u64 val)1001 int __weak cpc_write_ffh(int cpunum, struct cpc_reg *reg, u64 val)
1002 {
1003 	return -ENOTSUPP;
1004 }
1005 
1006 /*
1007  * Since cpc_read and cpc_write are called while holding pcc_lock, it should be
1008  * as fast as possible. We have already mapped the PCC subspace during init, so
1009  * we can directly write to it.
1010  */
1011 
cpc_read(int cpu,struct cpc_register_resource * reg_res,u64 * val)1012 static int cpc_read(int cpu, struct cpc_register_resource *reg_res, u64 *val)
1013 {
1014 	void __iomem *vaddr = NULL;
1015 	int size;
1016 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1017 	struct cpc_reg *reg = &reg_res->cpc_entry.reg;
1018 
1019 	if (reg_res->type == ACPI_TYPE_INTEGER) {
1020 		*val = reg_res->cpc_entry.int_value;
1021 		return 0;
1022 	}
1023 
1024 	*val = 0;
1025 	size = GET_BIT_WIDTH(reg);
1026 
1027 	if (IS_ENABLED(CONFIG_HAS_IOPORT) &&
1028 	    reg->space_id == ACPI_ADR_SPACE_SYSTEM_IO) {
1029 		u32 val_u32;
1030 		acpi_status status;
1031 
1032 		status = acpi_os_read_port((acpi_io_address)reg->address,
1033 					   &val_u32, size);
1034 		if (ACPI_FAILURE(status)) {
1035 			pr_debug("Error: Failed to read SystemIO port %llx\n",
1036 				 reg->address);
1037 			return -EFAULT;
1038 		}
1039 
1040 		*val = val_u32;
1041 		return 0;
1042 	} else if (reg->space_id == ACPI_ADR_SPACE_PLATFORM_COMM && pcc_ss_id >= 0) {
1043 		/*
1044 		 * For registers in PCC space, the register size is determined
1045 		 * by the bit width field; the access size is used to indicate
1046 		 * the PCC subspace id.
1047 		 */
1048 		size = reg->bit_width;
1049 		vaddr = GET_PCC_VADDR(reg->address, pcc_ss_id);
1050 	}
1051 	else if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY)
1052 		vaddr = reg_res->sys_mem_vaddr;
1053 	else if (reg->space_id == ACPI_ADR_SPACE_FIXED_HARDWARE)
1054 		return cpc_read_ffh(cpu, reg, val);
1055 	else
1056 		return acpi_os_read_memory((acpi_physical_address)reg->address,
1057 				val, size);
1058 
1059 	switch (size) {
1060 	case 8:
1061 		*val = readb_relaxed(vaddr);
1062 		break;
1063 	case 16:
1064 		*val = readw_relaxed(vaddr);
1065 		break;
1066 	case 32:
1067 		*val = readl_relaxed(vaddr);
1068 		break;
1069 	case 64:
1070 		*val = readq_relaxed(vaddr);
1071 		break;
1072 	default:
1073 		if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY) {
1074 			pr_debug("Error: Cannot read %u bit width from system memory: 0x%llx\n",
1075 				size, reg->address);
1076 		} else if (reg->space_id == ACPI_ADR_SPACE_PLATFORM_COMM) {
1077 			pr_debug("Error: Cannot read %u bit width from PCC for ss: %d\n",
1078 				size, pcc_ss_id);
1079 		}
1080 		return -EFAULT;
1081 	}
1082 
1083 	if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY)
1084 		*val = MASK_VAL_READ(reg, *val);
1085 
1086 	return 0;
1087 }
1088 
cpc_write(int cpu,struct cpc_register_resource * reg_res,u64 val)1089 static int cpc_write(int cpu, struct cpc_register_resource *reg_res, u64 val)
1090 {
1091 	int ret_val = 0;
1092 	int size;
1093 	u64 prev_val;
1094 	void __iomem *vaddr = NULL;
1095 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1096 	struct cpc_reg *reg = &reg_res->cpc_entry.reg;
1097 	struct cpc_desc *cpc_desc;
1098 	unsigned long flags;
1099 
1100 	size = GET_BIT_WIDTH(reg);
1101 
1102 	if (IS_ENABLED(CONFIG_HAS_IOPORT) &&
1103 	    reg->space_id == ACPI_ADR_SPACE_SYSTEM_IO) {
1104 		acpi_status status;
1105 
1106 		status = acpi_os_write_port((acpi_io_address)reg->address,
1107 					    (u32)val, size);
1108 		if (ACPI_FAILURE(status)) {
1109 			pr_debug("Error: Failed to write SystemIO port %llx\n",
1110 				 reg->address);
1111 			return -EFAULT;
1112 		}
1113 
1114 		return 0;
1115 	} else if (reg->space_id == ACPI_ADR_SPACE_PLATFORM_COMM && pcc_ss_id >= 0) {
1116 		/*
1117 		 * For registers in PCC space, the register size is determined
1118 		 * by the bit width field; the access size is used to indicate
1119 		 * the PCC subspace id.
1120 		 */
1121 		size = reg->bit_width;
1122 		vaddr = GET_PCC_VADDR(reg->address, pcc_ss_id);
1123 	}
1124 	else if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY)
1125 		vaddr = reg_res->sys_mem_vaddr;
1126 	else if (reg->space_id == ACPI_ADR_SPACE_FIXED_HARDWARE)
1127 		return cpc_write_ffh(cpu, reg, val);
1128 	else
1129 		return acpi_os_write_memory((acpi_physical_address)reg->address,
1130 				val, size);
1131 
1132 	if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY) {
1133 		cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1134 		if (!cpc_desc) {
1135 			pr_debug("No CPC descriptor for CPU:%d\n", cpu);
1136 			return -ENODEV;
1137 		}
1138 
1139 		raw_spin_lock_irqsave(&cpc_desc->rmw_lock, flags);
1140 		switch (size) {
1141 		case 8:
1142 			prev_val = readb_relaxed(vaddr);
1143 			break;
1144 		case 16:
1145 			prev_val = readw_relaxed(vaddr);
1146 			break;
1147 		case 32:
1148 			prev_val = readl_relaxed(vaddr);
1149 			break;
1150 		case 64:
1151 			prev_val = readq_relaxed(vaddr);
1152 			break;
1153 		default:
1154 			raw_spin_unlock_irqrestore(&cpc_desc->rmw_lock, flags);
1155 			return -EFAULT;
1156 		}
1157 		val = MASK_VAL_WRITE(reg, prev_val, val);
1158 	}
1159 
1160 	switch (size) {
1161 	case 8:
1162 		writeb_relaxed(val, vaddr);
1163 		break;
1164 	case 16:
1165 		writew_relaxed(val, vaddr);
1166 		break;
1167 	case 32:
1168 		writel_relaxed(val, vaddr);
1169 		break;
1170 	case 64:
1171 		writeq_relaxed(val, vaddr);
1172 		break;
1173 	default:
1174 		if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY) {
1175 			pr_debug("Error: Cannot write %u bit width to system memory: 0x%llx\n",
1176 				size, reg->address);
1177 		} else if (reg->space_id == ACPI_ADR_SPACE_PLATFORM_COMM) {
1178 			pr_debug("Error: Cannot write %u bit width to PCC for ss: %d\n",
1179 				size, pcc_ss_id);
1180 		}
1181 		ret_val = -EFAULT;
1182 		break;
1183 	}
1184 
1185 	if (reg->space_id == ACPI_ADR_SPACE_SYSTEM_MEMORY)
1186 		raw_spin_unlock_irqrestore(&cpc_desc->rmw_lock, flags);
1187 
1188 	return ret_val;
1189 }
1190 
cppc_get_reg_val_in_pcc(int cpu,struct cpc_register_resource * reg,u64 * val)1191 static int cppc_get_reg_val_in_pcc(int cpu, struct cpc_register_resource *reg, u64 *val)
1192 {
1193 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1194 	struct cppc_pcc_data *pcc_ss_data = NULL;
1195 	int ret;
1196 
1197 	if (pcc_ss_id < 0) {
1198 		pr_debug("Invalid pcc_ss_id\n");
1199 		return -ENODEV;
1200 	}
1201 
1202 	pcc_ss_data = pcc_data[pcc_ss_id];
1203 
1204 	down_write(&pcc_ss_data->pcc_lock);
1205 
1206 	if (send_pcc_cmd(pcc_ss_id, CMD_READ) >= 0)
1207 		ret = cpc_read(cpu, reg, val);
1208 	else
1209 		ret = -EIO;
1210 
1211 	up_write(&pcc_ss_data->pcc_lock);
1212 
1213 	return ret;
1214 }
1215 
cppc_get_reg_val(int cpu,enum cppc_regs reg_idx,u64 * val)1216 static int cppc_get_reg_val(int cpu, enum cppc_regs reg_idx, u64 *val)
1217 {
1218 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1219 	struct cpc_register_resource *reg;
1220 
1221 	if (val == NULL)
1222 		return -EINVAL;
1223 
1224 	if (!cpc_desc) {
1225 		pr_debug("No CPC descriptor for CPU:%d\n", cpu);
1226 		return -ENODEV;
1227 	}
1228 
1229 	reg = &cpc_desc->cpc_regs[reg_idx];
1230 
1231 	if ((reg->type == ACPI_TYPE_INTEGER && IS_OPTIONAL_CPC_REG(reg_idx) &&
1232 	     !reg->cpc_entry.int_value) || (reg->type != ACPI_TYPE_INTEGER &&
1233 	     IS_NULL_REG(&reg->cpc_entry.reg))) {
1234 		pr_debug("CPC register is not supported\n");
1235 		return -EOPNOTSUPP;
1236 	}
1237 
1238 	if (CPC_IN_PCC(reg))
1239 		return cppc_get_reg_val_in_pcc(cpu, reg, val);
1240 
1241 	return cpc_read(cpu, reg, val);
1242 }
1243 
cppc_set_reg_val_in_pcc(int cpu,struct cpc_register_resource * reg,u64 val)1244 static int cppc_set_reg_val_in_pcc(int cpu, struct cpc_register_resource *reg, u64 val)
1245 {
1246 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1247 	struct cppc_pcc_data *pcc_ss_data = NULL;
1248 	int ret;
1249 
1250 	if (pcc_ss_id < 0) {
1251 		pr_debug("Invalid pcc_ss_id\n");
1252 		return -ENODEV;
1253 	}
1254 
1255 	ret = cpc_write(cpu, reg, val);
1256 	if (ret)
1257 		return ret;
1258 
1259 	pcc_ss_data = pcc_data[pcc_ss_id];
1260 
1261 	down_write(&pcc_ss_data->pcc_lock);
1262 	/* after writing CPC, transfer the ownership of PCC to platform */
1263 	ret = send_pcc_cmd(pcc_ss_id, CMD_WRITE);
1264 	up_write(&pcc_ss_data->pcc_lock);
1265 
1266 	return ret;
1267 }
1268 
cppc_set_reg_val(int cpu,enum cppc_regs reg_idx,u64 val)1269 static int cppc_set_reg_val(int cpu, enum cppc_regs reg_idx, u64 val)
1270 {
1271 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1272 	struct cpc_register_resource *reg;
1273 
1274 	if (!cpc_desc) {
1275 		pr_debug("No CPC descriptor for CPU:%d\n", cpu);
1276 		return -ENODEV;
1277 	}
1278 
1279 	reg = &cpc_desc->cpc_regs[reg_idx];
1280 
1281 	/* if a register is writeable, it must be a buffer and not null */
1282 	if ((reg->type != ACPI_TYPE_BUFFER) || IS_NULL_REG(&reg->cpc_entry.reg)) {
1283 		pr_debug("CPC register is not supported\n");
1284 		return -EOPNOTSUPP;
1285 	}
1286 
1287 	if (CPC_IN_PCC(reg))
1288 		return cppc_set_reg_val_in_pcc(cpu, reg, val);
1289 
1290 	return cpc_write(cpu, reg, val);
1291 }
1292 
1293 /**
1294  * cppc_get_desired_perf - Get the desired performance register value.
1295  * @cpunum: CPU from which to get desired performance.
1296  * @desired_perf: Return address.
1297  *
1298  * Return: 0 for success, -EIO otherwise.
1299  */
cppc_get_desired_perf(int cpunum,u64 * desired_perf)1300 int cppc_get_desired_perf(int cpunum, u64 *desired_perf)
1301 {
1302 	return cppc_get_reg_val(cpunum, DESIRED_PERF, desired_perf);
1303 }
1304 EXPORT_SYMBOL_GPL(cppc_get_desired_perf);
1305 
1306 /**
1307  * cppc_get_nominal_perf - Get the nominal performance register value.
1308  * @cpunum: CPU from which to get nominal performance.
1309  * @nominal_perf: Return address.
1310  *
1311  * Return: 0 for success, -EIO otherwise.
1312  */
cppc_get_nominal_perf(int cpunum,u64 * nominal_perf)1313 int cppc_get_nominal_perf(int cpunum, u64 *nominal_perf)
1314 {
1315 	return cppc_get_reg_val(cpunum, NOMINAL_PERF, nominal_perf);
1316 }
1317 
1318 /**
1319  * cppc_get_highest_perf - Get the highest performance register value.
1320  * @cpunum: CPU from which to get highest performance.
1321  * @highest_perf: Return address.
1322  *
1323  * Return: 0 for success, -EIO otherwise.
1324  */
cppc_get_highest_perf(int cpunum,u64 * highest_perf)1325 int cppc_get_highest_perf(int cpunum, u64 *highest_perf)
1326 {
1327 	return cppc_get_reg_val(cpunum, HIGHEST_PERF, highest_perf);
1328 }
1329 EXPORT_SYMBOL_GPL(cppc_get_highest_perf);
1330 
1331 /**
1332  * cppc_get_epp_perf - Get the epp register value.
1333  * @cpunum: CPU from which to get epp preference value.
1334  * @epp_perf: Return address.
1335  *
1336  * Return: 0 for success, -EIO otherwise.
1337  */
cppc_get_epp_perf(int cpunum,u64 * epp_perf)1338 int cppc_get_epp_perf(int cpunum, u64 *epp_perf)
1339 {
1340 	return cppc_get_reg_val(cpunum, ENERGY_PERF, epp_perf);
1341 }
1342 EXPORT_SYMBOL_GPL(cppc_get_epp_perf);
1343 
1344 /**
1345  * cppc_get_perf_caps - Get a CPU's performance capabilities.
1346  * @cpunum: CPU from which to get capabilities info.
1347  * @perf_caps: ptr to cppc_perf_caps. See cppc_acpi.h
1348  *
1349  * Return: 0 for success with perf_caps populated else -ERRNO.
1350  */
cppc_get_perf_caps(int cpunum,struct cppc_perf_caps * perf_caps)1351 int cppc_get_perf_caps(int cpunum, struct cppc_perf_caps *perf_caps)
1352 {
1353 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpunum);
1354 	struct cpc_register_resource *highest_reg, *lowest_reg,
1355 		*lowest_non_linear_reg, *nominal_reg, *reference_reg,
1356 		*guaranteed_reg, *low_freq_reg = NULL, *nom_freq_reg = NULL;
1357 	u64 high, low, guaranteed, nom, ref, min_nonlinear,
1358 	    low_f = 0, nom_f = 0;
1359 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpunum);
1360 	struct cppc_pcc_data *pcc_ss_data = NULL;
1361 	int ret = 0, regs_in_pcc = 0;
1362 
1363 	if (!cpc_desc) {
1364 		pr_debug("No CPC descriptor for CPU:%d\n", cpunum);
1365 		return -ENODEV;
1366 	}
1367 
1368 	highest_reg = &cpc_desc->cpc_regs[HIGHEST_PERF];
1369 	lowest_reg = &cpc_desc->cpc_regs[LOWEST_PERF];
1370 	lowest_non_linear_reg = &cpc_desc->cpc_regs[LOW_NON_LINEAR_PERF];
1371 	nominal_reg = &cpc_desc->cpc_regs[NOMINAL_PERF];
1372 	reference_reg = &cpc_desc->cpc_regs[REFERENCE_PERF];
1373 	low_freq_reg = &cpc_desc->cpc_regs[LOWEST_FREQ];
1374 	nom_freq_reg = &cpc_desc->cpc_regs[NOMINAL_FREQ];
1375 	guaranteed_reg = &cpc_desc->cpc_regs[GUARANTEED_PERF];
1376 
1377 	/* Are any of the regs PCC ?*/
1378 	if (CPC_IN_PCC(highest_reg) || CPC_IN_PCC(lowest_reg) ||
1379 		CPC_IN_PCC(lowest_non_linear_reg) || CPC_IN_PCC(nominal_reg) ||
1380 		(CPC_SUPPORTED(reference_reg) && CPC_IN_PCC(reference_reg)) ||
1381 		CPC_IN_PCC(low_freq_reg) || CPC_IN_PCC(nom_freq_reg) ||
1382 		CPC_IN_PCC(guaranteed_reg)) {
1383 		if (pcc_ss_id < 0) {
1384 			pr_debug("Invalid pcc_ss_id\n");
1385 			return -ENODEV;
1386 		}
1387 		pcc_ss_data = pcc_data[pcc_ss_id];
1388 		regs_in_pcc = 1;
1389 		down_write(&pcc_ss_data->pcc_lock);
1390 		/* Ring doorbell once to update PCC subspace */
1391 		if (send_pcc_cmd(pcc_ss_id, CMD_READ) < 0) {
1392 			ret = -EIO;
1393 			goto out_err;
1394 		}
1395 	}
1396 
1397 	ret = cpc_read(cpunum, highest_reg, &high);
1398 	if (ret)
1399 		goto out_err;
1400 	perf_caps->highest_perf = high;
1401 
1402 	ret = cpc_read(cpunum, lowest_reg, &low);
1403 	if (ret)
1404 		goto out_err;
1405 	perf_caps->lowest_perf = low;
1406 
1407 	ret = cpc_read(cpunum, nominal_reg, &nom);
1408 	if (ret)
1409 		goto out_err;
1410 	perf_caps->nominal_perf = nom;
1411 
1412 	/*
1413 	 * If reference perf register is not supported then we should
1414 	 * use the nominal perf value
1415 	 */
1416 	if (CPC_SUPPORTED(reference_reg)) {
1417 		ret = cpc_read(cpunum, reference_reg, &ref);
1418 		if (ret)
1419 			goto out_err;
1420 	} else {
1421 		ref = nom;
1422 	}
1423 	perf_caps->reference_perf = ref;
1424 
1425 	if (guaranteed_reg->type != ACPI_TYPE_BUFFER  ||
1426 	    IS_NULL_REG(&guaranteed_reg->cpc_entry.reg)) {
1427 		perf_caps->guaranteed_perf = 0;
1428 	} else {
1429 		ret = cpc_read(cpunum, guaranteed_reg, &guaranteed);
1430 		if (ret)
1431 			goto out_err;
1432 		perf_caps->guaranteed_perf = guaranteed;
1433 	}
1434 
1435 	ret = cpc_read(cpunum, lowest_non_linear_reg, &min_nonlinear);
1436 	if (ret)
1437 		goto out_err;
1438 	perf_caps->lowest_nonlinear_perf = min_nonlinear;
1439 
1440 	if (!high || !low || !nom || !ref || !min_nonlinear) {
1441 		ret = -EFAULT;
1442 		goto out_err;
1443 	}
1444 
1445 	/* Read optional lowest and nominal frequencies if present */
1446 	if (CPC_SUPPORTED(low_freq_reg)) {
1447 		ret = cpc_read(cpunum, low_freq_reg, &low_f);
1448 		if (ret)
1449 			goto out_err;
1450 	}
1451 
1452 	if (CPC_SUPPORTED(nom_freq_reg)) {
1453 		ret = cpc_read(cpunum, nom_freq_reg, &nom_f);
1454 		if (ret)
1455 			goto out_err;
1456 	}
1457 
1458 	perf_caps->lowest_freq = low_f;
1459 	perf_caps->nominal_freq = nom_f;
1460 
1461 
1462 out_err:
1463 	if (regs_in_pcc)
1464 		up_write(&pcc_ss_data->pcc_lock);
1465 	return ret;
1466 }
1467 EXPORT_SYMBOL_GPL(cppc_get_perf_caps);
1468 
1469 /**
1470  * cppc_perf_ctrs_in_pcc_cpu - Check if any perf counters of a CPU are in PCC.
1471  * @cpu: CPU on which to check perf counters.
1472  *
1473  * Return: true if any of the counters are in PCC regions, false otherwise
1474  */
cppc_perf_ctrs_in_pcc_cpu(unsigned int cpu)1475 bool cppc_perf_ctrs_in_pcc_cpu(unsigned int cpu)
1476 {
1477 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1478 
1479 	return CPC_IN_PCC(&cpc_desc->cpc_regs[DELIVERED_CTR]) ||
1480 		CPC_IN_PCC(&cpc_desc->cpc_regs[REFERENCE_CTR]) ||
1481 		CPC_IN_PCC(&cpc_desc->cpc_regs[CTR_WRAP_TIME]);
1482 }
1483 EXPORT_SYMBOL_GPL(cppc_perf_ctrs_in_pcc_cpu);
1484 
1485 /**
1486  * cppc_perf_ctrs_in_pcc - Check if any perf counters are in a PCC region.
1487  *
1488  * CPPC has flexibility about how CPU performance counters are accessed.
1489  * One of the choices is PCC regions, which can have a high access latency. This
1490  * routine allows callers of cppc_get_perf_ctrs() to know this ahead of time.
1491  *
1492  * Return: true if any of the counters are in PCC regions, false otherwise
1493  */
cppc_perf_ctrs_in_pcc(void)1494 bool cppc_perf_ctrs_in_pcc(void)
1495 {
1496 	int cpu;
1497 
1498 	for_each_online_cpu(cpu) {
1499 		if (cppc_perf_ctrs_in_pcc_cpu(cpu))
1500 			return true;
1501 	}
1502 
1503 	return false;
1504 }
1505 EXPORT_SYMBOL_GPL(cppc_perf_ctrs_in_pcc);
1506 
1507 /**
1508  * cppc_get_perf_ctrs - Read a CPU's performance feedback counters.
1509  * @cpunum: CPU from which to read counters.
1510  * @perf_fb_ctrs: ptr to cppc_perf_fb_ctrs. See cppc_acpi.h
1511  *
1512  * Return: 0 for success with perf_fb_ctrs populated else -ERRNO.
1513  */
cppc_get_perf_ctrs(int cpunum,struct cppc_perf_fb_ctrs * perf_fb_ctrs)1514 int cppc_get_perf_ctrs(int cpunum, struct cppc_perf_fb_ctrs *perf_fb_ctrs)
1515 {
1516 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpunum);
1517 	struct cpc_register_resource *delivered_reg, *reference_reg,
1518 		*ctr_wrap_reg;
1519 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpunum);
1520 	struct cppc_pcc_data *pcc_ss_data = NULL;
1521 	u64 delivered, reference, ctr_wrap_time;
1522 	int ret = 0, regs_in_pcc = 0;
1523 
1524 	if (!cpc_desc) {
1525 		pr_debug("No CPC descriptor for CPU:%d\n", cpunum);
1526 		return -ENODEV;
1527 	}
1528 
1529 	delivered_reg = &cpc_desc->cpc_regs[DELIVERED_CTR];
1530 	reference_reg = &cpc_desc->cpc_regs[REFERENCE_CTR];
1531 	ctr_wrap_reg = &cpc_desc->cpc_regs[CTR_WRAP_TIME];
1532 
1533 	/* Are any of the regs PCC ?*/
1534 	if (CPC_IN_PCC(delivered_reg) || CPC_IN_PCC(reference_reg) ||
1535 		CPC_IN_PCC(ctr_wrap_reg)) {
1536 		if (pcc_ss_id < 0) {
1537 			pr_debug("Invalid pcc_ss_id\n");
1538 			return -ENODEV;
1539 		}
1540 		pcc_ss_data = pcc_data[pcc_ss_id];
1541 		down_write(&pcc_ss_data->pcc_lock);
1542 		regs_in_pcc = 1;
1543 		/* Ring doorbell once to update PCC subspace */
1544 		if (send_pcc_cmd(pcc_ss_id, CMD_READ) < 0) {
1545 			ret = -EIO;
1546 			goto out_err;
1547 		}
1548 	}
1549 
1550 	ret = cpc_read(cpunum, delivered_reg, &delivered);
1551 	if (ret)
1552 		goto out_err;
1553 
1554 	ret = cpc_read(cpunum, reference_reg, &reference);
1555 	if (ret)
1556 		goto out_err;
1557 
1558 	/*
1559 	 * Per spec, if ctr_wrap_time optional register is unsupported, then the
1560 	 * performance counters are assumed to never wrap during the lifetime of
1561 	 * platform
1562 	 */
1563 	ctr_wrap_time = (u64)(~((u64)0));
1564 	if (CPC_SUPPORTED(ctr_wrap_reg)) {
1565 		ret = cpc_read(cpunum, ctr_wrap_reg, &ctr_wrap_time);
1566 		if (ret)
1567 			goto out_err;
1568 	}
1569 
1570 	if (!delivered || !reference) {
1571 		ret = -EFAULT;
1572 		goto out_err;
1573 	}
1574 
1575 	perf_fb_ctrs->delivered = delivered;
1576 	perf_fb_ctrs->reference = reference;
1577 	perf_fb_ctrs->wraparound_time = ctr_wrap_time;
1578 out_err:
1579 	if (regs_in_pcc)
1580 		up_write(&pcc_ss_data->pcc_lock);
1581 	return ret;
1582 }
1583 EXPORT_SYMBOL_GPL(cppc_get_perf_ctrs);
1584 
1585 /*
1586  * Set Energy Performance Preference Register value through
1587  * Performance Controls Interface
1588  */
cppc_set_epp_perf(int cpu,struct cppc_perf_ctrls * perf_ctrls,bool enable)1589 int cppc_set_epp_perf(int cpu, struct cppc_perf_ctrls *perf_ctrls, bool enable)
1590 {
1591 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1592 	struct cpc_register_resource *epp_set_reg;
1593 	struct cpc_register_resource *auto_sel_reg;
1594 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1595 	struct cppc_pcc_data *pcc_ss_data = NULL;
1596 	bool autosel_ffh_sysmem;
1597 	bool epp_ffh_sysmem;
1598 	int ret;
1599 
1600 	if (!cpc_desc) {
1601 		pr_debug("No CPC descriptor for CPU:%d\n", cpu);
1602 		return -ENODEV;
1603 	}
1604 
1605 	auto_sel_reg = &cpc_desc->cpc_regs[AUTO_SEL_ENABLE];
1606 	epp_set_reg = &cpc_desc->cpc_regs[ENERGY_PERF];
1607 
1608 	epp_ffh_sysmem = CPC_SUPPORTED(epp_set_reg) &&
1609 		(CPC_IN_FFH(epp_set_reg) || CPC_IN_SYSTEM_MEMORY(epp_set_reg));
1610 	autosel_ffh_sysmem = CPC_SUPPORTED(auto_sel_reg) &&
1611 		(CPC_IN_FFH(auto_sel_reg) || CPC_IN_SYSTEM_MEMORY(auto_sel_reg));
1612 
1613 	if (CPC_IN_PCC(epp_set_reg) || CPC_IN_PCC(auto_sel_reg)) {
1614 		if (pcc_ss_id < 0) {
1615 			pr_debug("Invalid pcc_ss_id for CPU:%d\n", cpu);
1616 			return -ENODEV;
1617 		}
1618 
1619 		if (CPC_SUPPORTED(auto_sel_reg)) {
1620 			ret = cpc_write(cpu, auto_sel_reg, enable);
1621 			if (ret)
1622 				return ret;
1623 		}
1624 
1625 		if (CPC_SUPPORTED(epp_set_reg)) {
1626 			ret = cpc_write(cpu, epp_set_reg, perf_ctrls->energy_perf);
1627 			if (ret)
1628 				return ret;
1629 		}
1630 
1631 		pcc_ss_data = pcc_data[pcc_ss_id];
1632 
1633 		down_write(&pcc_ss_data->pcc_lock);
1634 		/* after writing CPC, transfer the ownership of PCC to platform */
1635 		ret = send_pcc_cmd(pcc_ss_id, CMD_WRITE);
1636 		up_write(&pcc_ss_data->pcc_lock);
1637 	} else if (osc_cpc_flexible_adr_space_confirmed &&
1638 		   (epp_ffh_sysmem || autosel_ffh_sysmem)) {
1639 		if (autosel_ffh_sysmem) {
1640 			ret = cpc_write(cpu, auto_sel_reg, enable);
1641 			if (ret)
1642 				return ret;
1643 		}
1644 
1645 		if (epp_ffh_sysmem) {
1646 			ret = cpc_write(cpu, epp_set_reg,
1647 					perf_ctrls->energy_perf);
1648 			if (ret)
1649 				return ret;
1650 		}
1651 	} else {
1652 		ret = -ENOTSUPP;
1653 		pr_debug("_CPC in PCC/FFH/SystemMemory are not supported\n");
1654 	}
1655 
1656 	return ret;
1657 }
1658 EXPORT_SYMBOL_GPL(cppc_set_epp_perf);
1659 
1660 /**
1661  * cppc_set_epp() - Write the EPP register.
1662  * @cpu: CPU on which to write register.
1663  * @epp_val: Value to write to the EPP register.
1664  */
cppc_set_epp(int cpu,u64 epp_val)1665 int cppc_set_epp(int cpu, u64 epp_val)
1666 {
1667 	if (epp_val > CPPC_EPP_ENERGY_EFFICIENCY_PREF)
1668 		return -EINVAL;
1669 
1670 	return cppc_set_reg_val(cpu, ENERGY_PERF, epp_val);
1671 }
1672 EXPORT_SYMBOL_GPL(cppc_set_epp);
1673 
1674 /**
1675  * cppc_get_auto_act_window() - Read autonomous activity window register.
1676  * @cpu: CPU from which to read register.
1677  * @auto_act_window: Return address.
1678  *
1679  * According to ACPI 6.5, s8.4.6.1.6, the value read from the autonomous
1680  * activity window register consists of two parts: a 7 bits value indicate
1681  * significand and a 3 bits value indicate exponent.
1682  */
cppc_get_auto_act_window(int cpu,u64 * auto_act_window)1683 int cppc_get_auto_act_window(int cpu, u64 *auto_act_window)
1684 {
1685 	unsigned int exp;
1686 	u64 val, sig;
1687 	int ret;
1688 
1689 	if (auto_act_window == NULL)
1690 		return -EINVAL;
1691 
1692 	ret = cppc_get_reg_val(cpu, AUTO_ACT_WINDOW, &val);
1693 	if (ret)
1694 		return ret;
1695 
1696 	sig = val & CPPC_AUTO_ACT_WINDOW_MAX_SIG;
1697 	exp = (val >> CPPC_AUTO_ACT_WINDOW_SIG_BIT_SIZE) & CPPC_AUTO_ACT_WINDOW_MAX_EXP;
1698 	*auto_act_window = sig * int_pow(10, exp);
1699 
1700 	return 0;
1701 }
1702 EXPORT_SYMBOL_GPL(cppc_get_auto_act_window);
1703 
1704 /**
1705  * cppc_set_auto_act_window() - Write autonomous activity window register.
1706  * @cpu: CPU on which to write register.
1707  * @auto_act_window: usec value to write to the autonomous activity window register.
1708  *
1709  * According to ACPI 6.5, s8.4.6.1.6, the value to write to the autonomous
1710  * activity window register consists of two parts: a 7 bits value indicate
1711  * significand and a 3 bits value indicate exponent.
1712  */
cppc_set_auto_act_window(int cpu,u64 auto_act_window)1713 int cppc_set_auto_act_window(int cpu, u64 auto_act_window)
1714 {
1715 	/* The max value to store is 1270000000 */
1716 	u64 max_val = CPPC_AUTO_ACT_WINDOW_MAX_SIG * int_pow(10, CPPC_AUTO_ACT_WINDOW_MAX_EXP);
1717 	int exp = 0;
1718 	u64 val;
1719 
1720 	if (auto_act_window > max_val)
1721 		return -EINVAL;
1722 
1723 	/*
1724 	 * The max significand is 127, when auto_act_window is larger than
1725 	 * 129, discard the precision of the last digit and increase the
1726 	 * exponent by 1.
1727 	 */
1728 	while (auto_act_window > CPPC_AUTO_ACT_WINDOW_SIG_CARRY_THRESH) {
1729 		auto_act_window /= 10;
1730 		exp += 1;
1731 	}
1732 
1733 	/* For 128 and 129, cut it to 127. */
1734 	if (auto_act_window > CPPC_AUTO_ACT_WINDOW_MAX_SIG)
1735 		auto_act_window = CPPC_AUTO_ACT_WINDOW_MAX_SIG;
1736 
1737 	val = (exp << CPPC_AUTO_ACT_WINDOW_SIG_BIT_SIZE) + auto_act_window;
1738 
1739 	return cppc_set_reg_val(cpu, AUTO_ACT_WINDOW, val);
1740 }
1741 EXPORT_SYMBOL_GPL(cppc_set_auto_act_window);
1742 
1743 /**
1744  * cppc_get_auto_sel() - Read autonomous selection register.
1745  * @cpu: CPU from which to read register.
1746  * @enable: Return address.
1747  */
cppc_get_auto_sel(int cpu,bool * enable)1748 int cppc_get_auto_sel(int cpu, bool *enable)
1749 {
1750 	u64 auto_sel;
1751 	int ret;
1752 
1753 	if (enable == NULL)
1754 		return -EINVAL;
1755 
1756 	ret = cppc_get_reg_val(cpu, AUTO_SEL_ENABLE, &auto_sel);
1757 	if (ret)
1758 		return ret;
1759 
1760 	*enable = (bool)auto_sel;
1761 
1762 	return 0;
1763 }
1764 EXPORT_SYMBOL_GPL(cppc_get_auto_sel);
1765 
1766 /**
1767  * cppc_set_auto_sel - Write autonomous selection register.
1768  * @cpu    : CPU to which to write register.
1769  * @enable : the desired value of autonomous selection resiter to be updated.
1770  */
cppc_set_auto_sel(int cpu,bool enable)1771 int cppc_set_auto_sel(int cpu, bool enable)
1772 {
1773 	return cppc_set_reg_val(cpu, AUTO_SEL_ENABLE, enable);
1774 }
1775 EXPORT_SYMBOL_GPL(cppc_set_auto_sel);
1776 
1777 /**
1778  * cppc_set_enable - Set to enable CPPC on the processor by writing the
1779  * Continuous Performance Control package EnableRegister field.
1780  * @cpu: CPU for which to enable CPPC register.
1781  * @enable: 0 - disable, 1 - enable CPPC feature on the processor.
1782  *
1783  * Return: 0 for success, -ERRNO or -EIO otherwise.
1784  */
cppc_set_enable(int cpu,bool enable)1785 int cppc_set_enable(int cpu, bool enable)
1786 {
1787 	return cppc_set_reg_val(cpu, ENABLE, enable);
1788 }
1789 EXPORT_SYMBOL_GPL(cppc_set_enable);
1790 
1791 /**
1792  * cppc_get_perf - Get a CPU's performance controls.
1793  * @cpu: CPU for which to get performance controls.
1794  * @perf_ctrls: ptr to cppc_perf_ctrls. See cppc_acpi.h
1795  *
1796  * Return: 0 for success with perf_ctrls, -ERRNO otherwise.
1797  */
cppc_get_perf(int cpu,struct cppc_perf_ctrls * perf_ctrls)1798 int cppc_get_perf(int cpu, struct cppc_perf_ctrls *perf_ctrls)
1799 {
1800 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1801 	struct cpc_register_resource *desired_perf_reg,
1802 				     *min_perf_reg, *max_perf_reg,
1803 				     *energy_perf_reg, *auto_sel_reg;
1804 	u64 desired_perf = 0, min = 0, max = 0, energy_perf = 0, auto_sel = 0;
1805 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1806 	struct cppc_pcc_data *pcc_ss_data = NULL;
1807 	int ret = 0, regs_in_pcc = 0;
1808 
1809 	if (!cpc_desc) {
1810 		pr_debug("No CPC descriptor for CPU:%d\n", cpu);
1811 		return -ENODEV;
1812 	}
1813 
1814 	if (!perf_ctrls) {
1815 		pr_debug("Invalid perf_ctrls pointer\n");
1816 		return -EINVAL;
1817 	}
1818 
1819 	desired_perf_reg = &cpc_desc->cpc_regs[DESIRED_PERF];
1820 	min_perf_reg = &cpc_desc->cpc_regs[MIN_PERF];
1821 	max_perf_reg = &cpc_desc->cpc_regs[MAX_PERF];
1822 	energy_perf_reg = &cpc_desc->cpc_regs[ENERGY_PERF];
1823 	auto_sel_reg = &cpc_desc->cpc_regs[AUTO_SEL_ENABLE];
1824 
1825 	/* Are any of the regs PCC ?*/
1826 	if (CPC_IN_PCC(desired_perf_reg) || CPC_IN_PCC(min_perf_reg) ||
1827 	    CPC_IN_PCC(max_perf_reg) || CPC_IN_PCC(energy_perf_reg) ||
1828 	    CPC_IN_PCC(auto_sel_reg)) {
1829 		if (pcc_ss_id < 0) {
1830 			pr_debug("Invalid pcc_ss_id for CPU:%d\n", cpu);
1831 			return -ENODEV;
1832 		}
1833 		pcc_ss_data = pcc_data[pcc_ss_id];
1834 		regs_in_pcc = 1;
1835 		down_write(&pcc_ss_data->pcc_lock);
1836 		/* Ring doorbell once to update PCC subspace */
1837 		if (send_pcc_cmd(pcc_ss_id, CMD_READ) < 0) {
1838 			ret = -EIO;
1839 			goto out_err;
1840 		}
1841 	}
1842 
1843 	/* Read optional elements if present */
1844 	if (CPC_SUPPORTED(max_perf_reg)) {
1845 		ret = cpc_read(cpu, max_perf_reg, &max);
1846 		if (ret)
1847 			goto out_err;
1848 	}
1849 	perf_ctrls->max_perf = max;
1850 
1851 	if (CPC_SUPPORTED(min_perf_reg)) {
1852 		ret = cpc_read(cpu, min_perf_reg, &min);
1853 		if (ret)
1854 			goto out_err;
1855 	}
1856 	perf_ctrls->min_perf = min;
1857 
1858 	if (CPC_SUPPORTED(desired_perf_reg)) {
1859 		ret = cpc_read(cpu, desired_perf_reg, &desired_perf);
1860 		if (ret)
1861 			goto out_err;
1862 	}
1863 	perf_ctrls->desired_perf = desired_perf;
1864 
1865 	if (CPC_SUPPORTED(energy_perf_reg)) {
1866 		ret = cpc_read(cpu, energy_perf_reg, &energy_perf);
1867 		if (ret)
1868 			goto out_err;
1869 	}
1870 	perf_ctrls->energy_perf = energy_perf;
1871 
1872 	if (CPC_SUPPORTED(auto_sel_reg)) {
1873 		ret = cpc_read(cpu, auto_sel_reg, &auto_sel);
1874 		if (ret)
1875 			goto out_err;
1876 	}
1877 	perf_ctrls->auto_sel = (bool)auto_sel;
1878 
1879 out_err:
1880 	if (regs_in_pcc)
1881 		up_write(&pcc_ss_data->pcc_lock);
1882 	return ret;
1883 }
1884 EXPORT_SYMBOL_GPL(cppc_get_perf);
1885 
1886 /**
1887  * cppc_set_perf - Set a CPU's performance controls.
1888  * @cpu: CPU for which to set performance controls.
1889  * @perf_ctrls: ptr to cppc_perf_ctrls. See cppc_acpi.h
1890  *
1891  * Return: 0 for success, -ERRNO otherwise.
1892  */
cppc_set_perf(int cpu,struct cppc_perf_ctrls * perf_ctrls)1893 int cppc_set_perf(int cpu, struct cppc_perf_ctrls *perf_ctrls)
1894 {
1895 	struct cpc_desc *cpc_desc = per_cpu(cpc_desc_ptr, cpu);
1896 	struct cpc_register_resource *desired_reg, *min_perf_reg, *max_perf_reg;
1897 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu);
1898 	struct cppc_pcc_data *pcc_ss_data = NULL;
1899 	int ret = 0;
1900 
1901 	if (!cpc_desc) {
1902 		pr_debug("No CPC descriptor for CPU:%d\n", cpu);
1903 		return -ENODEV;
1904 	}
1905 
1906 	desired_reg = &cpc_desc->cpc_regs[DESIRED_PERF];
1907 	min_perf_reg = &cpc_desc->cpc_regs[MIN_PERF];
1908 	max_perf_reg = &cpc_desc->cpc_regs[MAX_PERF];
1909 
1910 	/*
1911 	 * This is Phase-I where we want to write to CPC registers
1912 	 * -> We want all CPUs to be able to execute this phase in parallel
1913 	 *
1914 	 * Since read_lock can be acquired by multiple CPUs simultaneously we
1915 	 * achieve that goal here
1916 	 */
1917 	if (CPC_IN_PCC(desired_reg) || CPC_IN_PCC(min_perf_reg) || CPC_IN_PCC(max_perf_reg)) {
1918 		if (pcc_ss_id < 0) {
1919 			pr_debug("Invalid pcc_ss_id\n");
1920 			return -ENODEV;
1921 		}
1922 		pcc_ss_data = pcc_data[pcc_ss_id];
1923 		down_read(&pcc_ss_data->pcc_lock); /* BEGIN Phase-I */
1924 		if (pcc_ss_data->platform_owns_pcc) {
1925 			ret = check_pcc_chan(pcc_ss_id, false);
1926 			if (ret) {
1927 				up_read(&pcc_ss_data->pcc_lock);
1928 				return ret;
1929 			}
1930 		}
1931 		/*
1932 		 * Update the pending_write to make sure a PCC CMD_READ will not
1933 		 * arrive and steal the channel during the switch to write lock
1934 		 */
1935 		pcc_ss_data->pending_pcc_write_cmd = true;
1936 		cpc_desc->write_cmd_id = pcc_ss_data->pcc_write_cnt;
1937 		cpc_desc->write_cmd_status = 0;
1938 	}
1939 
1940 	cpc_write(cpu, desired_reg, perf_ctrls->desired_perf);
1941 
1942 	/*
1943 	 * Only write if min_perf and max_perf not zero. Some drivers pass zero
1944 	 * value to min and max perf, but they don't mean to set the zero value,
1945 	 * they just don't want to write to those registers.
1946 	 */
1947 	if (perf_ctrls->min_perf)
1948 		cpc_write(cpu, min_perf_reg, perf_ctrls->min_perf);
1949 	if (perf_ctrls->max_perf)
1950 		cpc_write(cpu, max_perf_reg, perf_ctrls->max_perf);
1951 
1952 	if (CPC_IN_PCC(desired_reg) || CPC_IN_PCC(min_perf_reg) || CPC_IN_PCC(max_perf_reg))
1953 		up_read(&pcc_ss_data->pcc_lock);	/* END Phase-I */
1954 	/*
1955 	 * This is Phase-II where we transfer the ownership of PCC to Platform
1956 	 *
1957 	 * Short Summary: Basically if we think of a group of cppc_set_perf
1958 	 * requests that happened in short overlapping interval. The last CPU to
1959 	 * come out of Phase-I will enter Phase-II and ring the doorbell.
1960 	 *
1961 	 * We have the following requirements for Phase-II:
1962 	 *     1. We want to execute Phase-II only when there are no CPUs
1963 	 * currently executing in Phase-I
1964 	 *     2. Once we start Phase-II we want to avoid all other CPUs from
1965 	 * entering Phase-I.
1966 	 *     3. We want only one CPU among all those who went through Phase-I
1967 	 * to run phase-II
1968 	 *
1969 	 * If write_trylock fails to get the lock and doesn't transfer the
1970 	 * PCC ownership to the platform, then one of the following will be TRUE
1971 	 *     1. There is at-least one CPU in Phase-I which will later execute
1972 	 * write_trylock, so the CPUs in Phase-I will be responsible for
1973 	 * executing the Phase-II.
1974 	 *     2. Some other CPU has beaten this CPU to successfully execute the
1975 	 * write_trylock and has already acquired the write_lock. We know for a
1976 	 * fact it (other CPU acquiring the write_lock) couldn't have happened
1977 	 * before this CPU's Phase-I as we held the read_lock.
1978 	 *     3. Some other CPU executing pcc CMD_READ has stolen the
1979 	 * down_write, in which case, send_pcc_cmd will check for pending
1980 	 * CMD_WRITE commands by checking the pending_pcc_write_cmd.
1981 	 * So this CPU can be certain that its request will be delivered
1982 	 *    So in all cases, this CPU knows that its request will be delivered
1983 	 * by another CPU and can return
1984 	 *
1985 	 * After getting the down_write we still need to check for
1986 	 * pending_pcc_write_cmd to take care of the following scenario
1987 	 *    The thread running this code could be scheduled out between
1988 	 * Phase-I and Phase-II. Before it is scheduled back on, another CPU
1989 	 * could have delivered the request to Platform by triggering the
1990 	 * doorbell and transferred the ownership of PCC to platform. So this
1991 	 * avoids triggering an unnecessary doorbell and more importantly before
1992 	 * triggering the doorbell it makes sure that the PCC channel ownership
1993 	 * is still with OSPM.
1994 	 *   pending_pcc_write_cmd can also be cleared by a different CPU, if
1995 	 * there was a pcc CMD_READ waiting on down_write and it steals the lock
1996 	 * before the pcc CMD_WRITE is completed. send_pcc_cmd checks for this
1997 	 * case during a CMD_READ and if there are pending writes it delivers
1998 	 * the write command before servicing the read command
1999 	 */
2000 	if (CPC_IN_PCC(desired_reg) || CPC_IN_PCC(min_perf_reg) || CPC_IN_PCC(max_perf_reg)) {
2001 		if (down_write_trylock(&pcc_ss_data->pcc_lock)) {/* BEGIN Phase-II */
2002 			/* Update only if there are pending write commands */
2003 			if (pcc_ss_data->pending_pcc_write_cmd)
2004 				send_pcc_cmd(pcc_ss_id, CMD_WRITE);
2005 			up_write(&pcc_ss_data->pcc_lock);	/* END Phase-II */
2006 		} else
2007 			/* Wait until pcc_write_cnt is updated by send_pcc_cmd */
2008 			wait_event(pcc_ss_data->pcc_write_wait_q,
2009 				   cpc_desc->write_cmd_id != pcc_ss_data->pcc_write_cnt);
2010 
2011 		/* send_pcc_cmd updates the status in case of failure */
2012 		ret = cpc_desc->write_cmd_status;
2013 	}
2014 	return ret;
2015 }
2016 EXPORT_SYMBOL_GPL(cppc_set_perf);
2017 
2018 /**
2019  * cppc_get_perf_limited - Get the Performance Limited register value.
2020  * @cpu: CPU from which to get Performance Limited register.
2021  * @perf_limited: Pointer to store the Performance Limited value.
2022  *
2023  * The returned value contains sticky status bits indicating platform-imposed
2024  * performance limitations.
2025  *
2026  * Return: 0 for success, -EIO on failure, -EOPNOTSUPP if not supported.
2027  */
cppc_get_perf_limited(int cpu,u64 * perf_limited)2028 int cppc_get_perf_limited(int cpu, u64 *perf_limited)
2029 {
2030 	return cppc_get_reg_val(cpu, PERF_LIMITED, perf_limited);
2031 }
2032 EXPORT_SYMBOL_GPL(cppc_get_perf_limited);
2033 
2034 /**
2035  * cppc_set_perf_limited() - Clear bits in the Performance Limited register.
2036  * @cpu: CPU on which to write register.
2037  * @bits_to_clear: Bitmask of bits to clear in the perf_limited register.
2038  *
2039  * The Performance Limited register contains two sticky bits set by platform:
2040  *   - Bit 0 (Desired_Excursion): Set when delivered performance is constrained
2041  *     below desired performance. Not used when Autonomous Selection is enabled.
2042  *   - Bit 1 (Minimum_Excursion): Set when delivered performance is constrained
2043  *     below minimum performance.
2044  *
2045  * These bits are sticky and remain set until OSPM explicitly clears them.
2046  * This function only allows clearing bits (the platform sets them).
2047  *
2048  * Return: 0 for success, -EINVAL for invalid bits, -EIO on register
2049  *         access failure, -EOPNOTSUPP if not supported.
2050  */
cppc_set_perf_limited(int cpu,u64 bits_to_clear)2051 int cppc_set_perf_limited(int cpu, u64 bits_to_clear)
2052 {
2053 	u64 current_val, new_val;
2054 	int ret;
2055 
2056 	/* Only bits 0 and 1 are valid */
2057 	if (bits_to_clear & ~CPPC_PERF_LIMITED_MASK)
2058 		return -EINVAL;
2059 
2060 	if (!bits_to_clear)
2061 		return 0;
2062 
2063 	ret = cppc_get_perf_limited(cpu, &current_val);
2064 	if (ret)
2065 		return ret;
2066 
2067 	/* Clear the specified bits */
2068 	new_val = current_val & ~bits_to_clear;
2069 
2070 	return cppc_set_reg_val(cpu, PERF_LIMITED, new_val);
2071 }
2072 EXPORT_SYMBOL_GPL(cppc_set_perf_limited);
2073 
2074 /**
2075  * cppc_get_transition_latency - returns frequency transition latency in ns
2076  * @cpu_num: CPU number for per_cpu().
2077  *
2078  * ACPI CPPC does not explicitly specify how a platform can specify the
2079  * transition latency for performance change requests. The closest we have
2080  * is the timing information from the PCCT tables which provides the info
2081  * on the number and frequency of PCC commands the platform can handle.
2082  *
2083  * If desired_reg is in the SystemMemory or SystemIo ACPI address space,
2084  * then assume there is no latency.
2085  */
cppc_get_transition_latency(int cpu_num)2086 int cppc_get_transition_latency(int cpu_num)
2087 {
2088 	/*
2089 	 * Expected transition latency is based on the PCCT timing values
2090 	 * Below are definition from ACPI spec:
2091 	 * pcc_nominal- Expected latency to process a command, in microseconds
2092 	 * pcc_mpar   - The maximum number of periodic requests that the subspace
2093 	 *              channel can support, reported in commands per minute. 0
2094 	 *              indicates no limitation.
2095 	 * pcc_mrtt   - The minimum amount of time that OSPM must wait after the
2096 	 *              completion of a command before issuing the next command,
2097 	 *              in microseconds.
2098 	 */
2099 	struct cpc_desc *cpc_desc;
2100 	struct cpc_register_resource *desired_reg;
2101 	int pcc_ss_id = per_cpu(cpu_pcc_subspace_idx, cpu_num);
2102 	struct cppc_pcc_data *pcc_ss_data;
2103 	int latency_ns = 0;
2104 
2105 	cpc_desc = per_cpu(cpc_desc_ptr, cpu_num);
2106 	if (!cpc_desc)
2107 		return -ENODATA;
2108 
2109 	desired_reg = &cpc_desc->cpc_regs[DESIRED_PERF];
2110 	if (CPC_IN_SYSTEM_MEMORY(desired_reg) || CPC_IN_SYSTEM_IO(desired_reg))
2111 		return 0;
2112 
2113 	if (!CPC_IN_PCC(desired_reg) || pcc_ss_id < 0)
2114 		return -ENODATA;
2115 
2116 	pcc_ss_data = pcc_data[pcc_ss_id];
2117 	if (pcc_ss_data->pcc_mpar)
2118 		latency_ns = 60 * (1000 * 1000 * 1000 / pcc_ss_data->pcc_mpar);
2119 
2120 	latency_ns = max_t(int, latency_ns, pcc_ss_data->pcc_nominal * 1000);
2121 	latency_ns = max_t(int, latency_ns, pcc_ss_data->pcc_mrtt * 1000);
2122 
2123 	return latency_ns;
2124 }
2125 EXPORT_SYMBOL_GPL(cppc_get_transition_latency);
2126 
2127 /* Minimum struct length needed for the DMI processor entry we want */
2128 #define DMI_ENTRY_PROCESSOR_MIN_LENGTH	48
2129 
2130 /* Offset in the DMI processor structure for the max frequency */
2131 #define DMI_PROCESSOR_MAX_SPEED		0x14
2132 
2133 /* Callback function used to retrieve the max frequency from DMI */
cppc_find_dmi_mhz(const struct dmi_header * dm,void * private)2134 static void cppc_find_dmi_mhz(const struct dmi_header *dm, void *private)
2135 {
2136 	const u8 *dmi_data = (const u8 *)dm;
2137 	u16 *mhz = (u16 *)private;
2138 
2139 	if (dm->type == DMI_ENTRY_PROCESSOR &&
2140 	    dm->length >= DMI_ENTRY_PROCESSOR_MIN_LENGTH) {
2141 		u16 val = (u16)get_unaligned((const u16 *)
2142 				(dmi_data + DMI_PROCESSOR_MAX_SPEED));
2143 		*mhz = umax(val, *mhz);
2144 	}
2145 }
2146 
2147 /* Look up the max frequency in DMI */
cppc_get_dmi_max_khz(void)2148 u64 cppc_get_dmi_max_khz(void)
2149 {
2150 	u16 mhz = 0;
2151 
2152 	dmi_walk(cppc_find_dmi_mhz, &mhz);
2153 
2154 	/*
2155 	 * Real stupid fallback value, just in case there is no
2156 	 * actual value set.
2157 	 */
2158 	mhz = mhz ? mhz : 1;
2159 
2160 	return KHZ_PER_MHZ * mhz;
2161 }
2162 EXPORT_SYMBOL_GPL(cppc_get_dmi_max_khz);
2163 
2164 /*
2165  * If CPPC lowest_freq and nominal_freq registers are exposed then we can
2166  * use them to convert perf to freq and vice versa. The conversion is
2167  * extrapolated as an affine function passing by the 2 points:
2168  *  - (Low perf, Low freq)
2169  *  - (Nominal perf, Nominal freq)
2170  */
cppc_perf_to_khz(struct cppc_perf_caps * caps,unsigned int perf)2171 unsigned int cppc_perf_to_khz(struct cppc_perf_caps *caps, unsigned int perf)
2172 {
2173 	s64 retval, offset = 0;
2174 	static u64 max_khz;
2175 	u64 mul, div;
2176 
2177 	if (caps->lowest_freq && caps->nominal_freq) {
2178 		/* Avoid special case when nominal_freq is equal to lowest_freq */
2179 		if (caps->lowest_freq == caps->nominal_freq) {
2180 			mul = caps->nominal_freq;
2181 			div = caps->nominal_perf;
2182 		} else {
2183 			mul = caps->nominal_freq - caps->lowest_freq;
2184 			div = caps->nominal_perf - caps->lowest_perf;
2185 		}
2186 		mul *= KHZ_PER_MHZ;
2187 		offset = caps->nominal_freq * KHZ_PER_MHZ -
2188 			 div64_u64(caps->nominal_perf * mul, div);
2189 	} else {
2190 		if (!max_khz)
2191 			max_khz = cppc_get_dmi_max_khz();
2192 		mul = max_khz;
2193 		div = caps->highest_perf;
2194 	}
2195 
2196 	retval = offset + div64_u64(perf * mul, div);
2197 	if (retval >= 0)
2198 		return retval;
2199 	return 0;
2200 }
2201 EXPORT_SYMBOL_GPL(cppc_perf_to_khz);
2202 
cppc_khz_to_perf(struct cppc_perf_caps * caps,unsigned int freq)2203 unsigned int cppc_khz_to_perf(struct cppc_perf_caps *caps, unsigned int freq)
2204 {
2205 	s64 retval, offset = 0;
2206 	static u64 max_khz;
2207 	u64 mul, div;
2208 
2209 	if (caps->lowest_freq && caps->nominal_freq) {
2210 		/* Avoid special case when nominal_freq is equal to lowest_freq */
2211 		if (caps->lowest_freq == caps->nominal_freq) {
2212 			mul = caps->nominal_perf;
2213 			div = caps->nominal_freq;
2214 		} else {
2215 			mul = caps->nominal_perf - caps->lowest_perf;
2216 			div = caps->nominal_freq - caps->lowest_freq;
2217 		}
2218 		/*
2219 		 * We don't need to convert to kHz for computing offset and can
2220 		 * directly use nominal_freq and lowest_freq as the div64_u64
2221 		 * will remove the frequency unit.
2222 		 */
2223 		offset = caps->nominal_perf -
2224 			 div64_u64(caps->nominal_freq * mul, div);
2225 		/* But we need it for computing the perf level. */
2226 		div *= KHZ_PER_MHZ;
2227 	} else {
2228 		if (!max_khz)
2229 			max_khz = cppc_get_dmi_max_khz();
2230 		mul = caps->highest_perf;
2231 		div = max_khz;
2232 	}
2233 
2234 	retval = offset + div64_u64(freq * mul, div);
2235 	if (retval >= 0)
2236 		return retval;
2237 	return 0;
2238 }
2239 EXPORT_SYMBOL_GPL(cppc_khz_to_perf);
2240