Subversion Repositories shark

Rev

Rev 600 | Rev 770 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | RSS feed

/*
 *   (c) 2003 Advanced Micro Devices, Inc.
 *  Your use of this code is subject to the terms and conditions of the
 *  GNU general public license version 2. See "../../../COPYING" or
 *  http://www.gnu.org/licenses/gpl.html
 *
 *  Support : paul.devriendt@amd.com
 *
 *  Based on the powernow-k7.c module written by Dave Jones.
 *  (C) 2003 Dave Jones <davej@codemonkey.ork.uk> on behalf of SuSE Labs
 *  Licensed under the terms of the GNU GPL License version 2.
 *  Based upon datasheets & sample CPUs kindly provided by AMD.
 *
 *  Processor information obtained from Chapter 9 (Power and Thermal Management)
 *  of the "BIOS and Kernel Developer's Guide for the AMD Athlon 64 and AMD
 *  Opteron Processors", revision 3.03, available for download from www.amd.com
 *
 */


#include <linuxcomp.h>

#include <linux/kernel.h>
#include <linux/smp.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/cpufreq.h>
#include <linux/slab.h>
#include <linux/string.h>

#include <asm/msr.h>
#include <asm/io.h>
#include <asm/delay.h>

#define DEBUG

#ifdef DEBUG
#define dprintk(msg...) printk(msg)
#else
#define dprintk(msg...) do { } while(0)
#endif

#define PFX "powernow-k8: "
#define BFX PFX "BIOS error: "
#define VERSION "version 1.00.08 - September 26, 2003"
#include "powernow-k8.h"

#ifdef CONFIG_PREEMPT
#warning this driver has not been tested on a preempt system
#endif

extern struct cpuinfo_x86 new_cpu_data;

static u32 vstable;     /* voltage stabalization time, from PSB, units 20 us */
static u32 plllock;     /* pll lock time, from PSB, units 1 us */
static u32 numps;       /* number of p-states, from PSB */
static u32 rvo;         /* ramp voltage offset, from PSB */
static u32 irt;         /* isochronous relief time, from PSB */
static u32 vidmvs;      /* usable value calculated from mvs, from PSB */
struct pst_s *ppst;     /* array of p states, valid for this part */
static u32 currvid;     /* keep track of the current fid / vid */
static u32 currfid;

/*
The PSB table supplied by BIOS allows for the definition of the number of
p-states that can be used when running on a/c, and the number of p-states
that can be used when running on battery. This allows laptop manufacturers
to force the system to save power when running from battery. The relationship
is :
   1 <= number_of_battery_p_states <= maximum_number_of_p_states

This driver does NOT have the support in it to detect transitions from
a/c power to battery power, and thus trigger the transition to a lower
p-state if required. This is because I need ACPI and the 2.6 kernel to do
this, and this is a 2.4 kernel driver. Check back for a new improved driver
for the 2.6 kernel soon.

This code therefore assumes it is on battery at all times, and thus
restricts performance to number_of_battery_p_states. For desktops,
  number_of_battery_p_states == maximum_number_of_pstates,
so this is not actually a restriction.
*/


static u32 batps;       /* limit on the number of p states when on battery */
                        /* - set by BIOS in the PSB/PST                    */

static struct cpufreq_driver cpufreq_amd64_driver = {
        .verify = powernowk8_verify,
        .target = powernowk8_target,
        .init = powernowk8_cpu_init,
        .name = "cpufreq-amd64",
        .owner = THIS_MODULE,
};

#define SEARCH_UP     1
#define SEARCH_DOWN   0

/* Return a frequency in MHz, given an input fid */
u32 find_freq_from_fid(u32 fid)
{
        return 800 + (fid * 100);
}

/* Return a fid matching an input frequency in MHz */
static u32 find_fid_from_freq(u32 freq)
{
        return (freq - 800) / 100;
}

/* Return the vco fid for an input fid */
static u32 convert_fid_to_vco_fid(u32 fid)
{
        if (fid < HI_FID_TABLE_BOTTOM) {
                return 8 + (2 * fid);
        } else {
                return fid;
        }
}

/* Sort the fid/vid frequency table into ascending order by fid. The spec */
/* implies that it will be sorted by BIOS, but, it only implies it, and I */
/* prefer not to trust when I can check.                                  */
/* Yes, it is a simple bubble sort, but the PST is really small, so the   */
/* choice of algorithm is pretty irrelevant.                              */
static inline void sort_pst(struct pst_s *ppst, u32 numpstates)
{
        u32 i;
        u8 tempfid;
        u8 tempvid;
        int swaps = 1;

        while (swaps) {
                swaps = 0;
                for (i = 0; i < (numpstates - 1); i++) {
                        if (ppst[i].fid > ppst[i + 1].fid) {
                                swaps = 1;
                                tempfid = ppst[i].fid;
                                tempvid = ppst[i].vid;
                                ppst[i].fid = ppst[i + 1].fid;
                                ppst[i].vid = ppst[i + 1].vid;
                                ppst[i + 1].fid = tempfid;
                                ppst[i + 1].vid = tempvid;
                        }
                }
        }

        return;
}

/* Return 1 if the pending bit is set. Unless we are actually just told the */
/* processor to transition a state, seeing this bit set is really bad news. */
static inline int pending_bit_stuck(void)
{
        u32 lo;
        u32 hi;

        rdmsr(MSR_FIDVID_STATUS, lo, hi);
        return lo & MSR_S_LO_CHANGE_PENDING ? 1 : 0;
}

/* Update the global current fid / vid values from the status msr. Returns 1 */
/* on error.                                                                 */
static int query_current_values_with_pending_wait(void)
{
        u32 lo;
        u32 hi;
        u32 i = 0;

        lo = MSR_S_LO_CHANGE_PENDING;
        while (lo & MSR_S_LO_CHANGE_PENDING) {
                if (i++ > 0x1000000) {
                        printk(KERN_ERR PFX "detected change pending stuck\n");
                        return 1;
                }
                rdmsr(MSR_FIDVID_STATUS, lo, hi);
        }

        currvid = hi & MSR_S_HI_CURRENT_VID;
        currfid = lo & MSR_S_LO_CURRENT_FID;

        return 0;
}

/* the isochronous relief time */
static inline void count_off_irt(void)
{
        udelay((1 << irt) * 10);
        return;
}

/* the voltage stabalization time */
static inline void count_off_vst(void)
{
        udelay(vstable * VST_UNITS_20US);
        return;
}

/* write the new fid value along with the other control fields to the msr */
static int write_new_fid(u32 fid)
{
        u32 lo;
        u32 savevid = currvid;

        if ((fid & INVALID_FID_MASK) || (currvid & INVALID_VID_MASK)) {
                printk(KERN_ERR PFX "internal error - overflow on fid write\n");
                return 1;
        }

        lo = fid | (currvid << MSR_C_LO_VID_SHIFT) | MSR_C_LO_INIT_FID_VID;

        dprintk(KERN_DEBUG PFX "writing fid %x, lo %x, hi %x\n",
                fid, lo, plllock * PLL_LOCK_CONVERSION);

        wrmsr(MSR_FIDVID_CTL, lo, plllock * PLL_LOCK_CONVERSION);

        if (query_current_values_with_pending_wait())
                return 1;

        count_off_irt();

        if (savevid != currvid) {
                printk(KERN_ERR PFX
                       "vid changed on fid transition, save %x, currvid %x\n",
                       savevid, currvid);
                return 1;
        }

        if (fid != currfid) {
                printk(KERN_ERR PFX
                       "fid transition failed, fid %x, currfid %x\n",
                        fid, currfid);
                return 1;
        }

        return 0;
}

/* Write a new vid to the hardware */
static int write_new_vid(u32 vid)
{
        u32 lo;
        u32 savefid = currfid;

        if ((currfid & INVALID_FID_MASK) || (vid & INVALID_VID_MASK)) {
                printk(KERN_ERR PFX "internal error - overflow on vid write\n");
                return 1;
        }

        lo = currfid | (vid << MSR_C_LO_VID_SHIFT) | MSR_C_LO_INIT_FID_VID;

        dprintk(KERN_DEBUG PFX "writing vid %x, lo %x, hi %x\n",
                vid, lo, STOP_GRANT_5NS);

        wrmsr(MSR_FIDVID_CTL, lo, STOP_GRANT_5NS);

        if (query_current_values_with_pending_wait()) {
                return 1;
        }

        if (savefid != currfid) {
                printk(KERN_ERR PFX
                       "fid changed on vid transition, save %x currfid %x\n",
                       savefid, currfid);
                return 1;
        }

        if (vid != currvid) {
                printk(KERN_ERR PFX
                       "vid transition failed, vid %x, currvid %x\n",
                       vid, currvid);
                return 1;
        }

        return 0;
}

/* Reduce the vid by the max of step or reqvid.                   */
/* Decreasing vid codes represent increasing voltages :           */
/* vid of 0 is 1.550V, vid of 0x1e is 0.800V, vid of 0x1f is off. */
static int decrease_vid_code_by_step(u32 reqvid, u32 step)
{
        if ((currvid - reqvid) > step)
                reqvid = currvid - step;

        if (write_new_vid(reqvid))
                return 1;

        count_off_vst();

        return 0;
}

/* Change the fid and vid, by the 3 phases. */
static inline int transition_fid_vid(u32 reqfid, u32 reqvid)
{
        if (core_voltage_pre_transition(reqvid))
                return 1;

        if (core_frequency_transition(reqfid))
                return 1;

        if (core_voltage_post_transition(reqvid))
                return 1;

        if (query_current_values_with_pending_wait())
                return 1;

        if ((reqfid != currfid) || (reqvid != currvid)) {
                printk(KERN_ERR PFX "failed: req 0x%x 0x%x, curr 0x%x 0x%x\n",
                       reqfid, reqvid, currfid, currvid);
                return 1;
        }

        dprintk(KERN_INFO PFX
                "transitioned: new fid 0x%x, vid 0x%x\n", currfid, currvid);

        return 0;
}

/* Phase 1 - core voltage transition ... setup appropriate voltage for the */
/* fid transition.                                                         */
static inline int core_voltage_pre_transition(u32 reqvid)
{
        u32 rvosteps = rvo;
        u32 savefid = currfid;

        dprintk(KERN_DEBUG PFX
                "ph1: start, currfid 0x%x, currvid 0x%x, reqvid 0x%x, rvo %x\n",
                currfid, currvid, reqvid, rvo);

        while (currvid > reqvid) {
                dprintk(KERN_DEBUG PFX "ph1: curr 0x%x, requesting vid 0x%x\n",
                        currvid, reqvid);
                if (decrease_vid_code_by_step(reqvid, vidmvs))
                        return 1;
        }

        while (rvosteps > 0) {
                if (currvid == 0) {
                        rvosteps = 0;
                } else {
                        dprintk(KERN_DEBUG PFX
                                "ph1: changing vid for rvo, requesting 0x%x\n",
                                currvid - 1);
                        if (decrease_vid_code_by_step(currvid - 1, 1))
                                return 1;
                        rvosteps--;
                }
        }

        if (query_current_values_with_pending_wait())
                return 1;

        if (savefid != currfid) {
                printk(KERN_ERR PFX "ph1 err, currfid changed 0x%x\n", currfid);
                return 1;
        }

        dprintk(KERN_DEBUG PFX "ph1 complete, currfid 0x%x, currvid 0x%x\n",
                currfid, currvid);

        return 0;
}

/* Phase 2 - core frequency transition */
static inline int core_frequency_transition(u32 reqfid)
{
        u32 vcoreqfid;
        u32 vcocurrfid;
        u32 vcofiddiff;
        u32 savevid = currvid;

        if ((reqfid < HI_FID_TABLE_BOTTOM) && (currfid < HI_FID_TABLE_BOTTOM)) {
                printk(KERN_ERR PFX "ph2 illegal lo-lo transition 0x%x 0x%x\n",
                       reqfid, currfid);
                return 1;
        }

        if (currfid == reqfid) {
                printk(KERN_ERR PFX "ph2 null fid transition 0x%x\n", currfid);
                return 0;
        }

        dprintk(KERN_DEBUG PFX
                "ph2 starting, currfid 0x%x, currvid 0x%x, reqfid 0x%x\n",
                currfid, currvid, reqfid);

        vcoreqfid = convert_fid_to_vco_fid(reqfid);
        vcocurrfid = convert_fid_to_vco_fid(currfid);
        vcofiddiff = vcocurrfid > vcoreqfid ? vcocurrfid - vcoreqfid
            : vcoreqfid - vcocurrfid;

        while (vcofiddiff > 2) {
                if (reqfid > currfid) {
                        if (currfid > LO_FID_TABLE_TOP) {
                                if (write_new_fid(currfid + 2)) {
                                        return 1;
                                }
                        } else {
                                if (write_new_fid
                                    (2 + convert_fid_to_vco_fid(currfid))) {
                                        return 1;
                                }
                        }
                } else {
                        if (write_new_fid(currfid - 2))
                                return 1;
                }

                vcocurrfid = convert_fid_to_vco_fid(currfid);
                vcofiddiff = vcocurrfid > vcoreqfid ? vcocurrfid - vcoreqfid
                    : vcoreqfid - vcocurrfid;
        }

        if (write_new_fid(reqfid))
                return 1;

        if (query_current_values_with_pending_wait())
                return 1;

        if (currfid != reqfid) {
                printk(KERN_ERR PFX
                       "ph2 mismatch, failed fid transition, curr %x, req %x\n",
                       currfid, reqfid);
                return 1;
        }

        if (savevid != currvid) {
                printk(KERN_ERR PFX
                       "ph2 vid changed, save %x, curr %x\n", savevid,
                       currvid);
                return 1;
        }

        dprintk(KERN_DEBUG PFX "ph2 complete, currfid 0x%x, currvid 0x%x\n",
                currfid, currvid);

        return 0;
}

/* Phase 3 - core voltage transition flow ... jump to the final vid. */
static inline int core_voltage_post_transition(u32 reqvid)
{
        u32 savefid = currfid;
        u32 savereqvid = reqvid;

        dprintk(KERN_DEBUG PFX "ph3 starting, currfid 0x%x, currvid 0x%x\n",
                currfid, currvid);

        if (reqvid != currvid) {
                if (write_new_vid(reqvid))
                        return 1;

                if (savefid != currfid) {
                        printk(KERN_ERR PFX
                               "ph3: bad fid change, save %x, curr %x\n",
                               savefid, currfid);
                        return 1;
                }

                if (currvid != reqvid) {
                        printk(KERN_ERR PFX
                               "ph3: failed vid transition\n, req %x, curr %x",
                               reqvid, currvid);
                        return 1;
                }
        }

        if (query_current_values_with_pending_wait())
                return 1;

        if (savereqvid != currvid) {
                dprintk(KERN_ERR PFX "ph3 failed, currvid 0x%x\n", currvid);
                return 1;
        }

        if (savefid != currfid) {
                dprintk(KERN_ERR PFX "ph3 failed, currfid changed 0x%x\n",
                        currfid);
                return 1;
        }

        dprintk(KERN_DEBUG PFX "ph3 complete, currfid 0x%x, currvid 0x%x\n",
                currfid, currvid);

        return 0;
}

static inline int check_supported_cpu(void)
{
        struct cpuinfo_x86 *c = &new_cpu_data;
        u32 eax, ebx, ecx, edx;

        if (num_online_cpus() != 1) {
                dprintk(KERN_INFO PFX "multiprocessor systems not supported\n");
                return 0;
        }

        if (c->x86_vendor != X86_VENDOR_AMD) {
                dprintk(KERN_INFO PFX "Not an AMD processor\n");
                return 0;
        }

        eax = cpuid_eax(CPUID_PROCESSOR_SIGNATURE);
        if (((eax & CPUID_USE_XFAM_XMOD) != CPUID_USE_XFAM_XMOD) ||
            ((eax & CPUID_XFAM) != CPUID_XFAM_K8) ||
            ((eax & CPUID_XMOD) > CPUID_XMOD_REV_E)) {
                printk(KERN_INFO PFX "Processor cpuid %x not supported\n", eax);
                return 0;
        } else {
                dprintk(KERN_INFO PFX "AMD Athlon 64 or AMD Opteron processor found\n");
        }

        eax = cpuid_eax(CPUID_GET_MAX_CAPABILITIES);
        if (eax < CPUID_FREQ_VOLT_CAPABILITIES) {
                dprintk(KERN_INFO PFX
                       "No frequency change capabilities detected\n");
                return 0;
        }

        cpuid(CPUID_FREQ_VOLT_CAPABILITIES, &eax, &ebx, &ecx, &edx);
        if ((edx & P_STATE_TRANSITION_CAPABLE) != P_STATE_TRANSITION_CAPABLE) {
                dprintk(KERN_INFO PFX "Power state transitions not supported\n");
                return 0;
        }

        printk(KERN_INFO PFX "Found AMD Athlon 64 / Opteron processor "
               "supporting p-state transitions\n");

        return 1;
}

/* Find and validate the PSB/PST table in BIOS. */
static inline int find_psb_table(void)
{
        struct psb_s *psb;
        struct pst_s *pst;
        unsigned i, j;
        u32 lastfid;
        u32 mvs;
        u8 maxvid;

        for (i = 0xc0000; i < 0xffff0; i += 0x10) {
                /* Scan BIOS looking for the signature. */
                /* It can not be at ffff0 - it is too big. */

                psb = phys_to_virt(i);
                if (memcmp(psb, PSB_ID_STRING, PSB_ID_STRING_LEN) != 0)
                        continue;

                dprintk(KERN_DEBUG PFX "found PSB header at 0x%p\n", psb);

                dprintk(KERN_DEBUG PFX "table vers: 0x%x\n", psb->tableversion);
                if (psb->tableversion != PSB_VERSION_1_4) {
                        printk(KERN_INFO BFX "PSB table is not v1.4\n");
                        return -ENODEV;
                }

                dprintk(KERN_DEBUG PFX "flags: 0x%x\n", psb->flags1);
                if (psb->flags1) {
                        printk(KERN_ERR BFX "unknown flags\n");
                        return -ENODEV;
                }

                vstable = psb->voltagestabilizationtime;
                printk(KERN_INFO PFX "voltage stable time: %d (units 20us)\n",
                       vstable);

                dprintk(KERN_DEBUG PFX "flags2: 0x%x\n", psb->flags2);
                rvo = psb->flags2 & 3;
                irt = ((psb->flags2) >> 2) & 3;
                mvs = ((psb->flags2) >> 4) & 3;
                vidmvs = 1 << mvs;
                batps = ((psb->flags2) >> 6) & 3;
                printk(KERN_INFO PFX "p states on battery: %d ", batps);
                switch (batps) {
                case 0:
                        printk("- all available\n");
                        break;
                case 1:
                        printk("- only the minimum\n");
                        break;
                case 2:
                        printk("- only the 2 lowest\n");
                        break;
                case 3:
                        printk("- only the 3 lowest\n");
                        break;
                }
                printk(KERN_INFO PFX "ramp voltage offset: %d\n", rvo);
                printk(KERN_INFO PFX "isochronous relief time: %d\n", irt);
                printk(KERN_INFO PFX "maximum voltage step: %d\n", mvs);

                dprintk(KERN_DEBUG PFX "numpst: 0x%x\n", psb->numpst);
                if (psb->numpst != 1) {
                        printk(KERN_ERR BFX "numpst must be 1\n");
                        return -ENODEV;
                }

                dprintk(KERN_DEBUG PFX "cpuid: 0x%x\n", psb->cpuid);

                plllock = psb->plllocktime;
                printk(KERN_INFO PFX "pll lock time: 0x%x\n", plllock);

                maxvid = psb->maxvid;
                printk(KERN_INFO PFX "maxfid: 0x%x\n", psb->maxfid);
                printk(KERN_INFO PFX "maxvid: 0x%x\n", maxvid);

                numps = psb->numpstates;
                printk(KERN_INFO PFX "numpstates: 0x%x\n", numps);
                if (numps < 2) {
                        printk(KERN_ERR BFX "no p states to transition\n");
                        return -ENODEV;
                }

                if (batps == 0) {
                        batps = numps;
                } else if (batps > numps) {
                        printk(KERN_ERR BFX "batterypstates > numpstates\n");
                        batps = numps;
                } else {
                        printk(KERN_ERR PFX
                               "Restricting operation to %d p-states\n", batps);
                        printk(KERN_ERR PFX
                               "Check for an updated driver to access all "
                               "%d p-states\n", numps);
                }

                if ((numps <= 1) || (batps <= 1)) {
                        printk(KERN_ERR PFX "only 1 p-state to transition\n");
                        return -ENODEV;
                }

                ppst = kmalloc(sizeof (struct pst_s) * numps, GFP_KERNEL);
                if (!ppst) {
                        printk(KERN_ERR PFX "ppst memory alloc failure\n");
                        return -ENOMEM;
                }

                pst = (struct pst_s *) (psb + 1);
                for (j = 0; j < numps; j++) {
                        ppst[j].fid = pst[j].fid;
                        ppst[j].vid = pst[j].vid;
                        printk(KERN_INFO PFX
                               "   %d : fid 0x%x, vid 0x%x\n", j,
                               ppst[j].fid, ppst[j].vid);
                }
                sort_pst(ppst, numps);

                lastfid = ppst[0].fid;
                if (lastfid > LO_FID_TABLE_TOP)
                        printk(KERN_INFO BFX "first fid not in lo freq tbl\n");

                if ((lastfid > MAX_FID) || (lastfid & 1) || (ppst[0].vid > LEAST_VID)) {
                        printk(KERN_ERR BFX "first fid/vid bad (0x%x - 0x%x)\n",
                               lastfid, ppst[0].vid);
                        kfree(ppst);
                        return -ENODEV;
                }

                for (j = 1; j < numps; j++) {
                        if ((lastfid >= ppst[j].fid)
                            || (ppst[j].fid & 1)
                            || (ppst[j].fid < HI_FID_TABLE_BOTTOM)
                            || (ppst[j].fid > MAX_FID)
                            || (ppst[j].vid > LEAST_VID)) {
                                printk(KERN_ERR BFX
                                       "invalid fid/vid in pst(%x %x)\n",
                                       ppst[j].fid, ppst[j].vid);
                                kfree(ppst);
                                return -ENODEV;
                        }
                        lastfid = ppst[j].fid;
                }

                for (j = 0; j < numps; j++) {
                        if (ppst[j].vid < rvo) {        /* vid+rvo >= 0 */
                                printk(KERN_ERR BFX
                                       "0 vid exceeded with pstate %d\n", j);
                                return -ENODEV;
                        }
                        if (ppst[j].vid < maxvid+rvo) { /* vid+rvo >= maxvid */
                                printk(KERN_ERR BFX
                                       "maxvid exceeded with pstate %d\n", j);
                                return -ENODEV;
                        }
                }

                if (query_current_values_with_pending_wait()) {
                        kfree(ppst);
                        return -EIO;
                }

                printk(KERN_INFO PFX "currfid 0x%x, currvid 0x%x\n",
                       currfid, currvid);

                for (j = 0; j < numps; j++)
                        if ((ppst[j].fid==currfid) && (ppst[j].vid==currvid))
                                return (0);

                printk(KERN_ERR BFX "currfid/vid do not match PST, ignoring\n");
                return 0;
        }

        printk(KERN_ERR BFX "no PSB\n");
        return -ENODEV;
}

/* Converts a frequency (that might not necessarily be a multiple of 200) */
/* to a fid.                                                              */
static u32 find_closest_fid(u32 freq, int searchup)
{
        if (searchup == SEARCH_UP)
                freq += MIN_FREQ_RESOLUTION - 1;

        freq = (freq / MIN_FREQ_RESOLUTION) * MIN_FREQ_RESOLUTION;

        if (freq < MIN_FREQ)
                freq = MIN_FREQ;
        else if (freq > MAX_FREQ)
                freq = MAX_FREQ;

        return find_fid_from_freq(freq);
}

static int find_match(u32 * ptargfreq, u32 * pmin, u32 * pmax, int searchup, u32 * pfid, u32 * pvid)
{
        u32 availpstates = batps;
        u32 targfid = find_closest_fid(*ptargfreq, searchup);
        u32 minfid = find_closest_fid(*pmin, SEARCH_DOWN);
        u32 maxfid = find_closest_fid(*pmax, SEARCH_UP);
        u32 minidx = 0;
        u32 maxidx = availpstates - 1;
        u32 targidx = 0xffffffff;
        int i;

        dprintk(KERN_DEBUG PFX "find match: freq %d MHz, min %d, max %d\n",
                *ptargfreq, *pmin, *pmax);

        /* Restrict values to the frequency choices in the PST */
        if (minfid < ppst[0].fid)
                minfid = ppst[0].fid;
        if (maxfid > ppst[maxidx].fid)
                maxfid = ppst[maxidx].fid;

        /* Find appropriate PST index for the minimim fid */
        for (i = 0; i < (int) availpstates; i++) {
                if (minfid >= ppst[i].fid)
                        minidx = i;
        }

        /* Find appropriate PST index for the maximum fid */
        for (i = availpstates - 1; i >= 0; i--) {
                if (maxfid <= ppst[i].fid)
                        maxidx = i;
        }

        if (minidx > maxidx)
                maxidx = minidx;

        /* Frequency ids are now constrained by limits matching PST entries */
        minfid = ppst[minidx].fid;
        maxfid = ppst[maxidx].fid;

        /* Limit the target frequency to these limits */
        if (targfid < minfid)
                targfid = minfid;
        else if (targfid > maxfid)
                targfid = maxfid;

        /* Find the best target index into the PST, contrained by the range */
        if (searchup == SEARCH_UP) {
                for (i = maxidx; i >= (int) minidx; i--) {
                        if (targfid <= ppst[i].fid)
                                targidx = i;
                }
        } else {
                for (i = minidx; i <= (int) maxidx; i++) {
                        if (targfid >= ppst[i].fid)
                                targidx = i;
                }
        }

        if (targidx == 0xffffffff) {
                printk(KERN_ERR PFX "could not find target\n");
                return 1;
        }

        *pmin = find_freq_from_fid(minfid);
        *pmax = find_freq_from_fid(maxfid);
        *ptargfreq = find_freq_from_fid(ppst[targidx].fid);

        if (pfid)
                *pfid = ppst[targidx].fid;
        if (pvid)
                *pvid = ppst[targidx].vid;

        return 0;
}

/* Take a frequency, and issue the fid/vid transition command */
static inline int transition_frequency(u32 * preq, u32 * pmin, u32 * pmax, u32 searchup)
{
        u32 fid;
        u32 vid;
        int res;
        struct cpufreq_freqs freqs;

        if (find_match(preq, pmin, pmax, searchup, &fid, &vid))
                return 1;

        dprintk(KERN_DEBUG PFX "table matched fid 0x%x, giving vid 0x%x\n",
                fid, vid);

        if (query_current_values_with_pending_wait())
                return 1;

        if ((currvid == vid) && (currfid == fid)) {
                dprintk(KERN_DEBUG PFX
                        "target matches current values (fid 0x%x, vid 0x%x)\n",
                        fid, vid);
                return 0;
        }

        if ((fid < HI_FID_TABLE_BOTTOM) && (currfid < HI_FID_TABLE_BOTTOM)) {
                printk(KERN_ERR PFX
                       "ignoring illegal change in lo freq table-%x to %x\n",
                       currfid, fid);
                return 1;
        }

        dprintk(KERN_DEBUG PFX "changing to fid 0x%x, vid 0x%x\n", fid, vid);

        freqs.cpu = 0;  /* only true because SMP not supported */

        freqs.old = find_freq_from_fid(currfid);
        freqs.new = find_freq_from_fid(fid);
        cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);

        res = transition_fid_vid(fid, vid);

        freqs.new = find_freq_from_fid(currfid);
        cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);

        return res;
}

/* Driver entry point to switch to the target frequency */
static int powernowk8_target(struct cpufreq_policy *pol, unsigned targfreq, unsigned relation)
{
        u32 checkfid = currfid;
        u32 checkvid = currvid;
        u32 reqfreq = targfreq / 1000;
        u32 minfreq = pol->min / 1000;
        u32 maxfreq = pol->max / 1000;

        if (ppst == 0) {
                printk(KERN_ERR PFX "targ: ppst 0\n");
                return -ENODEV;
        }

        if (pending_bit_stuck()) {
                printk(KERN_ERR PFX "drv targ fail: change pending bit set\n");
                return -EIO;
        }

        dprintk(KERN_DEBUG PFX "targ: %d kHz, min %d, max %d, relation %d\n",
                targfreq, pol->min, pol->max, relation);

        if (query_current_values_with_pending_wait())
                return -EIO;

        dprintk(KERN_DEBUG PFX "targ: curr fid 0x%x, vid 0x%x\n",
                currfid, currvid);

        if ((checkvid != currvid) || (checkfid != currfid)) {
                printk(KERN_ERR PFX
                       "error - out of sync, fid 0x%x 0x%x, vid 0x%x 0x%x\n",
                       checkfid, currfid, checkvid, currvid);
        }

        if (transition_frequency(&reqfreq, &minfreq, &maxfreq,
                                 relation ==
                                 CPUFREQ_RELATION_H ? SEARCH_UP : SEARCH_DOWN))
        {
                printk(KERN_ERR PFX "transition frequency failed\n");
                return 1;
        }

        pol->cur = 1000 * find_freq_from_fid(currfid);

        return 0;
}

/* Driver entry point to verify the policy and range of frequencies */
static int powernowk8_verify(struct cpufreq_policy *pol)
{
        u32 min = pol->min / 1000;
        u32 max = pol->max / 1000;
        u32 targ = min;
        int res;

        if (ppst == 0) {
                printk(KERN_ERR PFX "verify - ppst 0\n");
                return -ENODEV;
        }

        if (pending_bit_stuck()) {
                printk(KERN_ERR PFX "failing verify, change pending bit set\n");
                return -EIO;
        }

        dprintk(KERN_DEBUG PFX
                "ver: cpu%d, min %d, max %d, cur %d, pol %d\n", pol->cpu,
                pol->min, pol->max, pol->cur, pol->policy);

        if (pol->cpu != 0) {
                printk(KERN_ERR PFX "verify - cpu not 0\n");
                return -ENODEV;
        }

#warning pol->policy is in undefined state here
        res = find_match(&targ, &min, &max,
                         pol->policy == CPUFREQ_POLICY_POWERSAVE ?
                         SEARCH_DOWN : SEARCH_UP, 0, 0);
        if (!res) {
                pol->min = min * 1000;
                pol->max = max * 1000;
        }
        return res;
}

/* per CPU init entry point to the driver */
static int __init powernowk8_cpu_init(struct cpufreq_policy *pol)
{
        if (pol->cpu != 0) {
                printk(KERN_ERR PFX "init not cpu 0\n");
                return -ENODEV;
        }

        pol->governor = 0; //!!!CPUFREQ_DEFAULT_GOVERNOR;

        /* Take a crude guess here. */
        pol->cpuinfo.transition_latency = ((rvo + 8) * vstable * VST_UNITS_20US)
            + (3 * (1 << irt) * 10);

        if (query_current_values_with_pending_wait())
                return -EIO;

        pol->cur = 1000 * find_freq_from_fid(currfid);
        dprintk(KERN_DEBUG PFX "policy current frequency %d kHz\n", pol->cur);

        /* min/max the cpu is capable of */
        pol->cpuinfo.min_freq = 1000 * find_freq_from_fid(ppst[0].fid);
        pol->cpuinfo.max_freq = 1000 * find_freq_from_fid(ppst[numps-1].fid);
        pol->min = 1000 * find_freq_from_fid(ppst[0].fid);
        pol->max = 1000 * find_freq_from_fid(ppst[batps - 1].fid);

        printk(KERN_INFO PFX "cpu_init done, current fid 0x%x, vid 0x%x\n",
               currfid, currvid);

        return 0;
}

/* driver entry point for init */
/*static*/ int __init powernowk8_init(void)
{
        int rc;

        dprintk(KERN_INFO PFX VERSION "\n");

        if (check_supported_cpu() == 0)
                return -ENODEV;

        rc = find_psb_table();
        if (rc)
                return rc;

        if (pending_bit_stuck()) {
                printk(KERN_ERR PFX "powernowk8_init fail, change pending bit set\n");
                kfree(ppst);
                return -EIO;
        }

        return cpufreq_register_driver(&cpufreq_amd64_driver);
}

/* driver entry point for term */
/*static*/ void __exit powernowk8_exit(void)
{
        dprintk(KERN_INFO PFX "powernowk8_exit\n");

        cpufreq_unregister_driver(&cpufreq_amd64_driver);
        kfree(ppst);
}

MODULE_AUTHOR("Paul Devriendt <paul.devriendt@amd.com>");
MODULE_DESCRIPTION("AMD Athlon 64 and Opteron processor frequency driver.");
MODULE_LICENSE("GPL");

module_init(powernowk8_init);
module_exit(powernowk8_exit);