2005-06-01 10:03:45 +08:00
|
|
|
/*
|
|
|
|
* sc520_freq.c: cpufreq driver for the AMD Elan sc520
|
|
|
|
*
|
|
|
|
* Copyright (C) 2005 Sean Young <sean@mess.org>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public License
|
|
|
|
* as published by the Free Software Foundation; either version
|
|
|
|
* 2 of the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* Based on elanfreq.c
|
|
|
|
*
|
|
|
|
* 2005-03-30: - initial revision
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/cpufreq.h>
|
2009-01-18 14:27:35 +08:00
|
|
|
#include <linux/timex.h>
|
|
|
|
#include <linux/io.h>
|
2005-06-01 10:03:45 +08:00
|
|
|
|
2012-01-26 07:09:12 +08:00
|
|
|
#include <asm/cpu_device_id.h>
|
2005-06-01 10:03:45 +08:00
|
|
|
#include <asm/msr.h>
|
|
|
|
|
|
|
|
#define MMCR_BASE 0xfffef000 /* The default base address */
|
|
|
|
#define OFFS_CPUCTL 0x2 /* CPU Control Register */
|
|
|
|
|
|
|
|
static __u8 __iomem *cpuctl;
|
|
|
|
|
2009-01-18 14:27:35 +08:00
|
|
|
#define PFX "sc520_freq: "
|
2005-06-01 10:03:45 +08:00
|
|
|
|
|
|
|
static struct cpufreq_frequency_table sc520_freq_table[] = {
|
|
|
|
{0x01, 100000},
|
|
|
|
{0x02, 133000},
|
|
|
|
{0, CPUFREQ_TABLE_END},
|
|
|
|
};
|
|
|
|
|
|
|
|
static unsigned int sc520_freq_get_cpu_frequency(unsigned int cpu)
|
|
|
|
{
|
|
|
|
u8 clockspeed_reg = *cpuctl;
|
|
|
|
|
|
|
|
switch (clockspeed_reg & 0x03) {
|
|
|
|
default:
|
2009-01-18 14:27:35 +08:00
|
|
|
printk(KERN_ERR PFX "error: cpuctl register has unexpected "
|
|
|
|
"value %02x\n", clockspeed_reg);
|
2005-06-01 10:03:45 +08:00
|
|
|
case 0x01:
|
|
|
|
return 100000;
|
|
|
|
case 0x02:
|
|
|
|
return 133000;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2013-03-24 14:26:43 +08:00
|
|
|
static void sc520_freq_set_cpu_state(struct cpufreq_policy *policy,
|
|
|
|
unsigned int state)
|
2005-06-01 10:03:45 +08:00
|
|
|
{
|
|
|
|
|
|
|
|
struct cpufreq_freqs freqs;
|
|
|
|
u8 clockspeed_reg;
|
|
|
|
|
|
|
|
freqs.old = sc520_freq_get_cpu_frequency(0);
|
|
|
|
freqs.new = sc520_freq_table[state].frequency;
|
|
|
|
|
2013-03-24 14:26:43 +08:00
|
|
|
cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
|
2005-06-01 10:03:45 +08:00
|
|
|
|
2011-03-27 21:04:46 +08:00
|
|
|
pr_debug("attempting to set frequency to %i kHz\n",
|
2005-06-01 10:03:45 +08:00
|
|
|
sc520_freq_table[state].frequency);
|
|
|
|
|
|
|
|
local_irq_disable();
|
|
|
|
|
|
|
|
clockspeed_reg = *cpuctl & ~0x03;
|
2013-03-30 18:55:15 +08:00
|
|
|
*cpuctl = clockspeed_reg | sc520_freq_table[state].driver_data;
|
2005-06-01 10:03:45 +08:00
|
|
|
|
|
|
|
local_irq_enable();
|
|
|
|
|
2013-03-24 14:26:43 +08:00
|
|
|
cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
|
2005-06-01 10:03:45 +08:00
|
|
|
};
|
|
|
|
|
2009-01-18 14:27:35 +08:00
|
|
|
static int sc520_freq_target(struct cpufreq_policy *policy,
|
2005-06-01 10:03:45 +08:00
|
|
|
unsigned int target_freq,
|
|
|
|
unsigned int relation)
|
|
|
|
{
|
|
|
|
unsigned int newstate = 0;
|
|
|
|
|
2009-01-18 14:27:35 +08:00
|
|
|
if (cpufreq_frequency_table_target(policy, sc520_freq_table,
|
|
|
|
target_freq, relation, &newstate))
|
2005-06-01 10:03:45 +08:00
|
|
|
return -EINVAL;
|
|
|
|
|
2013-03-24 14:26:43 +08:00
|
|
|
sc520_freq_set_cpu_state(policy, newstate);
|
2005-06-01 10:03:45 +08:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Module init and exit code
|
|
|
|
*/
|
|
|
|
|
|
|
|
static int sc520_freq_cpu_init(struct cpufreq_policy *policy)
|
|
|
|
{
|
2007-10-20 02:35:04 +08:00
|
|
|
struct cpuinfo_x86 *c = &cpu_data(0);
|
2005-06-01 10:03:45 +08:00
|
|
|
|
|
|
|
/* capability check */
|
|
|
|
if (c->x86_vendor != X86_VENDOR_AMD ||
|
|
|
|
c->x86 != 4 || c->x86_model != 9)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
/* cpuinfo and default policy values */
|
|
|
|
policy->cpuinfo.transition_latency = 1000000; /* 1ms */
|
|
|
|
|
2013-09-16 21:26:34 +08:00
|
|
|
return cpufreq_table_validate_and_show(policy, sc520_freq_table);
|
2005-06-01 10:03:45 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2007-02-27 06:55:48 +08:00
|
|
|
static struct cpufreq_driver sc520_freq_driver = {
|
2005-06-01 10:03:45 +08:00
|
|
|
.get = sc520_freq_get_cpu_frequency,
|
2013-10-03 22:58:24 +08:00
|
|
|
.verify = cpufreq_generic_frequency_table_verify,
|
2005-06-01 10:03:45 +08:00
|
|
|
.target = sc520_freq_target,
|
|
|
|
.init = sc520_freq_cpu_init,
|
2013-10-03 22:58:24 +08:00
|
|
|
.exit = cpufreq_generic_exit,
|
2005-06-01 10:03:45 +08:00
|
|
|
.name = "sc520_freq",
|
2013-10-03 22:58:24 +08:00
|
|
|
.attr = cpufreq_generic_attr,
|
2005-06-01 10:03:45 +08:00
|
|
|
};
|
|
|
|
|
2012-01-26 07:09:12 +08:00
|
|
|
static const struct x86_cpu_id sc520_ids[] = {
|
|
|
|
{ X86_VENDOR_AMD, 4, 9 },
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(x86cpu, sc520_ids);
|
2005-06-01 10:03:45 +08:00
|
|
|
|
|
|
|
static int __init sc520_freq_init(void)
|
|
|
|
{
|
2006-10-17 12:32:55 +08:00
|
|
|
int err;
|
2005-06-01 10:03:45 +08:00
|
|
|
|
2012-01-26 07:09:12 +08:00
|
|
|
if (!x86_match_cpu(sc520_ids))
|
2005-06-01 10:03:45 +08:00
|
|
|
return -ENODEV;
|
2012-01-26 07:09:12 +08:00
|
|
|
|
2005-06-01 10:03:45 +08:00
|
|
|
cpuctl = ioremap((unsigned long)(MMCR_BASE + OFFS_CPUCTL), 1);
|
2009-01-18 14:27:35 +08:00
|
|
|
if (!cpuctl) {
|
2005-06-01 10:03:45 +08:00
|
|
|
printk(KERN_ERR "sc520_freq: error: failed to remap memory\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
2006-10-17 12:32:55 +08:00
|
|
|
err = cpufreq_register_driver(&sc520_freq_driver);
|
|
|
|
if (err)
|
|
|
|
iounmap(cpuctl);
|
|
|
|
|
|
|
|
return err;
|
2005-06-01 10:03:45 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void __exit sc520_freq_exit(void)
|
|
|
|
{
|
|
|
|
cpufreq_unregister_driver(&sc520_freq_driver);
|
|
|
|
iounmap(cpuctl);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
MODULE_AUTHOR("Sean Young <sean@mess.org>");
|
|
|
|
MODULE_DESCRIPTION("cpufreq driver for AMD's Elan sc520 CPU");
|
|
|
|
|
|
|
|
module_init(sc520_freq_init);
|
|
|
|
module_exit(sc520_freq_exit);
|
|
|
|
|