2 * pcc-cpufreq.c - Processor Clocking Control firmware cpufreq interface
4 * Copyright (C) 2009 Red Hat, Matthew Garrett <mjg@redhat.com>
5 * Copyright (C) 2009 Hewlett-Packard Development Company, L.P.
6 * Nagananda Chumbalkar <nagananda.chumbalkar@hp.com>
8 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; version 2 of the License.
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or NON
17 * INFRINGEMENT. See the GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License along
20 * with this program; if not, write to the Free Software Foundation, Inc.,
21 * 675 Mass Ave, Cambridge, MA 02139, USA.
23 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/smp.h>
30 #include <linux/sched.h>
31 #include <linux/cpufreq.h>
32 #include <linux/compiler.h>
33 #include <linux/slab.h>
35 #include <linux/acpi.h>
37 #include <linux/spinlock.h>
38 #include <linux/uaccess.h>
40 #include <acpi/processor.h>
42 #define PCC_VERSION "1.10.00"
43 #define POLL_LOOPS 300
45 #define CMD_COMPLETE 0x1
46 #define CMD_GET_FREQ 0x0
47 #define CMD_SET_FREQ 0x1
51 struct pcc_register_resource
{
59 } __attribute__ ((packed
));
61 struct pcc_memory_resource
{
70 u64 translation_offset
;
72 } __attribute__ ((packed
));
74 static struct cpufreq_driver pcc_cpufreq_driver
;
88 u32 throttled_frequency
;
89 u32 minimum_frequency
;
92 static void __iomem
*pcch_virt_addr
;
93 static struct pcc_header __iomem
*pcch_hdr
;
95 static DEFINE_SPINLOCK(pcc_lock
);
97 static struct acpi_generic_address doorbell
;
99 static u64 doorbell_preserve
;
100 static u64 doorbell_write
;
102 static u8 OSC_UUID
[16] = {0x9F, 0x2C, 0x9B, 0x63, 0x91, 0x70, 0x1f, 0x49,
103 0xBB, 0x4F, 0xA5, 0x98, 0x2F, 0xA1, 0xB5, 0x46};
110 static struct pcc_cpu __percpu
*pcc_cpu_info
;
112 static int pcc_cpufreq_verify(struct cpufreq_policy
*policy
)
114 cpufreq_verify_within_limits(policy
, policy
->cpuinfo
.min_freq
,
115 policy
->cpuinfo
.max_freq
);
119 static inline void pcc_cmd(void)
124 acpi_read(&doorbell_value
, &doorbell
);
125 acpi_write((doorbell_value
& doorbell_preserve
) | doorbell_write
,
128 for (i
= 0; i
< POLL_LOOPS
; i
++) {
129 if (ioread16(&pcch_hdr
->status
) & CMD_COMPLETE
)
134 static inline void pcc_clear_mapping(void)
137 iounmap(pcch_virt_addr
);
138 pcch_virt_addr
= NULL
;
141 static unsigned int pcc_get_freq(unsigned int cpu
)
143 struct pcc_cpu
*pcc_cpu_data
;
144 unsigned int curr_freq
;
145 unsigned int freq_limit
;
150 spin_lock(&pcc_lock
);
152 pr_debug("get: get_freq for CPU %d\n", cpu
);
153 pcc_cpu_data
= per_cpu_ptr(pcc_cpu_info
, cpu
);
156 iowrite32(input_buffer
,
157 (pcch_virt_addr
+ pcc_cpu_data
->input_offset
));
158 iowrite16(CMD_GET_FREQ
, &pcch_hdr
->command
);
163 ioread32(pcch_virt_addr
+ pcc_cpu_data
->output_offset
);
165 /* Clear the input buffer - we are done with the current command */
166 memset_io((pcch_virt_addr
+ pcc_cpu_data
->input_offset
), 0, BUF_SZ
);
168 status
= ioread16(&pcch_hdr
->status
);
169 if (status
!= CMD_COMPLETE
) {
170 pr_debug("get: FAILED: for CPU %d, status is %d\n",
174 iowrite16(0, &pcch_hdr
->status
);
175 curr_freq
= (((ioread32(&pcch_hdr
->nominal
) * (output_buffer
& 0xff))
178 pr_debug("get: SUCCESS: (virtual) output_offset for cpu %d is "
179 "0x%p, contains a value of: 0x%x. Speed is: %d MHz\n",
180 cpu
, (pcch_virt_addr
+ pcc_cpu_data
->output_offset
),
181 output_buffer
, curr_freq
);
183 freq_limit
= (output_buffer
>> 8) & 0xff;
184 if (freq_limit
!= 0xff) {
185 pr_debug("get: frequency for cpu %d is being temporarily"
186 " capped at %d\n", cpu
, curr_freq
);
189 spin_unlock(&pcc_lock
);
193 iowrite16(0, &pcch_hdr
->status
);
194 spin_unlock(&pcc_lock
);
198 static int pcc_cpufreq_target(struct cpufreq_policy
*policy
,
199 unsigned int target_freq
,
200 unsigned int relation
)
202 struct pcc_cpu
*pcc_cpu_data
;
203 struct cpufreq_freqs freqs
;
208 spin_lock(&pcc_lock
);
210 pcc_cpu_data
= per_cpu_ptr(pcc_cpu_info
, cpu
);
212 pr_debug("target: CPU %d should go to target freq: %d "
213 "(virtual) input_offset is 0x%p\n",
215 (pcch_virt_addr
+ pcc_cpu_data
->input_offset
));
217 freqs
.new = target_freq
;
218 cpufreq_notify_transition(policy
, &freqs
, CPUFREQ_PRECHANGE
);
220 input_buffer
= 0x1 | (((target_freq
* 100)
221 / (ioread32(&pcch_hdr
->nominal
) * 1000)) << 8);
222 iowrite32(input_buffer
,
223 (pcch_virt_addr
+ pcc_cpu_data
->input_offset
));
224 iowrite16(CMD_SET_FREQ
, &pcch_hdr
->command
);
228 /* Clear the input buffer - we are done with the current command */
229 memset_io((pcch_virt_addr
+ pcc_cpu_data
->input_offset
), 0, BUF_SZ
);
231 status
= ioread16(&pcch_hdr
->status
);
232 if (status
!= CMD_COMPLETE
) {
233 pr_debug("target: FAILED for cpu %d, with status: 0x%x\n",
237 iowrite16(0, &pcch_hdr
->status
);
239 cpufreq_notify_transition(policy
, &freqs
, CPUFREQ_POSTCHANGE
);
240 pr_debug("target: was SUCCESSFUL for cpu %d\n", cpu
);
241 spin_unlock(&pcc_lock
);
246 freqs
.new = freqs
.old
;
247 cpufreq_notify_transition(policy
, &freqs
, CPUFREQ_POSTCHANGE
);
248 iowrite16(0, &pcch_hdr
->status
);
249 spin_unlock(&pcc_lock
);
253 static int pcc_get_offset(int cpu
)
256 struct acpi_buffer buffer
= {ACPI_ALLOCATE_BUFFER
, NULL
};
257 union acpi_object
*pccp
, *offset
;
258 struct pcc_cpu
*pcc_cpu_data
;
259 struct acpi_processor
*pr
;
262 pr
= per_cpu(processors
, cpu
);
263 pcc_cpu_data
= per_cpu_ptr(pcc_cpu_info
, cpu
);
268 status
= acpi_evaluate_object(pr
->handle
, "PCCP", NULL
, &buffer
);
269 if (ACPI_FAILURE(status
))
272 pccp
= buffer
.pointer
;
273 if (!pccp
|| pccp
->type
!= ACPI_TYPE_PACKAGE
) {
278 offset
= &(pccp
->package
.elements
[0]);
279 if (!offset
|| offset
->type
!= ACPI_TYPE_INTEGER
) {
284 pcc_cpu_data
->input_offset
= offset
->integer
.value
;
286 offset
= &(pccp
->package
.elements
[1]);
287 if (!offset
|| offset
->type
!= ACPI_TYPE_INTEGER
) {
292 pcc_cpu_data
->output_offset
= offset
->integer
.value
;
294 memset_io((pcch_virt_addr
+ pcc_cpu_data
->input_offset
), 0, BUF_SZ
);
295 memset_io((pcch_virt_addr
+ pcc_cpu_data
->output_offset
), 0, BUF_SZ
);
297 pr_debug("pcc_get_offset: for CPU %d: pcc_cpu_data "
298 "input_offset: 0x%x, pcc_cpu_data output_offset: 0x%x\n",
299 cpu
, pcc_cpu_data
->input_offset
, pcc_cpu_data
->output_offset
);
301 kfree(buffer
.pointer
);
305 static int __init
pcc_cpufreq_do_osc(acpi_handle
*handle
)
308 struct acpi_object_list input
;
309 struct acpi_buffer output
= {ACPI_ALLOCATE_BUFFER
, NULL
};
310 union acpi_object in_params
[4];
311 union acpi_object
*out_obj
;
318 input
.pointer
= in_params
;
319 in_params
[0].type
= ACPI_TYPE_BUFFER
;
320 in_params
[0].buffer
.length
= 16;
321 in_params
[0].buffer
.pointer
= OSC_UUID
;
322 in_params
[1].type
= ACPI_TYPE_INTEGER
;
323 in_params
[1].integer
.value
= 1;
324 in_params
[2].type
= ACPI_TYPE_INTEGER
;
325 in_params
[2].integer
.value
= 2;
326 in_params
[3].type
= ACPI_TYPE_BUFFER
;
327 in_params
[3].buffer
.length
= 8;
328 in_params
[3].buffer
.pointer
= (u8
*)&capabilities
;
330 capabilities
[0] = OSC_QUERY_ENABLE
;
331 capabilities
[1] = 0x1;
333 status
= acpi_evaluate_object(*handle
, "_OSC", &input
, &output
);
334 if (ACPI_FAILURE(status
))
340 out_obj
= output
.pointer
;
341 if (out_obj
->type
!= ACPI_TYPE_BUFFER
) {
346 errors
= *((u32
*)out_obj
->buffer
.pointer
) & ~(1 << 0);
352 supported
= *((u32
*)(out_obj
->buffer
.pointer
+ 4));
353 if (!(supported
& 0x1)) {
358 kfree(output
.pointer
);
359 capabilities
[0] = 0x0;
360 capabilities
[1] = 0x1;
362 status
= acpi_evaluate_object(*handle
, "_OSC", &input
, &output
);
363 if (ACPI_FAILURE(status
))
369 out_obj
= output
.pointer
;
370 if (out_obj
->type
!= ACPI_TYPE_BUFFER
) {
375 errors
= *((u32
*)out_obj
->buffer
.pointer
) & ~(1 << 0);
381 supported
= *((u32
*)(out_obj
->buffer
.pointer
+ 4));
382 if (!(supported
& 0x1)) {
388 kfree(output
.pointer
);
392 static int __init
pcc_cpufreq_probe(void)
395 struct acpi_buffer output
= {ACPI_ALLOCATE_BUFFER
, NULL
};
396 struct pcc_memory_resource
*mem_resource
;
397 struct pcc_register_resource
*reg_resource
;
398 union acpi_object
*out_obj
, *member
;
399 acpi_handle handle
, osc_handle
, pcch_handle
;
402 status
= acpi_get_handle(NULL
, "\\_SB", &handle
);
403 if (ACPI_FAILURE(status
))
406 status
= acpi_get_handle(handle
, "PCCH", &pcch_handle
);
407 if (ACPI_FAILURE(status
))
410 status
= acpi_get_handle(handle
, "_OSC", &osc_handle
);
411 if (ACPI_SUCCESS(status
)) {
412 ret
= pcc_cpufreq_do_osc(&osc_handle
);
414 pr_debug("probe: _OSC evaluation did not succeed\n");
415 /* Firmware's use of _OSC is optional */
419 status
= acpi_evaluate_object(handle
, "PCCH", NULL
, &output
);
420 if (ACPI_FAILURE(status
))
423 out_obj
= output
.pointer
;
424 if (out_obj
->type
!= ACPI_TYPE_PACKAGE
) {
429 member
= &out_obj
->package
.elements
[0];
430 if (member
->type
!= ACPI_TYPE_BUFFER
) {
435 mem_resource
= (struct pcc_memory_resource
*)member
->buffer
.pointer
;
437 pr_debug("probe: mem_resource descriptor: 0x%x,"
438 " length: %d, space_id: %d, resource_usage: %d,"
439 " type_specific: %d, granularity: 0x%llx,"
440 " minimum: 0x%llx, maximum: 0x%llx,"
441 " translation_offset: 0x%llx, address_length: 0x%llx\n",
442 mem_resource
->descriptor
, mem_resource
->length
,
443 mem_resource
->space_id
, mem_resource
->resource_usage
,
444 mem_resource
->type_specific
, mem_resource
->granularity
,
445 mem_resource
->minimum
, mem_resource
->maximum
,
446 mem_resource
->translation_offset
,
447 mem_resource
->address_length
);
449 if (mem_resource
->space_id
!= ACPI_ADR_SPACE_SYSTEM_MEMORY
) {
454 pcch_virt_addr
= ioremap_nocache(mem_resource
->minimum
,
455 mem_resource
->address_length
);
456 if (pcch_virt_addr
== NULL
) {
457 pr_debug("probe: could not map shared mem region\n");
461 pcch_hdr
= pcch_virt_addr
;
463 pr_debug("probe: PCCH header (virtual) addr: 0x%p\n", pcch_hdr
);
464 pr_debug("probe: PCCH header is at physical address: 0x%llx,"
465 " signature: 0x%x, length: %d bytes, major: %d, minor: %d,"
466 " supported features: 0x%x, command field: 0x%x,"
467 " status field: 0x%x, nominal latency: %d us\n",
468 mem_resource
->minimum
, ioread32(&pcch_hdr
->signature
),
469 ioread16(&pcch_hdr
->length
), ioread8(&pcch_hdr
->major
),
470 ioread8(&pcch_hdr
->minor
), ioread32(&pcch_hdr
->features
),
471 ioread16(&pcch_hdr
->command
), ioread16(&pcch_hdr
->status
),
472 ioread32(&pcch_hdr
->latency
));
474 pr_debug("probe: min time between commands: %d us,"
475 " max time between commands: %d us,"
476 " nominal CPU frequency: %d MHz,"
477 " minimum CPU frequency: %d MHz,"
478 " minimum CPU frequency without throttling: %d MHz\n",
479 ioread32(&pcch_hdr
->minimum_time
),
480 ioread32(&pcch_hdr
->maximum_time
),
481 ioread32(&pcch_hdr
->nominal
),
482 ioread32(&pcch_hdr
->throttled_frequency
),
483 ioread32(&pcch_hdr
->minimum_frequency
));
485 member
= &out_obj
->package
.elements
[1];
486 if (member
->type
!= ACPI_TYPE_BUFFER
) {
491 reg_resource
= (struct pcc_register_resource
*)member
->buffer
.pointer
;
493 doorbell
.space_id
= reg_resource
->space_id
;
494 doorbell
.bit_width
= reg_resource
->bit_width
;
495 doorbell
.bit_offset
= reg_resource
->bit_offset
;
496 doorbell
.access_width
= 64;
497 doorbell
.address
= reg_resource
->address
;
499 pr_debug("probe: doorbell: space_id is %d, bit_width is %d, "
500 "bit_offset is %d, access_width is %d, address is 0x%llx\n",
501 doorbell
.space_id
, doorbell
.bit_width
, doorbell
.bit_offset
,
502 doorbell
.access_width
, reg_resource
->address
);
504 member
= &out_obj
->package
.elements
[2];
505 if (member
->type
!= ACPI_TYPE_INTEGER
) {
510 doorbell_preserve
= member
->integer
.value
;
512 member
= &out_obj
->package
.elements
[3];
513 if (member
->type
!= ACPI_TYPE_INTEGER
) {
518 doorbell_write
= member
->integer
.value
;
520 pr_debug("probe: doorbell_preserve: 0x%llx,"
521 " doorbell_write: 0x%llx\n",
522 doorbell_preserve
, doorbell_write
);
524 pcc_cpu_info
= alloc_percpu(struct pcc_cpu
);
530 printk(KERN_DEBUG
"pcc-cpufreq: (v%s) driver loaded with frequency"
531 " limits: %d MHz, %d MHz\n", PCC_VERSION
,
532 ioread32(&pcch_hdr
->minimum_frequency
),
533 ioread32(&pcch_hdr
->nominal
));
534 kfree(output
.pointer
);
539 kfree(output
.pointer
);
543 static int pcc_cpufreq_cpu_init(struct cpufreq_policy
*policy
)
545 unsigned int cpu
= policy
->cpu
;
546 unsigned int result
= 0;
548 if (!pcch_virt_addr
) {
553 result
= pcc_get_offset(cpu
);
555 pr_debug("init: PCCP evaluation failed\n");
559 policy
->max
= policy
->cpuinfo
.max_freq
=
560 ioread32(&pcch_hdr
->nominal
) * 1000;
561 policy
->min
= policy
->cpuinfo
.min_freq
=
562 ioread32(&pcch_hdr
->minimum_frequency
) * 1000;
563 policy
->cur
= pcc_get_freq(cpu
);
566 pr_debug("init: Unable to get current CPU frequency\n");
571 pr_debug("init: policy->max is %d, policy->min is %d\n",
572 policy
->max
, policy
->min
);
577 static int pcc_cpufreq_cpu_exit(struct cpufreq_policy
*policy
)
582 static struct cpufreq_driver pcc_cpufreq_driver
= {
583 .flags
= CPUFREQ_CONST_LOOPS
,
585 .verify
= pcc_cpufreq_verify
,
586 .target
= pcc_cpufreq_target
,
587 .init
= pcc_cpufreq_cpu_init
,
588 .exit
= pcc_cpufreq_cpu_exit
,
589 .name
= "pcc-cpufreq",
592 static int __init
pcc_cpufreq_init(void)
599 ret
= pcc_cpufreq_probe();
601 pr_debug("pcc_cpufreq_init: PCCH evaluation failed\n");
605 ret
= cpufreq_register_driver(&pcc_cpufreq_driver
);
610 static void __exit
pcc_cpufreq_exit(void)
612 cpufreq_unregister_driver(&pcc_cpufreq_driver
);
616 free_percpu(pcc_cpu_info
);
619 static const struct acpi_device_id processor_device_ids
[] = {
620 {ACPI_PROCESSOR_OBJECT_HID
, },
621 {ACPI_PROCESSOR_DEVICE_HID
, },
624 MODULE_DEVICE_TABLE(acpi
, processor_device_ids
);
626 MODULE_AUTHOR("Matthew Garrett, Naga Chumbalkar");
627 MODULE_VERSION(PCC_VERSION
);
628 MODULE_DESCRIPTION("Processor Clocking Control interface driver");
629 MODULE_LICENSE("GPL");
631 late_initcall(pcc_cpufreq_init
);
632 module_exit(pcc_cpufreq_exit
);