2 * (C) 2004-2006 Sebastian Witt <se.witt@gmx.net>
4 * Licensed under the terms of the GNU GPL License version 2.
5 * Based upon reverse engineered information
7 * BIG FAT DISCLAIMER: Work in progress code. Possibly *dangerous*
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/moduleparam.h>
13 #include <linux/init.h>
14 #include <linux/cpufreq.h>
15 #include <linux/pci.h>
16 #include <linux/delay.h>
18 #define NFORCE2_XTAL 25
19 #define NFORCE2_BOOTFSB 0x48
20 #define NFORCE2_PLLENABLE 0xa8
21 #define NFORCE2_PLLREG 0xa4
22 #define NFORCE2_PLLADR 0xa0
23 #define NFORCE2_PLL(mul, div) (0x100000 | (mul << 8) | div)
25 #define NFORCE2_MIN_FSB 50
26 #define NFORCE2_SAFE_DISTANCE 50
28 /* Delay in ms between FSB changes */
29 /* #define NFORCE2_DELAY 10 */
33 * FSB is changed using the chipset
35 static struct pci_dev
*nforce2_dev
;
43 * minimum and maximum FSB (= FSB at boot time)
48 MODULE_AUTHOR("Sebastian Witt <se.witt@gmx.net>");
49 MODULE_DESCRIPTION("nForce2 FSB changing cpufreq driver");
50 MODULE_LICENSE("GPL");
52 module_param(fid
, int, 0444);
53 module_param(min_fsb
, int, 0444);
55 MODULE_PARM_DESC(fid
, "CPU multiplier to use (11.5 = 115)");
56 MODULE_PARM_DESC(min_fsb
,
57 "Minimum FSB to use, if not defined: current FSB - 50");
59 #define dprintk(msg...) cpufreq_debug_printk(CPUFREQ_DEBUG_DRIVER, \
60 "cpufreq-nforce2", msg)
63 * nforce2_calc_fsb - calculate FSB
66 * Calculates FSB from PLL value
68 static int nforce2_calc_fsb(int pll
)
70 unsigned char mul
, div
;
72 mul
= (pll
>> 8) & 0xff;
76 return NFORCE2_XTAL
* mul
/ div
;
82 * nforce2_calc_pll - calculate PLL value
85 * Calculate PLL value for given FSB
87 static int nforce2_calc_pll(unsigned int fsb
)
89 unsigned char xmul
, xdiv
;
90 unsigned char mul
= 0, div
= 0;
93 /* Try to calculate multiplier and divider up to 4 times */
94 while (((mul
== 0) || (div
== 0)) && (tried
<= 3)) {
95 for (xdiv
= 2; xdiv
<= 0x80; xdiv
++)
96 for (xmul
= 1; xmul
<= 0xfe; xmul
++)
97 if (nforce2_calc_fsb(NFORCE2_PLL(xmul
, xdiv
)) ==
105 if ((mul
== 0) || (div
== 0))
108 return NFORCE2_PLL(mul
, div
);
112 * nforce2_write_pll - write PLL value to chipset
115 * Writes new FSB PLL value to chipset
117 static void nforce2_write_pll(int pll
)
121 /* Set the pll addr. to 0x00 */
122 pci_write_config_dword(nforce2_dev
, NFORCE2_PLLADR
, 0);
124 /* Now write the value in all 64 registers */
125 for (temp
= 0; temp
<= 0x3f; temp
++)
126 pci_write_config_dword(nforce2_dev
, NFORCE2_PLLREG
, pll
);
132 * nforce2_fsb_read - Read FSB
134 * Read FSB from chipset
135 * If bootfsb != 0, return FSB at boot-time
137 static unsigned int nforce2_fsb_read(int bootfsb
)
139 struct pci_dev
*nforce2_sub5
;
142 /* Get chipset boot FSB from subdevice 5 (FSB at boot-time) */
143 nforce2_sub5
= pci_get_subsys(PCI_VENDOR_ID_NVIDIA
, 0x01EF,
144 PCI_ANY_ID
, PCI_ANY_ID
, NULL
);
148 pci_read_config_dword(nforce2_sub5
, NFORCE2_BOOTFSB
, &fsb
);
151 /* Check if PLL register is already set */
152 pci_read_config_byte(nforce2_dev
, NFORCE2_PLLENABLE
, (u8
*)&temp
);
154 if (bootfsb
|| !temp
)
157 /* Use PLL register FSB value */
158 pci_read_config_dword(nforce2_dev
, NFORCE2_PLLREG
, &temp
);
159 fsb
= nforce2_calc_fsb(temp
);
165 * nforce2_set_fsb - set new FSB
170 static int nforce2_set_fsb(unsigned int fsb
)
177 if ((fsb
> max_fsb
) || (fsb
< NFORCE2_MIN_FSB
)) {
178 printk(KERN_ERR
"cpufreq: FSB %d is out of range!\n", fsb
);
182 tfsb
= nforce2_fsb_read(0);
184 printk(KERN_ERR
"cpufreq: Error while reading the FSB\n");
188 /* First write? Then set actual value */
189 pci_read_config_byte(nforce2_dev
, NFORCE2_PLLENABLE
, (u8
*)&temp
);
191 pll
= nforce2_calc_pll(tfsb
);
196 nforce2_write_pll(pll
);
199 /* Enable write access */
201 pci_write_config_byte(nforce2_dev
, NFORCE2_PLLENABLE
, (u8
)temp
);
208 while ((tfsb
!= fsb
) && (tfsb
<= max_fsb
) && (tfsb
>= min_fsb
)) {
214 /* Calculate the PLL reg. value */
215 pll
= nforce2_calc_pll(tfsb
);
219 nforce2_write_pll(pll
);
221 mdelay(NFORCE2_DELAY
);
226 pci_write_config_byte(nforce2_dev
, NFORCE2_PLLADR
, (u8
)temp
);
232 * nforce2_get - get the CPU frequency
235 * Returns the CPU frequency
237 static unsigned int nforce2_get(unsigned int cpu
)
241 return nforce2_fsb_read(0) * fid
* 100;
245 * nforce2_target - set a new CPUFreq policy
246 * @policy: new policy
247 * @target_freq: the target frequency
248 * @relation: how that frequency relates to achieved frequency
249 * (CPUFREQ_RELATION_L or CPUFREQ_RELATION_H)
251 * Sets a new CPUFreq policy.
253 static int nforce2_target(struct cpufreq_policy
*policy
,
254 unsigned int target_freq
, unsigned int relation
)
256 /* unsigned long flags; */
257 struct cpufreq_freqs freqs
;
258 unsigned int target_fsb
;
260 if ((target_freq
> policy
->max
) || (target_freq
< policy
->min
))
263 target_fsb
= target_freq
/ (fid
* 100);
265 freqs
.old
= nforce2_get(policy
->cpu
);
266 freqs
.new = target_fsb
* fid
* 100;
267 freqs
.cpu
= 0; /* Only one CPU on nForce2 platforms */
269 if (freqs
.old
== freqs
.new)
272 dprintk("Old CPU frequency %d kHz, new %d kHz\n",
273 freqs
.old
, freqs
.new);
275 cpufreq_notify_transition(&freqs
, CPUFREQ_PRECHANGE
);
278 /* local_irq_save(flags); */
280 if (nforce2_set_fsb(target_fsb
) < 0)
281 printk(KERN_ERR
"cpufreq: Changing FSB to %d failed\n",
284 dprintk("Changed FSB successfully to %d\n",
288 /* local_irq_restore(flags); */
290 cpufreq_notify_transition(&freqs
, CPUFREQ_POSTCHANGE
);
296 * nforce2_verify - verifies a new CPUFreq policy
297 * @policy: new policy
299 static int nforce2_verify(struct cpufreq_policy
*policy
)
301 unsigned int fsb_pol_max
;
303 fsb_pol_max
= policy
->max
/ (fid
* 100);
305 if (policy
->min
< (fsb_pol_max
* fid
* 100))
306 policy
->max
= (fsb_pol_max
+ 1) * fid
* 100;
308 cpufreq_verify_within_limits(policy
,
309 policy
->cpuinfo
.min_freq
,
310 policy
->cpuinfo
.max_freq
);
314 static int nforce2_cpu_init(struct cpufreq_policy
*policy
)
319 /* capability check */
320 if (policy
->cpu
!= 0)
323 /* Get current FSB */
324 fsb
= nforce2_fsb_read(0);
329 /* FIX: Get FID from CPU */
333 "cpufreq: cpu_khz not set, "
334 "can't calculate multiplier!\n");
338 fid
= cpu_khz
/ (fsb
* 100);
349 printk(KERN_INFO
"cpufreq: FSB currently at %i MHz, FID %d.%d\n", fsb
,
352 /* Set maximum FSB to FSB at boot time */
353 max_fsb
= nforce2_fsb_read(1);
359 min_fsb
= max_fsb
- NFORCE2_SAFE_DISTANCE
;
361 if (min_fsb
< NFORCE2_MIN_FSB
)
362 min_fsb
= NFORCE2_MIN_FSB
;
364 /* cpuinfo and default policy values */
365 policy
->cpuinfo
.min_freq
= min_fsb
* fid
* 100;
366 policy
->cpuinfo
.max_freq
= max_fsb
* fid
* 100;
367 policy
->cpuinfo
.transition_latency
= CPUFREQ_ETERNAL
;
368 policy
->cur
= nforce2_get(policy
->cpu
);
369 policy
->min
= policy
->cpuinfo
.min_freq
;
370 policy
->max
= policy
->cpuinfo
.max_freq
;
375 static int nforce2_cpu_exit(struct cpufreq_policy
*policy
)
380 static struct cpufreq_driver nforce2_driver
= {
382 .verify
= nforce2_verify
,
383 .target
= nforce2_target
,
385 .init
= nforce2_cpu_init
,
386 .exit
= nforce2_cpu_exit
,
387 .owner
= THIS_MODULE
,
391 * nforce2_detect_chipset - detect the Southbridge which contains FSB PLL logic
393 * Detects nForce2 A2 and C1 stepping
396 static unsigned int nforce2_detect_chipset(void)
398 nforce2_dev
= pci_get_subsys(PCI_VENDOR_ID_NVIDIA
,
399 PCI_DEVICE_ID_NVIDIA_NFORCE2
,
400 PCI_ANY_ID
, PCI_ANY_ID
, NULL
);
402 if (nforce2_dev
== NULL
)
405 printk(KERN_INFO
"cpufreq: Detected nForce2 chipset revision %X\n",
406 nforce2_dev
->revision
);
408 "cpufreq: FSB changing is maybe unstable and can lead to "
409 "crashes and data loss.\n");
415 * nforce2_init - initializes the nForce2 CPUFreq driver
417 * Initializes the nForce2 FSB support. Returns -ENODEV on unsupported
418 * devices, -EINVAL on problems during initiatization, and zero on
421 static int __init
nforce2_init(void)
423 /* TODO: do we need to detect the processor? */
426 if (nforce2_detect_chipset()) {
427 printk(KERN_ERR
"cpufreq: No nForce2 chipset.\n");
431 return cpufreq_register_driver(&nforce2_driver
);
435 * nforce2_exit - unregisters cpufreq module
437 * Unregisters nForce2 FSB change support.
439 static void __exit
nforce2_exit(void)
441 cpufreq_unregister_driver(&nforce2_driver
);
444 module_init(nforce2_init
);
445 module_exit(nforce2_exit
);