drivers/cpufreq/elanfreq.c

   1 /*
   2  *      elanfreq:       cpufreq driver for the AMD ELAN family
   3  *
   4  *      (c) Copyright 2002 Robert Schwebel <r.schwebel@pengutronix.de>
   5  *
   6  *      Parts of this code are (c) Sven Geggus <sven@geggus.net>
   7  *
   8  *      All Rights Reserved.
   9  *
  10  *      This program is free software; you can redistribute it and/or
  11  *      modify it under the terms of the GNU General Public License
  12  *      as published by the Free Software Foundation; either version
  13  *      2 of the License, or (at your option) any later version.
  14  *
  15  *      2002-02-13: - initial revision for 2.4.18-pre9 by Robert Schwebel
  16  *
  17  */
  18
  19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  20
  21 #include <linux/kernel.h>
  22 #include <linux/module.h>
  23 #include <linux/init.h>
  24
  25 #include <linux/delay.h>
  26 #include <linux/cpufreq.h>
  27
  28 #include <asm/cpu_device_id.h>
  29 #include <asm/msr.h>
  30 #include <linux/timex.h>
  31 #include <linux/io.h>
  32
  33 #define REG_CSCIR 0x22          /* Chip Setup and Control Index Register    */
  34 #define REG_CSCDR 0x23          /* Chip Setup and Control Data  Register    */
  35
  36 /* Module parameter */
  37 static int max_freq;
  38
  39 struct s_elan_multiplier {
  40         int clock;              /* frequency in kHz                         */
  41         int val40h;             /* PMU Force Mode register                  */
  42         int val80h;             /* CPU Clock Speed Register                 */
  43 };
  44
  45 /*
  46  * It is important that the frequencies
  47  * are listed in ascending order here!
  48  */
  49 static struct s_elan_multiplier elan_multiplier[] = {
  50         {1000,  0x02,   0x18},
  51         {2000,  0x02,   0x10},
  52         {4000,  0x02,   0x08},
  53         {8000,  0x00,   0x00},
  54         {16000, 0x00,   0x02},
  55         {33000, 0x00,   0x04},
  56         {66000, 0x01,   0x04},
  57         {99000, 0x01,   0x05}
  58 };
  59
  60 static struct cpufreq_frequency_table elanfreq_table[] = {
  61         {0, 0,  1000},
  62         {0, 1,  2000},
  63         {0, 2,  4000},
  64         {0, 3,  8000},
  65         {0, 4,  16000},
  66         {0, 5,  33000},
  67         {0, 6,  66000},
  68         {0, 7,  99000},
  69         {0, 0,  CPUFREQ_TABLE_END},
  70 };
  71
  72
  73 /**
  74  *      elanfreq_get_cpu_frequency: determine current cpu speed
  75  *
  76  *      Finds out at which frequency the CPU of the Elan SOC runs
  77  *      at the moment. Frequencies from 1 to 33 MHz are generated
  78  *      the normal way, 66 and 99 MHz are called "Hyperspeed Mode"
  79  *      and have the rest of the chip running with 33 MHz.
  80  */
  81
  82 static unsigned int elanfreq_get_cpu_frequency(unsigned int cpu)
  83 {
  84         u8 clockspeed_reg;    /* Clock Speed Register */
  85
  86         local_irq_disable();
  87         outb_p(0x80, REG_CSCIR);
  88         clockspeed_reg = inb_p(REG_CSCDR);
  89         local_irq_enable();
  90
  91         if ((clockspeed_reg & 0xE0) == 0xE0)
  92                 return 0;
  93
  94         /* Are we in CPU clock multiplied mode (66/99 MHz)? */
  95         if ((clockspeed_reg & 0xE0) == 0xC0) {
  96                 if ((clockspeed_reg & 0x01) == 0)
  97                         return 66000;
  98                 else
  99                         return 99000;
 100         }
 101
 102         /* 33 MHz is not 32 MHz... */
 103         if ((clockspeed_reg & 0xE0) == 0xA0)
 104                 return 33000;
 105
 106         return (1<<((clockspeed_reg & 0xE0) >> 5)) * 1000;
 107 }
 108
 109
 110 static int elanfreq_target(struct cpufreq_policy *policy,
 111                             unsigned int state)
 112 {
 113         /*
 114          * Access to the Elan's internal registers is indexed via
 115          * 0x22: Chip Setup & Control Register Index Register (CSCI)
 116          * 0x23: Chip Setup & Control Register Data  Register (CSCD)
 117          *
 118          */
 119
 120         /*
 121          * 0x40 is the Power Management Unit's Force Mode Register.
 122          * Bit 6 enables Hyperspeed Mode (66/100 MHz core frequency)
 123          */
 124
 125         local_irq_disable();
 126         outb_p(0x40, REG_CSCIR);                /* Disable hyperspeed mode */
 127         outb_p(0x00, REG_CSCDR);
 128         local_irq_enable();             /* wait till internal pipelines and */
 129         udelay(1000);                   /* buffers have cleaned up          */
 130
 131         local_irq_disable();
 132
 133         /* now, set the CPU clock speed register (0x80) */
 134         outb_p(0x80, REG_CSCIR);
 135         outb_p(elan_multiplier[state].val80h, REG_CSCDR);
 136
 137         /* now, the hyperspeed bit in PMU Force Mode Register (0x40) */
 138         outb_p(0x40, REG_CSCIR);
 139         outb_p(elan_multiplier[state].val40h, REG_CSCDR);
 140         udelay(10000);
 141         local_irq_enable();
 142
 143         return 0;
 144 }
 145 /*
 146  *      Module init and exit code
 147  */
 148
 149 static int elanfreq_cpu_init(struct cpufreq_policy *policy)
 150 {
 151         struct cpuinfo_x86 *c = &cpu_data(0);
 152         struct cpufreq_frequency_table *pos;
 153
 154         /* capability check */
 155         if ((c->x86_vendor != X86_VENDOR_AMD) ||
 156             (c->x86 != 4) || (c->x86_model != 10))
 157                 return -ENODEV;
 158
 159         /* max freq */
 160         if (!max_freq)
 161                 max_freq = elanfreq_get_cpu_frequency(0);
 162
 163         /* table init */
 164         cpufreq_for_each_entry(pos, elanfreq_table)
 165                 if (pos->frequency > max_freq)
 166                         pos->frequency = CPUFREQ_ENTRY_INVALID;
 167
 168         policy->freq_table = elanfreq_table;
 169         return 0;
 170 }
 171
 172
 173 #ifndef MODULE
 174 /**
 175  * elanfreq_setup - elanfreq command line parameter parsing
 176  *
 177  * elanfreq command line parameter.  Use:
 178  *  elanfreq=66000
 179  * to set the maximum CPU frequency to 66 MHz. Note that in
 180  * case you do not give this boot parameter, the maximum
 181  * frequency will fall back to _current_ CPU frequency which
 182  * might be lower. If you build this as a module, use the
 183  * max_freq module parameter instead.
 184  */
 185 static int __init elanfreq_setup(char *str)
 186 {
 187         max_freq = simple_strtoul(str, &str, 0);
 188         pr_warn("You're using the deprecated elanfreq command line option. Use elanfreq.max_freq instead, please!\n");
 189         return 1;
 190 }
 191 __setup("elanfreq=", elanfreq_setup);
 192 #endif
 193
 194
 195 static struct cpufreq_driver elanfreq_driver = {
 196         .get            = elanfreq_get_cpu_frequency,
 197         .flags          = CPUFREQ_NO_AUTO_DYNAMIC_SWITCHING,
 198         .verify         = cpufreq_generic_frequency_table_verify,
 199         .target_index   = elanfreq_target,
 200         .init           = elanfreq_cpu_init,
 201         .name           = "elanfreq",
 202         .attr           = cpufreq_generic_attr,
 203 };
 204
 205 static const struct x86_cpu_id elan_id[] = {
 206         { X86_VENDOR_AMD, 4, 10, },
 207         {}
 208 };
 209 MODULE_DEVICE_TABLE(x86cpu, elan_id);
 210
 211 static int __init elanfreq_init(void)
 212 {
 213         if (!x86_match_cpu(elan_id))
 214                 return -ENODEV;
 215         return cpufreq_register_driver(&elanfreq_driver);
 216 }
 217
 218
 219 static void __exit elanfreq_exit(void)
 220 {
 221         cpufreq_unregister_driver(&elanfreq_driver);
 222 }
 223
 224
 225 module_param(max_freq, int, 0444);
 226
 227 MODULE_LICENSE("GPL");
 228 MODULE_AUTHOR("Robert Schwebel <r.schwebel@pengutronix.de>, "
 229                 "Sven Geggus <sven@geggus.net>");
 230 MODULE_DESCRIPTION("cpufreq driver for AMD's Elan CPUs");
 231
 232 module_init(elanfreq_init);
 233 module_exit(elanfreq_exit);