2 * (c) 2003-2012 Advanced Micro Devices, Inc.
3 * Your use of this code is subject to the terms and conditions of the
4 * GNU general public license version 2. See "COPYING" or
5 * http://www.gnu.org/licenses/gpl.html
8 * Andreas Herrmann <herrmann.der.user@googlemail.com>
10 * Based on the powernow-k7.c module written by Dave Jones.
11 * (C) 2003 Dave Jones on behalf of SuSE Labs
12 * (C) 2004 Dominik Brodowski <linux@brodo.de>
13 * (C) 2004 Pavel Machek <pavel@ucw.cz>
14 * Licensed under the terms of the GNU GPL License version 2.
15 * Based upon datasheets & sample CPUs kindly provided by AMD.
17 * Valuable input gratefully received from Dave Jones, Pavel Machek,
18 * Dominik Brodowski, Jacob Shin, and others.
19 * Originally developed by Paul Devriendt.
21 * Processor information obtained from Chapter 9 (Power and Thermal
22 * Management) of the "BIOS and Kernel Developer's Guide (BKDG) for
23 * the AMD Athlon 64 and AMD Opteron Processors" and section "2.x
24 * Power Management" in BKDGs for newer AMD CPU families.
26 * Tables for specific CPUs can be inferred from AMD's processor
27 * power and thermal data sheets, (e.g. 30417.pdf, 30430.pdf, 43375.pdf)
30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
32 #include <linux/kernel.h>
33 #include <linux/smp.h>
34 #include <linux/module.h>
35 #include <linux/init.h>
36 #include <linux/cpufreq.h>
37 #include <linux/slab.h>
38 #include <linux/string.h>
39 #include <linux/cpumask.h>
41 #include <linux/delay.h>
44 #include <asm/cpu_device_id.h>
46 #include <linux/acpi.h>
47 #include <linux/mutex.h>
48 #include <acpi/processor.h>
50 #define VERSION "version 2.20.00"
51 #include "powernow-k8.h"
53 /* serialize freq changes */
54 static DEFINE_MUTEX(fidvid_mutex
);
56 static DEFINE_PER_CPU(struct powernow_k8_data
*, powernow_data
);
58 static struct cpufreq_driver cpufreq_amd64_driver
;
60 /* Return a frequency in MHz, given an input fid */
61 static u32
find_freq_from_fid(u32 fid
)
63 return 800 + (fid
* 100);
66 /* Return a frequency in KHz, given an input fid */
67 static u32
find_khz_freq_from_fid(u32 fid
)
69 return 1000 * find_freq_from_fid(fid
);
72 /* Return the vco fid for an input fid
74 * Each "low" fid has corresponding "high" fid, and you can get to "low" fids
75 * only from corresponding high fids. This returns "high" fid corresponding to
78 static u32
convert_fid_to_vco_fid(u32 fid
)
80 if (fid
< HI_FID_TABLE_BOTTOM
)
87 * Return 1 if the pending bit is set. Unless we just instructed the processor
88 * to transition to a new state, seeing this bit set is really bad news.
90 static int pending_bit_stuck(void)
94 rdmsr(MSR_FIDVID_STATUS
, lo
, hi
);
95 return lo
& MSR_S_LO_CHANGE_PENDING
? 1 : 0;
99 * Update the global current fid / vid values from the status msr.
100 * Returns 1 on error.
102 static int query_current_values_with_pending_wait(struct powernow_k8_data
*data
)
109 pr_debug("detected change pending stuck\n");
112 rdmsr(MSR_FIDVID_STATUS
, lo
, hi
);
113 } while (lo
& MSR_S_LO_CHANGE_PENDING
);
115 data
->currvid
= hi
& MSR_S_HI_CURRENT_VID
;
116 data
->currfid
= lo
& MSR_S_LO_CURRENT_FID
;
121 /* the isochronous relief time */
122 static void count_off_irt(struct powernow_k8_data
*data
)
124 udelay((1 << data
->irt
) * 10);
128 /* the voltage stabilization time */
129 static void count_off_vst(struct powernow_k8_data
*data
)
131 udelay(data
->vstable
* VST_UNITS_20US
);
135 /* need to init the control msr to a safe value (for each cpu) */
136 static void fidvid_msr_init(void)
141 rdmsr(MSR_FIDVID_STATUS
, lo
, hi
);
142 vid
= hi
& MSR_S_HI_CURRENT_VID
;
143 fid
= lo
& MSR_S_LO_CURRENT_FID
;
144 lo
= fid
| (vid
<< MSR_C_LO_VID_SHIFT
);
145 hi
= MSR_C_HI_STP_GNT_BENIGN
;
146 pr_debug("cpu%d, init lo 0x%x, hi 0x%x\n", smp_processor_id(), lo
, hi
);
147 wrmsr(MSR_FIDVID_CTL
, lo
, hi
);
150 /* write the new fid value along with the other control fields to the msr */
151 static int write_new_fid(struct powernow_k8_data
*data
, u32 fid
)
154 u32 savevid
= data
->currvid
;
157 if ((fid
& INVALID_FID_MASK
) || (data
->currvid
& INVALID_VID_MASK
)) {
158 pr_err("internal error - overflow on fid write\n");
163 lo
|= (data
->currvid
<< MSR_C_LO_VID_SHIFT
);
164 lo
|= MSR_C_LO_INIT_FID_VID
;
166 pr_debug("writing fid 0x%x, lo 0x%x, hi 0x%x\n",
167 fid
, lo
, data
->plllock
* PLL_LOCK_CONVERSION
);
170 wrmsr(MSR_FIDVID_CTL
, lo
, data
->plllock
* PLL_LOCK_CONVERSION
);
172 pr_err("Hardware error - pending bit very stuck - no further pstate changes possible\n");
175 } while (query_current_values_with_pending_wait(data
));
179 if (savevid
!= data
->currvid
) {
180 pr_err("vid change on fid trans, old 0x%x, new 0x%x\n",
181 savevid
, data
->currvid
);
185 if (fid
!= data
->currfid
) {
186 pr_err("fid trans failed, fid 0x%x, curr 0x%x\n", fid
,
194 /* Write a new vid to the hardware */
195 static int write_new_vid(struct powernow_k8_data
*data
, u32 vid
)
198 u32 savefid
= data
->currfid
;
201 if ((data
->currfid
& INVALID_FID_MASK
) || (vid
& INVALID_VID_MASK
)) {
202 pr_err("internal error - overflow on vid write\n");
207 lo
|= (vid
<< MSR_C_LO_VID_SHIFT
);
208 lo
|= MSR_C_LO_INIT_FID_VID
;
210 pr_debug("writing vid 0x%x, lo 0x%x, hi 0x%x\n",
211 vid
, lo
, STOP_GRANT_5NS
);
214 wrmsr(MSR_FIDVID_CTL
, lo
, STOP_GRANT_5NS
);
216 pr_err("internal error - pending bit very stuck - no further pstate changes possible\n");
219 } while (query_current_values_with_pending_wait(data
));
221 if (savefid
!= data
->currfid
) {
222 pr_err("fid changed on vid trans, old 0x%x new 0x%x\n",
223 savefid
, data
->currfid
);
227 if (vid
!= data
->currvid
) {
228 pr_err("vid trans failed, vid 0x%x, curr 0x%x\n",
237 * Reduce the vid by the max of step or reqvid.
238 * Decreasing vid codes represent increasing voltages:
239 * vid of 0 is 1.550V, vid of 0x1e is 0.800V, vid of VID_OFF is off.
241 static int decrease_vid_code_by_step(struct powernow_k8_data
*data
,
242 u32 reqvid
, u32 step
)
244 if ((data
->currvid
- reqvid
) > step
)
245 reqvid
= data
->currvid
- step
;
247 if (write_new_vid(data
, reqvid
))
255 /* Change Opteron/Athlon64 fid and vid, by the 3 phases. */
256 static int transition_fid_vid(struct powernow_k8_data
*data
,
257 u32 reqfid
, u32 reqvid
)
259 if (core_voltage_pre_transition(data
, reqvid
, reqfid
))
262 if (core_frequency_transition(data
, reqfid
))
265 if (core_voltage_post_transition(data
, reqvid
))
268 if (query_current_values_with_pending_wait(data
))
271 if ((reqfid
!= data
->currfid
) || (reqvid
!= data
->currvid
)) {
272 pr_err("failed (cpu%d): req 0x%x 0x%x, curr 0x%x 0x%x\n",
274 reqfid
, reqvid
, data
->currfid
, data
->currvid
);
278 pr_debug("transitioned (cpu%d): new fid 0x%x, vid 0x%x\n",
279 smp_processor_id(), data
->currfid
, data
->currvid
);
284 /* Phase 1 - core voltage transition ... setup voltage */
285 static int core_voltage_pre_transition(struct powernow_k8_data
*data
,
286 u32 reqvid
, u32 reqfid
)
288 u32 rvosteps
= data
->rvo
;
289 u32 savefid
= data
->currfid
;
290 u32 maxvid
, lo
, rvomult
= 1;
292 pr_debug("ph1 (cpu%d): start, currfid 0x%x, currvid 0x%x, reqvid 0x%x, rvo 0x%x\n",
294 data
->currfid
, data
->currvid
, reqvid
, data
->rvo
);
296 if ((savefid
< LO_FID_TABLE_TOP
) && (reqfid
< LO_FID_TABLE_TOP
))
299 rdmsr(MSR_FIDVID_STATUS
, lo
, maxvid
);
300 maxvid
= 0x1f & (maxvid
>> 16);
301 pr_debug("ph1 maxvid=0x%x\n", maxvid
);
302 if (reqvid
< maxvid
) /* lower numbers are higher voltages */
305 while (data
->currvid
> reqvid
) {
306 pr_debug("ph1: curr 0x%x, req vid 0x%x\n",
307 data
->currvid
, reqvid
);
308 if (decrease_vid_code_by_step(data
, reqvid
, data
->vidmvs
))
312 while ((rvosteps
> 0) &&
313 ((rvomult
* data
->rvo
+ data
->currvid
) > reqvid
)) {
314 if (data
->currvid
== maxvid
) {
317 pr_debug("ph1: changing vid for rvo, req 0x%x\n",
319 if (decrease_vid_code_by_step(data
, data
->currvid
-1, 1))
325 if (query_current_values_with_pending_wait(data
))
328 if (savefid
!= data
->currfid
) {
329 pr_err("ph1 err, currfid changed 0x%x\n", data
->currfid
);
333 pr_debug("ph1 complete, currfid 0x%x, currvid 0x%x\n",
334 data
->currfid
, data
->currvid
);
339 /* Phase 2 - core frequency transition */
340 static int core_frequency_transition(struct powernow_k8_data
*data
, u32 reqfid
)
342 u32 vcoreqfid
, vcocurrfid
, vcofiddiff
;
343 u32 fid_interval
, savevid
= data
->currvid
;
345 if (data
->currfid
== reqfid
) {
346 pr_err("ph2 null fid transition 0x%x\n", data
->currfid
);
350 pr_debug("ph2 (cpu%d): starting, currfid 0x%x, currvid 0x%x, reqfid 0x%x\n",
352 data
->currfid
, data
->currvid
, reqfid
);
354 vcoreqfid
= convert_fid_to_vco_fid(reqfid
);
355 vcocurrfid
= convert_fid_to_vco_fid(data
->currfid
);
356 vcofiddiff
= vcocurrfid
> vcoreqfid
? vcocurrfid
- vcoreqfid
357 : vcoreqfid
- vcocurrfid
;
359 if ((reqfid
<= LO_FID_TABLE_TOP
) && (data
->currfid
<= LO_FID_TABLE_TOP
))
362 while (vcofiddiff
> 2) {
363 (data
->currfid
& 1) ? (fid_interval
= 1) : (fid_interval
= 2);
365 if (reqfid
> data
->currfid
) {
366 if (data
->currfid
> LO_FID_TABLE_TOP
) {
367 if (write_new_fid(data
,
368 data
->currfid
+ fid_interval
))
373 2 + convert_fid_to_vco_fid(data
->currfid
)))
377 if (write_new_fid(data
, data
->currfid
- fid_interval
))
381 vcocurrfid
= convert_fid_to_vco_fid(data
->currfid
);
382 vcofiddiff
= vcocurrfid
> vcoreqfid
? vcocurrfid
- vcoreqfid
383 : vcoreqfid
- vcocurrfid
;
386 if (write_new_fid(data
, reqfid
))
389 if (query_current_values_with_pending_wait(data
))
392 if (data
->currfid
!= reqfid
) {
393 pr_err("ph2: mismatch, failed fid transition, curr 0x%x, req 0x%x\n",
394 data
->currfid
, reqfid
);
398 if (savevid
!= data
->currvid
) {
399 pr_err("ph2: vid changed, save 0x%x, curr 0x%x\n",
400 savevid
, data
->currvid
);
404 pr_debug("ph2 complete, currfid 0x%x, currvid 0x%x\n",
405 data
->currfid
, data
->currvid
);
410 /* Phase 3 - core voltage transition flow ... jump to the final vid. */
411 static int core_voltage_post_transition(struct powernow_k8_data
*data
,
414 u32 savefid
= data
->currfid
;
415 u32 savereqvid
= reqvid
;
417 pr_debug("ph3 (cpu%d): starting, currfid 0x%x, currvid 0x%x\n",
419 data
->currfid
, data
->currvid
);
421 if (reqvid
!= data
->currvid
) {
422 if (write_new_vid(data
, reqvid
))
425 if (savefid
!= data
->currfid
) {
426 pr_err("ph3: bad fid change, save 0x%x, curr 0x%x\n",
427 savefid
, data
->currfid
);
431 if (data
->currvid
!= reqvid
) {
432 pr_err("ph3: failed vid transition\n, req 0x%x, curr 0x%x",
433 reqvid
, data
->currvid
);
438 if (query_current_values_with_pending_wait(data
))
441 if (savereqvid
!= data
->currvid
) {
442 pr_debug("ph3 failed, currvid 0x%x\n", data
->currvid
);
446 if (savefid
!= data
->currfid
) {
447 pr_debug("ph3 failed, currfid changed 0x%x\n",
452 pr_debug("ph3 complete, currfid 0x%x, currvid 0x%x\n",
453 data
->currfid
, data
->currvid
);
458 static const struct x86_cpu_id powernow_k8_ids
[] = {
459 /* IO based frequency switching */
460 { X86_VENDOR_AMD
, 0xf },
463 MODULE_DEVICE_TABLE(x86cpu
, powernow_k8_ids
);
465 static void check_supported_cpu(void *_rc
)
467 u32 eax
, ebx
, ecx
, edx
;
472 eax
= cpuid_eax(CPUID_PROCESSOR_SIGNATURE
);
474 if ((eax
& CPUID_XFAM
) == CPUID_XFAM_K8
) {
475 if (((eax
& CPUID_USE_XFAM_XMOD
) != CPUID_USE_XFAM_XMOD
) ||
476 ((eax
& CPUID_XMOD
) > CPUID_XMOD_REV_MASK
)) {
477 pr_info("Processor cpuid %x not supported\n", eax
);
481 eax
= cpuid_eax(CPUID_GET_MAX_CAPABILITIES
);
482 if (eax
< CPUID_FREQ_VOLT_CAPABILITIES
) {
483 pr_info("No frequency change capabilities detected\n");
487 cpuid(CPUID_FREQ_VOLT_CAPABILITIES
, &eax
, &ebx
, &ecx
, &edx
);
488 if ((edx
& P_STATE_TRANSITION_CAPABLE
)
489 != P_STATE_TRANSITION_CAPABLE
) {
490 pr_info("Power state transitions not supported\n");
497 static int check_pst_table(struct powernow_k8_data
*data
, struct pst_s
*pst
,
503 for (j
= 0; j
< data
->numps
; j
++) {
504 if (pst
[j
].vid
> LEAST_VID
) {
505 pr_err(FW_BUG
"vid %d invalid : 0x%x\n", j
,
509 if (pst
[j
].vid
< data
->rvo
) {
511 pr_err(FW_BUG
"0 vid exceeded with pstate %d\n", j
);
514 if (pst
[j
].vid
< maxvid
+ data
->rvo
) {
515 /* vid + rvo >= maxvid */
516 pr_err(FW_BUG
"maxvid exceeded with pstate %d\n", j
);
519 if (pst
[j
].fid
> MAX_FID
) {
520 pr_err(FW_BUG
"maxfid exceeded with pstate %d\n", j
);
523 if (j
&& (pst
[j
].fid
< HI_FID_TABLE_BOTTOM
)) {
524 /* Only first fid is allowed to be in "low" range */
525 pr_err(FW_BUG
"two low fids - %d : 0x%x\n", j
,
529 if (pst
[j
].fid
< lastfid
)
530 lastfid
= pst
[j
].fid
;
533 pr_err(FW_BUG
"lastfid invalid\n");
536 if (lastfid
> LO_FID_TABLE_TOP
)
537 pr_info(FW_BUG
"first fid not from lo freq table\n");
542 static void invalidate_entry(struct cpufreq_frequency_table
*powernow_table
,
545 powernow_table
[entry
].frequency
= CPUFREQ_ENTRY_INVALID
;
548 static void print_basics(struct powernow_k8_data
*data
)
551 for (j
= 0; j
< data
->numps
; j
++) {
552 if (data
->powernow_table
[j
].frequency
!=
553 CPUFREQ_ENTRY_INVALID
) {
554 pr_info("fid 0x%x (%d MHz), vid 0x%x\n",
555 data
->powernow_table
[j
].driver_data
& 0xff,
556 data
->powernow_table
[j
].frequency
/1000,
557 data
->powernow_table
[j
].driver_data
>> 8);
561 pr_info("Only %d pstates on battery\n", data
->batps
);
564 static int fill_powernow_table(struct powernow_k8_data
*data
,
565 struct pst_s
*pst
, u8 maxvid
)
567 struct cpufreq_frequency_table
*powernow_table
;
571 /* use ACPI support to get full speed on mains power */
572 pr_warn("Only %d pstates usable (use ACPI driver for full range\n",
574 data
->numps
= data
->batps
;
577 for (j
= 1; j
< data
->numps
; j
++) {
578 if (pst
[j
-1].fid
>= pst
[j
].fid
) {
579 pr_err("PST out of sequence\n");
584 if (data
->numps
< 2) {
585 pr_err("no p states to transition\n");
589 if (check_pst_table(data
, pst
, maxvid
))
592 powernow_table
= kzalloc((sizeof(*powernow_table
)
593 * (data
->numps
+ 1)), GFP_KERNEL
);
594 if (!powernow_table
) {
595 pr_err("powernow_table memory alloc failure\n");
599 for (j
= 0; j
< data
->numps
; j
++) {
601 powernow_table
[j
].driver_data
= pst
[j
].fid
; /* lower 8 bits */
602 powernow_table
[j
].driver_data
|= (pst
[j
].vid
<< 8); /* upper 8 bits */
603 freq
= find_khz_freq_from_fid(pst
[j
].fid
);
604 powernow_table
[j
].frequency
= freq
;
606 powernow_table
[data
->numps
].frequency
= CPUFREQ_TABLE_END
;
607 powernow_table
[data
->numps
].driver_data
= 0;
609 if (query_current_values_with_pending_wait(data
)) {
610 kfree(powernow_table
);
614 pr_debug("cfid 0x%x, cvid 0x%x\n", data
->currfid
, data
->currvid
);
615 data
->powernow_table
= powernow_table
;
616 if (cpumask_first(topology_core_cpumask(data
->cpu
)) == data
->cpu
)
619 for (j
= 0; j
< data
->numps
; j
++)
620 if ((pst
[j
].fid
== data
->currfid
) &&
621 (pst
[j
].vid
== data
->currvid
))
624 pr_debug("currfid/vid do not match PST, ignoring\n");
628 /* Find and validate the PSB/PST table in BIOS. */
629 static int find_psb_table(struct powernow_k8_data
*data
)
638 for (i
= 0xc0000; i
< 0xffff0; i
+= 0x10) {
639 /* Scan BIOS looking for the signature. */
640 /* It can not be at ffff0 - it is too big. */
642 psb
= phys_to_virt(i
);
643 if (memcmp(psb
, PSB_ID_STRING
, PSB_ID_STRING_LEN
) != 0)
646 pr_debug("found PSB header at 0x%p\n", psb
);
648 pr_debug("table vers: 0x%x\n", psb
->tableversion
);
649 if (psb
->tableversion
!= PSB_VERSION_1_4
) {
650 pr_err(FW_BUG
"PSB table is not v1.4\n");
654 pr_debug("flags: 0x%x\n", psb
->flags1
);
656 pr_err(FW_BUG
"unknown flags\n");
660 data
->vstable
= psb
->vstable
;
661 pr_debug("voltage stabilization time: %d(*20us)\n",
664 pr_debug("flags2: 0x%x\n", psb
->flags2
);
665 data
->rvo
= psb
->flags2
& 3;
666 data
->irt
= ((psb
->flags2
) >> 2) & 3;
667 mvs
= ((psb
->flags2
) >> 4) & 3;
668 data
->vidmvs
= 1 << mvs
;
669 data
->batps
= ((psb
->flags2
) >> 6) & 3;
671 pr_debug("ramp voltage offset: %d\n", data
->rvo
);
672 pr_debug("isochronous relief time: %d\n", data
->irt
);
673 pr_debug("maximum voltage step: %d - 0x%x\n", mvs
, data
->vidmvs
);
675 pr_debug("numpst: 0x%x\n", psb
->num_tables
);
676 cpst
= psb
->num_tables
;
677 if ((psb
->cpuid
== 0x00000fc0) ||
678 (psb
->cpuid
== 0x00000fe0)) {
679 thiscpuid
= cpuid_eax(CPUID_PROCESSOR_SIGNATURE
);
680 if ((thiscpuid
== 0x00000fc0) ||
681 (thiscpuid
== 0x00000fe0))
685 pr_err(FW_BUG
"numpst must be 1\n");
689 data
->plllock
= psb
->plllocktime
;
690 pr_debug("plllocktime: 0x%x (units 1us)\n", psb
->plllocktime
);
691 pr_debug("maxfid: 0x%x\n", psb
->maxfid
);
692 pr_debug("maxvid: 0x%x\n", psb
->maxvid
);
693 maxvid
= psb
->maxvid
;
695 data
->numps
= psb
->numps
;
696 pr_debug("numpstates: 0x%x\n", data
->numps
);
697 return fill_powernow_table(data
,
698 (struct pst_s
*)(psb
+1), maxvid
);
701 * If you see this message, complain to BIOS manufacturer. If
702 * he tells you "we do not support Linux" or some similar
703 * nonsense, remember that Windows 2000 uses the same legacy
704 * mechanism that the old Linux PSB driver uses. Tell them it
705 * is broken with Windows 2000.
707 * The reference to the AMD documentation is chapter 9 in the
708 * BIOS and Kernel Developer's Guide, which is available on
711 pr_err(FW_BUG
"No PSB or ACPI _PSS objects\n");
712 pr_err("Make sure that your BIOS is up to date and Cool'N'Quiet support is enabled in BIOS setup\n");
716 static void powernow_k8_acpi_pst_values(struct powernow_k8_data
*data
,
721 if (!data
->acpi_data
.state_count
)
724 control
= data
->acpi_data
.states
[index
].control
;
725 data
->irt
= (control
>> IRT_SHIFT
) & IRT_MASK
;
726 data
->rvo
= (control
>> RVO_SHIFT
) & RVO_MASK
;
727 data
->exttype
= (control
>> EXT_TYPE_SHIFT
) & EXT_TYPE_MASK
;
728 data
->plllock
= (control
>> PLL_L_SHIFT
) & PLL_L_MASK
;
729 data
->vidmvs
= 1 << ((control
>> MVS_SHIFT
) & MVS_MASK
);
730 data
->vstable
= (control
>> VST_SHIFT
) & VST_MASK
;
733 static int powernow_k8_cpu_init_acpi(struct powernow_k8_data
*data
)
735 struct cpufreq_frequency_table
*powernow_table
;
736 int ret_val
= -ENODEV
;
739 if (acpi_processor_register_performance(&data
->acpi_data
, data
->cpu
)) {
740 pr_debug("register performance failed: bad ACPI data\n");
744 /* verify the data contained in the ACPI structures */
745 if (data
->acpi_data
.state_count
<= 1) {
746 pr_debug("No ACPI P-States\n");
750 control
= data
->acpi_data
.control_register
.space_id
;
751 status
= data
->acpi_data
.status_register
.space_id
;
753 if ((control
!= ACPI_ADR_SPACE_FIXED_HARDWARE
) ||
754 (status
!= ACPI_ADR_SPACE_FIXED_HARDWARE
)) {
755 pr_debug("Invalid control/status registers (%llx - %llx)\n",
760 /* fill in data->powernow_table */
761 powernow_table
= kzalloc((sizeof(*powernow_table
)
762 * (data
->acpi_data
.state_count
+ 1)), GFP_KERNEL
);
763 if (!powernow_table
) {
764 pr_debug("powernow_table memory alloc failure\n");
769 data
->numps
= data
->acpi_data
.state_count
;
770 powernow_k8_acpi_pst_values(data
, 0);
772 ret_val
= fill_powernow_table_fidvid(data
, powernow_table
);
776 powernow_table
[data
->acpi_data
.state_count
].frequency
=
778 data
->powernow_table
= powernow_table
;
780 if (cpumask_first(topology_core_cpumask(data
->cpu
)) == data
->cpu
)
783 /* notify BIOS that we exist */
784 acpi_processor_notify_smm(THIS_MODULE
);
786 if (!zalloc_cpumask_var(&data
->acpi_data
.shared_cpu_map
, GFP_KERNEL
)) {
787 pr_err("unable to alloc powernow_k8_data cpumask\n");
795 kfree(powernow_table
);
798 acpi_processor_unregister_performance(&data
->acpi_data
, data
->cpu
);
800 /* data->acpi_data.state_count informs us at ->exit()
801 * whether ACPI was used */
802 data
->acpi_data
.state_count
= 0;
807 static int fill_powernow_table_fidvid(struct powernow_k8_data
*data
,
808 struct cpufreq_frequency_table
*powernow_table
)
812 for (i
= 0; i
< data
->acpi_data
.state_count
; i
++) {
819 status
= data
->acpi_data
.states
[i
].status
;
820 fid
= status
& EXT_FID_MASK
;
821 vid
= (status
>> VID_SHIFT
) & EXT_VID_MASK
;
823 control
= data
->acpi_data
.states
[i
].control
;
824 fid
= control
& FID_MASK
;
825 vid
= (control
>> VID_SHIFT
) & VID_MASK
;
828 pr_debug(" %d : fid 0x%x, vid 0x%x\n", i
, fid
, vid
);
830 index
= fid
| (vid
<<8);
831 powernow_table
[i
].driver_data
= index
;
833 freq
= find_khz_freq_from_fid(fid
);
834 powernow_table
[i
].frequency
= freq
;
836 /* verify frequency is OK */
837 if ((freq
> (MAX_FREQ
* 1000)) || (freq
< (MIN_FREQ
* 1000))) {
838 pr_debug("invalid freq %u kHz, ignoring\n", freq
);
839 invalidate_entry(powernow_table
, i
);
843 /* verify voltage is OK -
844 * BIOSs are using "off" to indicate invalid */
845 if (vid
== VID_OFF
) {
846 pr_debug("invalid vid %u, ignoring\n", vid
);
847 invalidate_entry(powernow_table
, i
);
851 if (freq
!= (data
->acpi_data
.states
[i
].core_frequency
* 1000)) {
852 pr_info("invalid freq entries %u kHz vs. %u kHz\n",
854 (data
->acpi_data
.states
[i
].core_frequency
856 invalidate_entry(powernow_table
, i
);
863 static void powernow_k8_cpu_exit_acpi(struct powernow_k8_data
*data
)
865 if (data
->acpi_data
.state_count
)
866 acpi_processor_unregister_performance(&data
->acpi_data
,
868 free_cpumask_var(data
->acpi_data
.shared_cpu_map
);
871 static int get_transition_latency(struct powernow_k8_data
*data
)
875 for (i
= 0; i
< data
->acpi_data
.state_count
; i
++) {
876 int cur_latency
= data
->acpi_data
.states
[i
].transition_latency
877 + data
->acpi_data
.states
[i
].bus_master_latency
;
878 if (cur_latency
> max_latency
)
879 max_latency
= cur_latency
;
881 if (max_latency
== 0) {
882 pr_err(FW_WARN
"Invalid zero transition latency\n");
885 /* value in usecs, needs to be in nanoseconds */
886 return 1000 * max_latency
;
889 /* Take a frequency, and issue the fid/vid transition command */
890 static int transition_frequency_fidvid(struct powernow_k8_data
*data
,
893 struct cpufreq_policy
*policy
;
897 struct cpufreq_freqs freqs
;
899 pr_debug("cpu %d transition to index %u\n", smp_processor_id(), index
);
901 /* fid/vid correctness check for k8 */
902 /* fid are the lower 8 bits of the index we stored into
903 * the cpufreq frequency table in find_psb_table, vid
904 * are the upper 8 bits.
906 fid
= data
->powernow_table
[index
].driver_data
& 0xFF;
907 vid
= (data
->powernow_table
[index
].driver_data
& 0xFF00) >> 8;
909 pr_debug("table matched fid 0x%x, giving vid 0x%x\n", fid
, vid
);
911 if (query_current_values_with_pending_wait(data
))
914 if ((data
->currvid
== vid
) && (data
->currfid
== fid
)) {
915 pr_debug("target matches current values (fid 0x%x, vid 0x%x)\n",
920 pr_debug("cpu %d, changing to fid 0x%x, vid 0x%x\n",
921 smp_processor_id(), fid
, vid
);
922 freqs
.old
= find_khz_freq_from_fid(data
->currfid
);
923 freqs
.new = find_khz_freq_from_fid(fid
);
925 policy
= cpufreq_cpu_get(smp_processor_id());
926 cpufreq_cpu_put(policy
);
928 cpufreq_freq_transition_begin(policy
, &freqs
);
929 res
= transition_fid_vid(data
, fid
, vid
);
930 cpufreq_freq_transition_end(policy
, &freqs
, res
);
935 struct powernowk8_target_arg
{
936 struct cpufreq_policy
*pol
;
940 static long powernowk8_target_fn(void *arg
)
942 struct powernowk8_target_arg
*pta
= arg
;
943 struct cpufreq_policy
*pol
= pta
->pol
;
944 unsigned newstate
= pta
->newstate
;
945 struct powernow_k8_data
*data
= per_cpu(powernow_data
, pol
->cpu
);
953 checkfid
= data
->currfid
;
954 checkvid
= data
->currvid
;
956 if (pending_bit_stuck()) {
957 pr_err("failing targ, change pending bit set\n");
961 pr_debug("targ: cpu %d, %d kHz, min %d, max %d\n",
962 pol
->cpu
, data
->powernow_table
[newstate
].frequency
, pol
->min
,
965 if (query_current_values_with_pending_wait(data
))
968 pr_debug("targ: curr fid 0x%x, vid 0x%x\n",
969 data
->currfid
, data
->currvid
);
971 if ((checkvid
!= data
->currvid
) ||
972 (checkfid
!= data
->currfid
)) {
973 pr_info("error - out of sync, fix 0x%x 0x%x, vid 0x%x 0x%x\n",
974 checkfid
, data
->currfid
,
975 checkvid
, data
->currvid
);
978 mutex_lock(&fidvid_mutex
);
980 powernow_k8_acpi_pst_values(data
, newstate
);
982 ret
= transition_frequency_fidvid(data
, newstate
);
985 pr_err("transition frequency failed\n");
986 mutex_unlock(&fidvid_mutex
);
989 mutex_unlock(&fidvid_mutex
);
991 pol
->cur
= find_khz_freq_from_fid(data
->currfid
);
996 /* Driver entry point to switch to the target frequency */
997 static int powernowk8_target(struct cpufreq_policy
*pol
, unsigned index
)
999 struct powernowk8_target_arg pta
= { .pol
= pol
, .newstate
= index
};
1001 return work_on_cpu(pol
->cpu
, powernowk8_target_fn
, &pta
);
1004 struct init_on_cpu
{
1005 struct powernow_k8_data
*data
;
1009 static void powernowk8_cpu_init_on_cpu(void *_init_on_cpu
)
1011 struct init_on_cpu
*init_on_cpu
= _init_on_cpu
;
1013 if (pending_bit_stuck()) {
1014 pr_err("failing init, change pending bit set\n");
1015 init_on_cpu
->rc
= -ENODEV
;
1019 if (query_current_values_with_pending_wait(init_on_cpu
->data
)) {
1020 init_on_cpu
->rc
= -ENODEV
;
1026 init_on_cpu
->rc
= 0;
1029 #define MISSING_PSS_MSG \
1030 FW_BUG "No compatible ACPI _PSS objects found.\n" \
1031 FW_BUG "First, make sure Cool'N'Quiet is enabled in the BIOS.\n" \
1032 FW_BUG "If that doesn't help, try upgrading your BIOS.\n"
1034 /* per CPU init entry point to the driver */
1035 static int powernowk8_cpu_init(struct cpufreq_policy
*pol
)
1037 struct powernow_k8_data
*data
;
1038 struct init_on_cpu init_on_cpu
;
1041 smp_call_function_single(pol
->cpu
, check_supported_cpu
, &rc
, 1);
1045 data
= kzalloc(sizeof(*data
), GFP_KERNEL
);
1047 pr_err("unable to alloc powernow_k8_data");
1051 data
->cpu
= pol
->cpu
;
1053 if (powernow_k8_cpu_init_acpi(data
)) {
1055 * Use the PSB BIOS structure. This is only available on
1056 * an UP version, and is deprecated by AMD.
1058 if (num_online_cpus() != 1) {
1059 pr_err_once(MISSING_PSS_MSG
);
1062 if (pol
->cpu
!= 0) {
1063 pr_err(FW_BUG
"No ACPI _PSS objects for CPU other than CPU0. Complain to your BIOS vendor.\n");
1066 rc
= find_psb_table(data
);
1070 /* Take a crude guess here.
1071 * That guess was in microseconds, so multiply with 1000 */
1072 pol
->cpuinfo
.transition_latency
= (
1073 ((data
->rvo
+ 8) * data
->vstable
* VST_UNITS_20US
) +
1074 ((1 << data
->irt
) * 30)) * 1000;
1075 } else /* ACPI _PSS objects available */
1076 pol
->cpuinfo
.transition_latency
= get_transition_latency(data
);
1078 /* only run on specific CPU from here on */
1079 init_on_cpu
.data
= data
;
1080 smp_call_function_single(data
->cpu
, powernowk8_cpu_init_on_cpu
,
1082 rc
= init_on_cpu
.rc
;
1084 goto err_out_exit_acpi
;
1086 cpumask_copy(pol
->cpus
, topology_core_cpumask(pol
->cpu
));
1087 data
->available_cores
= pol
->cpus
;
1089 /* min/max the cpu is capable of */
1090 if (cpufreq_table_validate_and_show(pol
, data
->powernow_table
)) {
1091 pr_err(FW_BUG
"invalid powernow_table\n");
1092 powernow_k8_cpu_exit_acpi(data
);
1093 kfree(data
->powernow_table
);
1098 pr_debug("cpu_init done, current fid 0x%x, vid 0x%x\n",
1099 data
->currfid
, data
->currvid
);
1101 /* Point all the CPUs in this policy to the same data */
1102 for_each_cpu(cpu
, pol
->cpus
)
1103 per_cpu(powernow_data
, cpu
) = data
;
1108 powernow_k8_cpu_exit_acpi(data
);
1115 static int powernowk8_cpu_exit(struct cpufreq_policy
*pol
)
1117 struct powernow_k8_data
*data
= per_cpu(powernow_data
, pol
->cpu
);
1123 powernow_k8_cpu_exit_acpi(data
);
1125 kfree(data
->powernow_table
);
1127 for_each_cpu(cpu
, pol
->cpus
)
1128 per_cpu(powernow_data
, cpu
) = NULL
;
1133 static void query_values_on_cpu(void *_err
)
1136 struct powernow_k8_data
*data
= __this_cpu_read(powernow_data
);
1138 *err
= query_current_values_with_pending_wait(data
);
1141 static unsigned int powernowk8_get(unsigned int cpu
)
1143 struct powernow_k8_data
*data
= per_cpu(powernow_data
, cpu
);
1144 unsigned int khz
= 0;
1150 smp_call_function_single(cpu
, query_values_on_cpu
, &err
, true);
1154 khz
= find_khz_freq_from_fid(data
->currfid
);
1161 static struct cpufreq_driver cpufreq_amd64_driver
= {
1162 .flags
= CPUFREQ_ASYNC_NOTIFICATION
,
1163 .verify
= cpufreq_generic_frequency_table_verify
,
1164 .target_index
= powernowk8_target
,
1165 .bios_limit
= acpi_processor_get_bios_limit
,
1166 .init
= powernowk8_cpu_init
,
1167 .exit
= powernowk8_cpu_exit
,
1168 .get
= powernowk8_get
,
1169 .name
= "powernow-k8",
1170 .attr
= cpufreq_generic_attr
,
1173 static void __request_acpi_cpufreq(void)
1175 const char *cur_drv
, *drv
= "acpi-cpufreq";
1177 cur_drv
= cpufreq_get_current_driver();
1181 if (strncmp(cur_drv
, drv
, min_t(size_t, strlen(cur_drv
), strlen(drv
))))
1182 pr_warn("WTF driver: %s\n", cur_drv
);
1187 pr_warn("This CPU is not supported anymore, using acpi-cpufreq instead.\n");
1188 request_module(drv
);
1191 /* driver entry point for init */
1192 static int powernowk8_init(void)
1194 unsigned int i
, supported_cpus
= 0;
1197 if (static_cpu_has(X86_FEATURE_HW_PSTATE
)) {
1198 __request_acpi_cpufreq();
1202 if (!x86_match_cpu(powernow_k8_ids
))
1206 for_each_online_cpu(i
) {
1207 smp_call_function_single(i
, check_supported_cpu
, &ret
, 1);
1212 if (supported_cpus
!= num_online_cpus()) {
1218 ret
= cpufreq_register_driver(&cpufreq_amd64_driver
);
1222 pr_info("Found %d %s (%d cpu cores) (" VERSION
")\n",
1223 num_online_nodes(), boot_cpu_data
.x86_model_id
, supported_cpus
);
1228 /* driver entry point for term */
1229 static void __exit
powernowk8_exit(void)
1233 cpufreq_unregister_driver(&cpufreq_amd64_driver
);
1236 MODULE_AUTHOR("Paul Devriendt <paul.devriendt@amd.com>");
1237 MODULE_AUTHOR("Mark Langsdorf <mark.langsdorf@amd.com>");
1238 MODULE_DESCRIPTION("AMD Athlon 64 and Opteron processor frequency driver.");
1239 MODULE_LICENSE("GPL");
1241 late_initcall(powernowk8_init
);
1242 module_exit(powernowk8_exit
);