powernow-k8.c 37 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1
/*
2
 *   (c) 2003-2006 Advanced Micro Devices, Inc.
Linus Torvalds's avatar
Linus Torvalds committed
3
4
5
6
 *  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
 *
Dave Jones's avatar
Dave Jones committed
7
 *  Support : mark.langsdorf@amd.com
Linus Torvalds's avatar
Linus Torvalds committed
8
9
 *
 *  Based on the powernow-k7.c module written by Dave Jones.
Dave Jones's avatar
Dave Jones committed
10
 *  (C) 2003 Dave Jones on behalf of SuSE Labs
Linus Torvalds's avatar
Linus Torvalds committed
11
12
13
14
15
16
 *  (C) 2004 Dominik Brodowski <linux@brodo.de>
 *  (C) 2004 Pavel Machek <pavel@suse.cz>
 *  Licensed under the terms of the GNU GPL License version 2.
 *  Based upon datasheets & sample CPUs kindly provided by AMD.
 *
 *  Valuable input gratefully received from Dave Jones, Pavel Machek,
17
 *  Dominik Brodowski, Jacob Shin, and others.
Dave Jones's avatar
Dave Jones committed
18
 *  Originally developed by Paul Devriendt.
Linus Torvalds's avatar
Linus Torvalds committed
19
20
21
22
 *  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" available for download from www.amd.com
 *
Dave Jones's avatar
Dave Jones committed
23
 *  Tables for specific CPUs can be inferred from
Dave Jones's avatar
Dave Jones committed
24
 *     http://www.amd.com/us-en/assets/content_type/white_papers_and_tech_docs/30430.pdf
Linus Torvalds's avatar
Linus Torvalds committed
25
26
27
28
29
30
31
32
33
 */

#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>
Dave Jones's avatar
Dave Jones committed
34
#include <linux/cpumask.h>
Tim Schmielau's avatar
Tim Schmielau committed
35
#include <linux/sched.h>	/* for current / set_cpus_allowed() */
36
37
#include <linux/io.h>
#include <linux/delay.h>
Linus Torvalds's avatar
Linus Torvalds committed
38
39
40
41

#include <asm/msr.h>

#include <linux/acpi.h>
42
#include <linux/mutex.h>
Linus Torvalds's avatar
Linus Torvalds committed
43
44
45
#include <acpi/processor.h>

#define PFX "powernow-k8: "
46
#define VERSION "version 2.20.00"
Linus Torvalds's avatar
Linus Torvalds committed
47
48
49
#include "powernow-k8.h"

/* serialize freq changes  */
50
static DEFINE_MUTEX(fidvid_mutex);
Linus Torvalds's avatar
Linus Torvalds committed
51

52
static DEFINE_PER_CPU(struct powernow_k8_data *, powernow_data);
Linus Torvalds's avatar
Linus Torvalds committed
53

54
55
static int cpu_family = CPU_OPTERON;

Dave Jones's avatar
Dave Jones committed
56
#ifndef CONFIG_SMP
57
58
59
60
static inline const struct cpumask *cpu_core_mask(int cpu)
{
	return cpumask_of(0);
}
Dave Jones's avatar
Dave Jones committed
61
62
#endif

Linus Torvalds's avatar
Linus Torvalds committed
63
64
65
66
67
68
69
70
71
72
73
74
/* Return a frequency in MHz, given an input fid */
static u32 find_freq_from_fid(u32 fid)
{
	return 800 + (fid * 100);
}

/* Return a frequency in KHz, given an input fid */
static u32 find_khz_freq_from_fid(u32 fid)
{
	return 1000 * find_freq_from_fid(fid);
}

75
76
static u32 find_khz_freq_from_pstate(struct cpufreq_frequency_table *data,
		u32 pstate)
77
{
78
	return data[pstate].frequency;
79
80
}

Linus Torvalds's avatar
Linus Torvalds committed
81
82
83
84
85
86
87
88
/* Return the vco fid for an input fid
 *
 * Each "low" fid has corresponding "high" fid, and you can get to "low" fids
 * only from corresponding high fids. This returns "high" fid corresponding to
 * "low" one.
 */
static u32 convert_fid_to_vco_fid(u32 fid)
{
89
	if (fid < HI_FID_TABLE_BOTTOM)
Linus Torvalds's avatar
Linus Torvalds committed
90
		return 8 + (2 * fid);
91
	else
Linus Torvalds's avatar
Linus Torvalds committed
92
93
94
95
96
97
98
99
100
101
102
		return fid;
}

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

103
	if (cpu_family == CPU_HW_PSTATE)
104
105
		return 0;

Linus Torvalds's avatar
Linus Torvalds committed
106
107
108
109
110
111
112
113
114
115
116
117
118
	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(struct powernow_k8_data *data)
{
	u32 lo, hi;
	u32 i = 0;

119
	if (cpu_family == CPU_HW_PSTATE) {
120
121
122
123
124
125
126
127
128
129
130
131
132
133
		if (data->currpstate == HW_PSTATE_INVALID) {
			/* read (initial) hw pstate if not yet set */
			rdmsr(MSR_PSTATE_STATUS, lo, hi);
			i = lo & HW_PSTATE_MASK;

			/*
			 * a workaround for family 11h erratum 311 might cause
			 * an "out-of-range Pstate if the core is in Pstate-0
			 */
			if (i >= data->numps)
				data->currpstate = HW_PSTATE_0;
			else
				data->currpstate = i;
		}
134
135
		return 0;
	}
136
	do {
137
138
		if (i++ > 10000) {
			dprintk("detected change pending stuck\n");
Linus Torvalds's avatar
Linus Torvalds committed
139
140
141
			return 1;
		}
		rdmsr(MSR_FIDVID_STATUS, lo, hi);
142
	} while (lo & MSR_S_LO_CHANGE_PENDING);
Linus Torvalds's avatar
Linus Torvalds committed
143
144
145
146
147
148
149
150
151
152
153
154
155
156

	data->currvid = hi & MSR_S_HI_CURRENT_VID;
	data->currfid = lo & MSR_S_LO_CURRENT_FID;

	return 0;
}

/* the isochronous relief time */
static void count_off_irt(struct powernow_k8_data *data)
{
	udelay((1 << data->irt) * 10);
	return;
}

Simon Arlott's avatar
Simon Arlott committed
157
/* the voltage stabilization time */
Linus Torvalds's avatar
Linus Torvalds committed
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
static void count_off_vst(struct powernow_k8_data *data)
{
	udelay(data->vstable * VST_UNITS_20US);
	return;
}

/* need to init the control msr to a safe value (for each cpu) */
static void fidvid_msr_init(void)
{
	u32 lo, hi;
	u8 fid, vid;

	rdmsr(MSR_FIDVID_STATUS, lo, hi);
	vid = hi & MSR_S_HI_CURRENT_VID;
	fid = lo & MSR_S_LO_CURRENT_FID;
	lo = fid | (vid << MSR_C_LO_VID_SHIFT);
	hi = MSR_C_HI_STP_GNT_BENIGN;
	dprintk("cpu%d, init lo 0x%x, hi 0x%x\n", smp_processor_id(), lo, hi);
	wrmsr(MSR_FIDVID_CTL, lo, hi);
}

/* write the new fid value along with the other control fields to the msr */
static int write_new_fid(struct powernow_k8_data *data, u32 fid)
{
	u32 lo;
	u32 savevid = data->currvid;
184
	u32 i = 0;
Linus Torvalds's avatar
Linus Torvalds committed
185
186
187
188
189
190

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

191
192
193
	lo = fid;
	lo |= (data->currvid << MSR_C_LO_VID_SHIFT);
	lo |= MSR_C_LO_INIT_FID_VID;
Linus Torvalds's avatar
Linus Torvalds committed
194
195
196
197

	dprintk("writing fid 0x%x, lo 0x%x, hi 0x%x\n",
		fid, lo, data->plllock * PLL_LOCK_CONVERSION);

198
199
200
	do {
		wrmsr(MSR_FIDVID_CTL, lo, data->plllock * PLL_LOCK_CONVERSION);
		if (i++ > 100) {
201
202
203
			printk(KERN_ERR PFX
				"Hardware error - pending bit very stuck - "
				"no further pstate changes possible\n");
204
			return 1;
205
		}
206
	} while (query_current_values_with_pending_wait(data));
Linus Torvalds's avatar
Linus Torvalds committed
207
208
209
210

	count_off_irt(data);

	if (savevid != data->currvid) {
211
212
213
		printk(KERN_ERR PFX
			"vid change on fid trans, old 0x%x, new 0x%x\n",
			savevid, data->currvid);
Linus Torvalds's avatar
Linus Torvalds committed
214
215
216
217
		return 1;
	}

	if (fid != data->currfid) {
218
219
220
		printk(KERN_ERR PFX
			"fid trans failed, fid 0x%x, curr 0x%x\n", fid,
			data->currfid);
Linus Torvalds's avatar
Linus Torvalds committed
221
222
223
224
225
226
227
228
229
230
231
		return 1;
	}

	return 0;
}

/* Write a new vid to the hardware */
static int write_new_vid(struct powernow_k8_data *data, u32 vid)
{
	u32 lo;
	u32 savefid = data->currfid;
232
	int i = 0;
Linus Torvalds's avatar
Linus Torvalds committed
233
234
235
236
237
238

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

239
240
241
	lo = data->currfid;
	lo |= (vid << MSR_C_LO_VID_SHIFT);
	lo |= MSR_C_LO_INIT_FID_VID;
Linus Torvalds's avatar
Linus Torvalds committed
242
243
244
245

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

246
247
	do {
		wrmsr(MSR_FIDVID_CTL, lo, STOP_GRANT_5NS);
248
		if (i++ > 100) {
249
250
251
			printk(KERN_ERR PFX "internal error - pending bit "
					"very stuck - no further pstate "
					"changes possible\n");
252
253
			return 1;
		}
254
	} while (query_current_values_with_pending_wait(data));
Linus Torvalds's avatar
Linus Torvalds committed
255
256

	if (savefid != data->currfid) {
257
258
		printk(KERN_ERR PFX "fid changed on vid trans, old "
			"0x%x new 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
259
260
261
262
263
		       savefid, data->currfid);
		return 1;
	}

	if (vid != data->currvid) {
264
265
266
		printk(KERN_ERR PFX "vid trans failed, vid 0x%x, "
				"curr 0x%x\n",
				vid, data->currvid);
Linus Torvalds's avatar
Linus Torvalds committed
267
268
269
270
271
272
273
274
275
		return 1;
	}

	return 0;
}

/*
 * Reduce the vid by the max of step or reqvid.
 * Decreasing vid codes represent increasing voltages:
276
 * vid of 0 is 1.550V, vid of 0x1e is 0.800V, vid of VID_OFF is off.
Linus Torvalds's avatar
Linus Torvalds committed
277
 */
278
279
static int decrease_vid_code_by_step(struct powernow_k8_data *data,
		u32 reqvid, u32 step)
Linus Torvalds's avatar
Linus Torvalds committed
280
281
282
283
284
285
286
287
288
289
290
291
{
	if ((data->currvid - reqvid) > step)
		reqvid = data->currvid - step;

	if (write_new_vid(data, reqvid))
		return 1;

	count_off_vst(data);

	return 0;
}

292
293
294
295
/* Change hardware pstate by single MSR write */
static int transition_pstate(struct powernow_k8_data *data, u32 pstate)
{
	wrmsr(MSR_PSTATE_CTRL, pstate, 0);
296
	data->currpstate = pstate;
297
298
299
300
	return 0;
}

/* Change Opteron/Athlon64 fid and vid, by the 3 phases. */
301
302
static int transition_fid_vid(struct powernow_k8_data *data,
		u32 reqfid, u32 reqvid)
Linus Torvalds's avatar
Linus Torvalds committed
303
304
305
306
307
308
309
310
311
312
313
314
315
316
{
	if (core_voltage_pre_transition(data, reqvid))
		return 1;

	if (core_frequency_transition(data, reqfid))
		return 1;

	if (core_voltage_post_transition(data, reqvid))
		return 1;

	if (query_current_values_with_pending_wait(data))
		return 1;

	if ((reqfid != data->currfid) || (reqvid != data->currvid)) {
317
318
		printk(KERN_ERR PFX "failed (cpu%d): req 0x%x 0x%x, "
				"curr 0x%x 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
319
320
321
322
323
324
325
326
327
328
329
330
				smp_processor_id(),
				reqfid, reqvid, data->currfid, data->currvid);
		return 1;
	}

	dprintk("transitioned (cpu%d): new fid 0x%x, vid 0x%x\n",
		smp_processor_id(), data->currfid, data->currvid);

	return 0;
}

/* Phase 1 - core voltage transition ... setup voltage */
331
332
static int core_voltage_pre_transition(struct powernow_k8_data *data,
		u32 reqvid)
Linus Torvalds's avatar
Linus Torvalds committed
333
334
335
{
	u32 rvosteps = data->rvo;
	u32 savefid = data->currfid;
Dave Jones's avatar
Dave Jones committed
336
	u32 maxvid, lo;
Linus Torvalds's avatar
Linus Torvalds committed
337

338
339
	dprintk("ph1 (cpu%d): start, currfid 0x%x, currvid 0x%x, "
		"reqvid 0x%x, rvo 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
340
341
342
		smp_processor_id(),
		data->currfid, data->currvid, reqvid, data->rvo);

Dave Jones's avatar
Dave Jones committed
343
344
345
346
347
348
	rdmsr(MSR_FIDVID_STATUS, lo, maxvid);
	maxvid = 0x1f & (maxvid >> 16);
	dprintk("ph1 maxvid=0x%x\n", maxvid);
	if (reqvid < maxvid) /* lower numbers are higher voltages */
		reqvid = maxvid;

Linus Torvalds's avatar
Linus Torvalds committed
349
350
351
352
353
354
355
	while (data->currvid > reqvid) {
		dprintk("ph1: curr 0x%x, req vid 0x%x\n",
			data->currvid, reqvid);
		if (decrease_vid_code_by_step(data, reqvid, data->vidmvs))
			return 1;
	}

Dave Jones's avatar
Dave Jones committed
356
357
	while ((rvosteps > 0) && ((data->rvo + data->currvid) > reqvid)) {
		if (data->currvid == maxvid) {
Linus Torvalds's avatar
Linus Torvalds committed
358
359
360
361
			rvosteps = 0;
		} else {
			dprintk("ph1: changing vid for rvo, req 0x%x\n",
				data->currvid - 1);
362
			if (decrease_vid_code_by_step(data, data->currvid-1, 1))
Linus Torvalds's avatar
Linus Torvalds committed
363
364
365
366
367
368
369
370
371
				return 1;
			rvosteps--;
		}
	}

	if (query_current_values_with_pending_wait(data))
		return 1;

	if (savefid != data->currfid) {
372
373
		printk(KERN_ERR PFX "ph1 err, currfid changed 0x%x\n",
				data->currfid);
Linus Torvalds's avatar
Linus Torvalds committed
374
375
376
377
378
379
380
381
382
383
384
385
		return 1;
	}

	dprintk("ph1 complete, currfid 0x%x, currvid 0x%x\n",
		data->currfid, data->currvid);

	return 0;
}

/* Phase 2 - core frequency transition */
static int core_frequency_transition(struct powernow_k8_data *data, u32 reqfid)
{
386
387
	u32 vcoreqfid, vcocurrfid, vcofiddiff;
	u32 fid_interval, savevid = data->currvid;
Linus Torvalds's avatar
Linus Torvalds committed
388

389
390
391
392
	if ((reqfid < HI_FID_TABLE_BOTTOM) &&
	    (data->currfid < HI_FID_TABLE_BOTTOM)) {
		printk(KERN_ERR PFX "ph2: illegal lo-lo transition "
				"0x%x 0x%x\n", reqfid, data->currfid);
Linus Torvalds's avatar
Linus Torvalds committed
393
394
395
396
		return 1;
	}

	if (data->currfid == reqfid) {
397
398
		printk(KERN_ERR PFX "ph2 null fid transition 0x%x\n",
				data->currfid);
Linus Torvalds's avatar
Linus Torvalds committed
399
400
401
		return 0;
	}

402
403
	dprintk("ph2 (cpu%d): starting, currfid 0x%x, currvid 0x%x, "
		"reqfid 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
404
405
406
407
408
409
410
411
412
		smp_processor_id(),
		data->currfid, data->currvid, reqfid);

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

	while (vcofiddiff > 2) {
413
414
		(data->currfid & 1) ? (fid_interval = 1) : (fid_interval = 2);

Linus Torvalds's avatar
Linus Torvalds committed
415
416
		if (reqfid > data->currfid) {
			if (data->currfid > LO_FID_TABLE_TOP) {
417
418
				if (write_new_fid(data,
						data->currfid + fid_interval))
Linus Torvalds's avatar
Linus Torvalds committed
419
420
421
					return 1;
			} else {
				if (write_new_fid
422
423
				    (data,
				     2 + convert_fid_to_vco_fid(data->currfid)))
Linus Torvalds's avatar
Linus Torvalds committed
424
425
426
					return 1;
			}
		} else {
427
			if (write_new_fid(data, data->currfid - fid_interval))
Linus Torvalds's avatar
Linus Torvalds committed
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
				return 1;
		}

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

	if (write_new_fid(data, reqfid))
		return 1;

	if (query_current_values_with_pending_wait(data))
		return 1;

	if (data->currfid != reqfid) {
		printk(KERN_ERR PFX
444
445
			"ph2: mismatch, failed fid transition, "
			"curr 0x%x, req 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
			data->currfid, reqfid);
		return 1;
	}

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

	dprintk("ph2 complete, currfid 0x%x, currvid 0x%x\n",
		data->currfid, data->currvid);

	return 0;
}

/* Phase 3 - core voltage transition flow ... jump to the final vid. */
463
464
static int core_voltage_post_transition(struct powernow_k8_data *data,
		u32 reqvid)
Linus Torvalds's avatar
Linus Torvalds committed
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
{
	u32 savefid = data->currfid;
	u32 savereqvid = reqvid;

	dprintk("ph3 (cpu%d): starting, currfid 0x%x, currvid 0x%x\n",
		smp_processor_id(),
		data->currfid, data->currvid);

	if (reqvid != data->currvid) {
		if (write_new_vid(data, reqvid))
			return 1;

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

		if (data->currvid != reqvid) {
			printk(KERN_ERR PFX
486
487
			       "ph3: failed vid transition\n, "
			       "req 0x%x, curr 0x%x",
Linus Torvalds's avatar
Linus Torvalds committed
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
			       reqvid, data->currvid);
			return 1;
		}
	}

	if (query_current_values_with_pending_wait(data))
		return 1;

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

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

	dprintk("ph3 complete, currfid 0x%x, currvid 0x%x\n",
		data->currfid, data->currvid);

	return 0;
}

static int check_supported_cpu(unsigned int cpu)
{
515
	cpumask_t oldmask;
Linus Torvalds's avatar
Linus Torvalds committed
516
517
518
519
	u32 eax, ebx, ecx, edx;
	unsigned int rc = 0;

	oldmask = current->cpus_allowed;
520
	set_cpus_allowed_ptr(current, &cpumask_of_cpu(cpu));
Linus Torvalds's avatar
Linus Torvalds committed
521
522

	if (smp_processor_id() != cpu) {
523
		printk(KERN_ERR PFX "limiting to cpu %u failed\n", cpu);
Linus Torvalds's avatar
Linus Torvalds committed
524
525
526
527
528
529
530
		goto out;
	}

	if (current_cpu_data.x86_vendor != X86_VENDOR_AMD)
		goto out;

	eax = cpuid_eax(CPUID_PROCESSOR_SIGNATURE);
531
532
	if (((eax & CPUID_XFAM) != CPUID_XFAM_K8) &&
	    ((eax & CPUID_XFAM) < CPUID_XFAM_10H))
533
534
		goto out;

535
536
	if ((eax & CPUID_XFAM) == CPUID_XFAM_K8) {
		if (((eax & CPUID_USE_XFAM_XMOD) != CPUID_USE_XFAM_XMOD) ||
537
		    ((eax & CPUID_XMOD) > CPUID_XMOD_REV_MASK)) {
538
539
			printk(KERN_INFO PFX
				"Processor cpuid %x not supported\n", eax);
540
541
			goto out;
		}
Linus Torvalds's avatar
Linus Torvalds committed
542

543
544
545
546
547
548
		eax = cpuid_eax(CPUID_GET_MAX_CAPABILITIES);
		if (eax < CPUID_FREQ_VOLT_CAPABILITIES) {
			printk(KERN_INFO PFX
			       "No frequency change capabilities detected\n");
			goto out;
		}
Linus Torvalds's avatar
Linus Torvalds committed
549

550
		cpuid(CPUID_FREQ_VOLT_CAPABILITIES, &eax, &ebx, &ecx, &edx);
551
552
553
554
		if ((edx & P_STATE_TRANSITION_CAPABLE)
			!= P_STATE_TRANSITION_CAPABLE) {
			printk(KERN_INFO PFX
				"Power state transitions not supported\n");
555
556
557
558
559
560
561
562
			goto out;
		}
	} else { /* must be a HW Pstate capable processor */
		cpuid(CPUID_FREQ_VOLT_CAPABILITIES, &eax, &ebx, &ecx, &edx);
		if ((edx & USE_HW_PSTATE) == USE_HW_PSTATE)
			cpu_family = CPU_HW_PSTATE;
		else
			goto out;
Linus Torvalds's avatar
Linus Torvalds committed
563
564
565
566
567
	}

	rc = 1;

out:
568
	set_cpus_allowed_ptr(current, &oldmask);
Linus Torvalds's avatar
Linus Torvalds committed
569
570
571
	return rc;
}

572
573
static int check_pst_table(struct powernow_k8_data *data, struct pst_s *pst,
		u8 maxvid)
Linus Torvalds's avatar
Linus Torvalds committed
574
575
576
577
578
579
{
	unsigned int j;
	u8 lastfid = 0xff;

	for (j = 0; j < data->numps; j++) {
		if (pst[j].vid > LEAST_VID) {
580
581
			printk(KERN_ERR FW_BUG PFX "vid %d invalid : 0x%x\n",
			       j, pst[j].vid);
Linus Torvalds's avatar
Linus Torvalds committed
582
583
			return -EINVAL;
		}
584
585
		if (pst[j].vid < data->rvo) {
			/* vid + rvo >= 0 */
586
587
			printk(KERN_ERR FW_BUG PFX "0 vid exceeded with pstate"
			       " %d\n", j);
Linus Torvalds's avatar
Linus Torvalds committed
588
589
			return -ENODEV;
		}
590
591
		if (pst[j].vid < maxvid + data->rvo) {
			/* vid + rvo >= maxvid */
592
593
			printk(KERN_ERR FW_BUG PFX "maxvid exceeded with pstate"
			       " %d\n", j);
Linus Torvalds's avatar
Linus Torvalds committed
594
595
			return -ENODEV;
		}
596
		if (pst[j].fid > MAX_FID) {
597
598
			printk(KERN_ERR FW_BUG PFX "maxfid exceeded with pstate"
			       " %d\n", j);
599
600
601
			return -ENODEV;
		}
		if (j && (pst[j].fid < HI_FID_TABLE_BOTTOM)) {
Linus Torvalds's avatar
Linus Torvalds committed
602
			/* Only first fid is allowed to be in "low" range */
603
604
			printk(KERN_ERR FW_BUG PFX "two low fids - %d : "
			       "0x%x\n", j, pst[j].fid);
Linus Torvalds's avatar
Linus Torvalds committed
605
606
607
608
609
610
			return -EINVAL;
		}
		if (pst[j].fid < lastfid)
			lastfid = pst[j].fid;
	}
	if (lastfid & 1) {
611
		printk(KERN_ERR FW_BUG PFX "lastfid invalid\n");
Linus Torvalds's avatar
Linus Torvalds committed
612
613
614
		return -EINVAL;
	}
	if (lastfid > LO_FID_TABLE_TOP)
615
616
		printk(KERN_INFO FW_BUG PFX
			"first fid not from lo freq table\n");
Linus Torvalds's avatar
Linus Torvalds committed
617
618
619
620

	return 0;
}

621
622
623
624
625
static void invalidate_entry(struct powernow_k8_data *data, unsigned int entry)
{
	data->powernow_table[entry].frequency = CPUFREQ_ENTRY_INVALID;
}

Linus Torvalds's avatar
Linus Torvalds committed
626
627
628
629
static void print_basics(struct powernow_k8_data *data)
{
	int j;
	for (j = 0; j < data->numps; j++) {
630
631
		if (data->powernow_table[j].frequency !=
				CPUFREQ_ENTRY_INVALID) {
632
			if (cpu_family == CPU_HW_PSTATE) {
633
634
				printk(KERN_INFO PFX
					"   %d : pstate %d (%d MHz)\n", j,
635
					data->powernow_table[j].index,
636
					data->powernow_table[j].frequency/1000);
637
			} else {
638
639
				printk(KERN_INFO PFX
					"   %d : fid 0x%x (%d MHz), vid 0x%x\n",
640
641
642
643
					j,
					data->powernow_table[j].index & 0xff,
					data->powernow_table[j].frequency/1000,
					data->powernow_table[j].index >> 8);
644
645
			}
		}
Linus Torvalds's avatar
Linus Torvalds committed
646
647
	}
	if (data->batps)
648
649
		printk(KERN_INFO PFX "Only %d pstates on battery\n",
				data->batps);
Linus Torvalds's avatar
Linus Torvalds committed
650
651
}

652
653
654
655
656
657
658
659
660
661
662
663
664
665
static u32 freq_from_fid_did(u32 fid, u32 did)
{
	u32 mhz = 0;

	if (boot_cpu_data.x86 == 0x10)
		mhz = (100 * (fid + 0x10)) >> did;
	else if (boot_cpu_data.x86 == 0x11)
		mhz = (100 * (fid + 8)) >> did;
	else
		BUG();

	return mhz * 1000;
}

666
667
static int fill_powernow_table(struct powernow_k8_data *data,
		struct pst_s *pst, u8 maxvid)
Linus Torvalds's avatar
Linus Torvalds committed
668
669
670
671
{
	struct cpufreq_frequency_table *powernow_table;
	unsigned int j;

672
673
674
675
676
	if (data->batps) {
		/* use ACPI support to get full speed on mains power */
		printk(KERN_WARNING PFX
			"Only %d pstates usable (use ACPI driver for full "
			"range\n", data->batps);
Linus Torvalds's avatar
Linus Torvalds committed
677
678
679
		data->numps = data->batps;
	}

680
	for (j = 1; j < data->numps; j++) {
Linus Torvalds's avatar
Linus Torvalds committed
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
		if (pst[j-1].fid >= pst[j].fid) {
			printk(KERN_ERR PFX "PST out of sequence\n");
			return -EINVAL;
		}
	}

	if (data->numps < 2) {
		printk(KERN_ERR PFX "no p states to transition\n");
		return -ENODEV;
	}

	if (check_pst_table(data, pst, maxvid))
		return -EINVAL;

	powernow_table = kmalloc((sizeof(struct cpufreq_frequency_table)
		* (data->numps + 1)), GFP_KERNEL);
	if (!powernow_table) {
		printk(KERN_ERR PFX "powernow_table memory alloc failure\n");
		return -ENOMEM;
	}

	for (j = 0; j < data->numps; j++) {
703
		int freq;
Linus Torvalds's avatar
Linus Torvalds committed
704
705
		powernow_table[j].index = pst[j].fid; /* lower 8 bits */
		powernow_table[j].index |= (pst[j].vid << 8); /* upper 8 bits */
706
707
		freq = find_khz_freq_from_fid(pst[j].fid);
		powernow_table[j].frequency = freq;
Linus Torvalds's avatar
Linus Torvalds committed
708
709
710
711
712
713
714
715
716
717
718
	}
	powernow_table[data->numps].frequency = CPUFREQ_TABLE_END;
	powernow_table[data->numps].index = 0;

	if (query_current_values_with_pending_wait(data)) {
		kfree(powernow_table);
		return -EIO;
	}

	dprintk("cfid 0x%x, cvid 0x%x\n", data->currfid, data->currvid);
	data->powernow_table = powernow_table;
719
	if (cpumask_first(cpu_core_mask(data->cpu)) == data->cpu)
720
		print_basics(data);
Linus Torvalds's avatar
Linus Torvalds committed
721
722

	for (j = 0; j < data->numps; j++)
723
724
		if ((pst[j].fid == data->currfid) &&
		    (pst[j].vid == data->currvid))
Linus Torvalds's avatar
Linus Torvalds committed
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
			return 0;

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

/* Find and validate the PSB/PST table in BIOS. */
static int find_psb_table(struct powernow_k8_data *data)
{
	struct psb_s *psb;
	unsigned int i;
	u32 mvs;
	u8 maxvid;
	u32 cpst = 0;
	u32 thiscpuid;

	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("found PSB header at 0x%p\n", psb);

		dprintk("table vers: 0x%x\n", psb->tableversion);
		if (psb->tableversion != PSB_VERSION_1_4) {
753
			printk(KERN_ERR FW_BUG PFX "PSB table is not v1.4\n");
Linus Torvalds's avatar
Linus Torvalds committed
754
755
756
757
758
			return -ENODEV;
		}

		dprintk("flags: 0x%x\n", psb->flags1);
		if (psb->flags1) {
759
			printk(KERN_ERR FW_BUG PFX "unknown flags\n");
Linus Torvalds's avatar
Linus Torvalds committed
760
761
762
763
			return -ENODEV;
		}

		data->vstable = psb->vstable;
764
765
		dprintk("voltage stabilization time: %d(*20us)\n",
				data->vstable);
Linus Torvalds's avatar
Linus Torvalds committed
766
767
768
769
770
771
772
773
774
775
776
777
778
779

		dprintk("flags2: 0x%x\n", psb->flags2);
		data->rvo = psb->flags2 & 3;
		data->irt = ((psb->flags2) >> 2) & 3;
		mvs = ((psb->flags2) >> 4) & 3;
		data->vidmvs = 1 << mvs;
		data->batps = ((psb->flags2) >> 6) & 3;

		dprintk("ramp voltage offset: %d\n", data->rvo);
		dprintk("isochronous relief time: %d\n", data->irt);
		dprintk("maximum voltage step: %d - 0x%x\n", mvs, data->vidmvs);

		dprintk("numpst: 0x%x\n", psb->num_tables);
		cpst = psb->num_tables;
780
781
		if ((psb->cpuid == 0x00000fc0) ||
		    (psb->cpuid == 0x00000fe0)) {
Linus Torvalds's avatar
Linus Torvalds committed
782
			thiscpuid = cpuid_eax(CPUID_PROCESSOR_SIGNATURE);
783
784
			if ((thiscpuid == 0x00000fc0) ||
			    (thiscpuid == 0x00000fe0))
Linus Torvalds's avatar
Linus Torvalds committed
785
786
787
				cpst = 1;
		}
		if (cpst != 1) {
788
			printk(KERN_ERR FW_BUG PFX "numpst must be 1\n");
Linus Torvalds's avatar
Linus Torvalds committed
789
790
791
792
793
794
795
796
797
798
799
			return -ENODEV;
		}

		data->plllock = psb->plllocktime;
		dprintk("plllocktime: 0x%x (units 1us)\n", psb->plllocktime);
		dprintk("maxfid: 0x%x\n", psb->maxfid);
		dprintk("maxvid: 0x%x\n", psb->maxvid);
		maxvid = psb->maxvid;

		data->numps = psb->numps;
		dprintk("numpstates: 0x%x\n", data->numps);
800
801
		return fill_powernow_table(data,
				(struct pst_s *)(psb+1), maxvid);
Linus Torvalds's avatar
Linus Torvalds committed
802
803
804
805
806
807
808
809
810
811
812
813
	}
	/*
	 * If you see this message, complain to BIOS manufacturer. If
	 * he tells you "we do not support Linux" or some similar
	 * nonsense, remember that Windows 2000 uses the same legacy
	 * mechanism that the old Linux PSB driver uses. Tell them it
	 * is broken with Windows 2000.
	 *
	 * The reference to the AMD documentation is chapter 9 in the
	 * BIOS and Kernel Developer's Guide, which is available on
	 * www.amd.com
	 */
814
	printk(KERN_ERR FW_BUG PFX "No PSB or ACPI _PSS objects\n");
Linus Torvalds's avatar
Linus Torvalds committed
815
816
817
	return -ENODEV;
}

818
819
static void powernow_k8_acpi_pst_values(struct powernow_k8_data *data,
		unsigned int index)
Linus Torvalds's avatar
Linus Torvalds committed
820
{
821
822
	acpi_integer control;

823
	if (!data->acpi_data.state_count || (cpu_family == CPU_HW_PSTATE))
Linus Torvalds's avatar
Linus Torvalds committed
824
825
		return;

826
827
828
829
830
831
832
	control = data->acpi_data.states[index].control; data->irt = (control
			>> IRT_SHIFT) & IRT_MASK; data->rvo = (control >>
				RVO_SHIFT) & RVO_MASK; data->exttype = (control
					>> EXT_TYPE_SHIFT) & EXT_TYPE_MASK;
	data->plllock = (control >> PLL_L_SHIFT) & PLL_L_MASK; data->vidmvs = 1
		<< ((control >> MVS_SHIFT) & MVS_MASK); data->vstable =
		(control >> VST_SHIFT) & VST_MASK; }
Linus Torvalds's avatar
Linus Torvalds committed
833
834
835
836

static int powernow_k8_cpu_init_acpi(struct powernow_k8_data *data)
{
	struct cpufreq_frequency_table *powernow_table;
837
	int ret_val = -ENODEV;
838
	acpi_integer control, status;
Linus Torvalds's avatar
Linus Torvalds committed
839

840
	if (acpi_processor_register_performance(&data->acpi_data, data->cpu)) {
Dave Jones's avatar
Dave Jones committed
841
		dprintk("register performance failed: bad ACPI data\n");
Linus Torvalds's avatar
Linus Torvalds committed
842
843
844
845
		return -EIO;
	}

	/* verify the data contained in the ACPI structures */
846
	if (data->acpi_data.state_count <= 1) {
Linus Torvalds's avatar
Linus Torvalds committed
847
848
849
850
		dprintk("No ACPI P-States\n");
		goto err_out;
	}

851
852
853
854
855
	control = data->acpi_data.control_register.space_id;
	status = data->acpi_data.status_register.space_id;

	if ((control != ACPI_ADR_SPACE_FIXED_HARDWARE) ||
	    (status != ACPI_ADR_SPACE_FIXED_HARDWARE)) {
Linus Torvalds's avatar
Linus Torvalds committed
856
		dprintk("Invalid control/status registers (%x - %x)\n",
857
			control, status);
Linus Torvalds's avatar
Linus Torvalds committed
858
859
860
861
862
		goto err_out;
	}

	/* fill in data->powernow_table */
	powernow_table = kmalloc((sizeof(struct cpufreq_frequency_table)
863
		* (data->acpi_data.state_count + 1)), GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
864
865
866
867
868
	if (!powernow_table) {
		dprintk("powernow_table memory alloc failure\n");
		goto err_out;
	}

869
	if (cpu_family == CPU_HW_PSTATE)
870
871
872
873
874
875
		ret_val = fill_powernow_table_pstate(data, powernow_table);
	else
		ret_val = fill_powernow_table_fidvid(data, powernow_table);
	if (ret_val)
		goto err_out_mem;

876
877
	powernow_table[data->acpi_data.state_count].frequency =
		CPUFREQ_TABLE_END;
878
	powernow_table[data->acpi_data.state_count].index = 0;
879
880
881
	data->powernow_table = powernow_table;

	/* fill in data */
882
	data->numps = data->acpi_data.state_count;
883
	if (cpumask_first(cpu_core_mask(data->cpu)) == data->cpu)
884
		print_basics(data);
885
886
887
888
889
	powernow_k8_acpi_pst_values(data, 0);

	/* notify BIOS that we exist */
	acpi_processor_notify_smm(THIS_MODULE);

890
	if (!zalloc_cpumask_var(&data->acpi_data.shared_cpu_map, GFP_KERNEL)) {
891
892
893
894
895
896
		printk(KERN_ERR PFX
				"unable to alloc powernow_k8_data cpumask\n");
		ret_val = -ENOMEM;
		goto err_out_mem;
	}

897
898
899
900
901
902
	return 0;

err_out_mem:
	kfree(powernow_table);

err_out:
903
	acpi_processor_unregister_performance(&data->acpi_data, data->cpu);
904

905
906
	/* data->acpi_data.state_count informs us at ->exit()
	 * whether ACPI was used */
907
	data->acpi_data.state_count = 0;
908

909
	return ret_val;
910
911
}

912
913
static int fill_powernow_table_pstate(struct powernow_k8_data *data,
		struct cpufreq_frequency_table *powernow_table)
914
915
{
	int i;
916
917
918
	u32 hi = 0, lo = 0;
	rdmsr(MSR_PSTATE_CUR_LIMIT, hi, lo);
	data->max_hw_pstate = (hi & HW_PSTATE_MAX_MASK) >> HW_PSTATE_MAX_SHIFT;
919

920
	for (i = 0; i < data->acpi_data.state_count; i++) {
921
922
		u32 index;

923
		index = data->acpi_data.states[i].control & HW_PSTATE_MASK;
924
		if (index > data->max_hw_pstate) {
925
926
927
928
929
			printk(KERN_ERR PFX "invalid pstate %d - "
					"bad value %d.\n", i, index);
			printk(KERN_ERR PFX "Please report to BIOS "
					"manufacturer\n");
			invalidate_entry(data, i);
930
			continue;
931
932
933
934
		}
		rdmsr(MSR_PSTATE_DEF_BASE + index, lo, hi);
		if (!(hi & HW_PSTATE_VALID_MASK)) {
			dprintk("invalid pstate %d, ignoring\n", index);
935
			invalidate_entry(data, i);
936
937
938
			continue;
		}

939
		powernow_table[i].index = index;
940

941
942
943
944
945
946
947
		/* Frequency may be rounded for these */
		if (boot_cpu_data.x86 == 0x10 || boot_cpu_data.x86 == 0x11) {
			powernow_table[i].frequency =
				freq_from_fid_did(lo & 0x3f, (lo >> 6) & 7);
		} else
			powernow_table[i].frequency =
				data->acpi_data.states[i].core_frequency * 1000;
948
949
950
951
	}
	return 0;
}

952
953
static int fill_powernow_table_fidvid(struct powernow_k8_data *data,
		struct cpufreq_frequency_table *powernow_table)
954
955
956
{
	int i;
	int cntlofreq = 0;
957

958
	for (i = 0; i < data->acpi_data.state_count; i++) {
959
960
		u32 fid;
		u32 vid;
961
962
		u32 freq, index;
		acpi_integer status, control;
963
964

		if (data->exttype) {
965
966
967
			status =  data->acpi_data.states[i].status;
			fid = status & EXT_FID_MASK;
			vid = (status >> VID_SHIFT) & EXT_VID_MASK;
968
		} else {
969
970
971
			control =  data->acpi_data.states[i].control;
			fid = control & FID_MASK;
			vid = (control >> VID_SHIFT) & VID_MASK;
972
		}
Linus Torvalds's avatar
Linus Torvalds committed
973
974
975

		dprintk("   %d : fid 0x%x, vid 0x%x\n", i, fid, vid);

976
977
978
979
980
		index = fid | (vid<<8);
		powernow_table[i].index = index;

		freq = find_khz_freq_from_fid(fid);
		powernow_table[i].frequency = freq;
Linus Torvalds's avatar
Linus Torvalds committed
981
982

		/* verify frequency is OK */
983
984
985
		if ((freq > (MAX_FREQ * 1000)) || (freq < (MIN_FREQ * 1000))) {
			dprintk("invalid freq %u kHz, ignoring\n", freq);
			invalidate_entry(data, i);
Linus Torvalds's avatar
Linus Torvalds committed
986
987
988
			continue;
		}

989
990
		/* verify voltage is OK -
		 * BIOSs are using "off" to indicate invalid */
991
		if (vid == VID_OFF) {
Linus Torvalds's avatar
Linus Torvalds committed
992
			dprintk("invalid vid %u, ignoring\n", vid);
993
			invalidate_entry(data, i);
Linus Torvalds's avatar
Linus Torvalds committed
994
995
996
			continue;
		}

Dave Jones's avatar
Dave Jones committed
997
998
999
		/* verify only 1 entry from the lo frequency table */
		if (fid < HI_FID_TABLE_BOTTOM) {
			if (cntlofreq) {
1000
1001
1002
1003
1004
1005
1006
				/* if both entries are the same,
				 * ignore this one ... */
				if ((freq != powernow_table[cntlofreq].frequency) ||
				    (index != powernow_table[cntlofreq].index)) {
					printk(KERN_ERR PFX
						"Too many lo freq table "
						"entries\n");
1007
					return 1;
Dave Jones's avatar
Dave Jones committed
1008
1009
				}

1010
1011
1012
				dprintk("double low frequency table entry, "
						"ignoring it.\n");
				invalidate_entry(data, i);
Dave Jones's avatar
Dave Jones committed
1013
1014
1015
				continue;
			} else
				cntlofreq = i;
Linus Torvalds's avatar
Linus Torvalds committed
1016
1017
		}

1018
1019
1020
1021
1022
1023
1024
		if (freq != (data->acpi_data.states[i].core_frequency * 1000)) {
			printk(KERN_INFO PFX "invalid freq entries "
				"%u kHz vs. %u kHz\n", freq,
				(unsigned int)
				(data->acpi_data.states[i].core_frequency
				 * 1000));
			invalidate_entry(data, i);
Linus Torvalds's avatar
Linus Torvalds committed
1025
1026
1027
1028
1029
1030
1031
1032
			continue;
		}
	}
	return 0;
}

static void powernow_k8_cpu_exit_acpi(struct powernow_k8_data *data)
{
1033
	if (data->acpi_data.state_count)
1034
1035
		acpi_processor_unregister_performance(&data->acpi_data,
				data->cpu);
1036
	free_cpumask_var(data->acpi_data.shared_cpu_map);
Linus Torvalds's avatar
Linus Torvalds committed
1037
1038
}

1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
static int get_transition_latency(struct powernow_k8_data *data)
{
	int max_latency = 0;
	int i;
	for (i = 0; i < data->acpi_data.state_count; i++) {
		int cur_latency = data->acpi_data.states[i].transition_latency
			+ data->acpi_data.states[i].bus_master_latency;
		if (cur_latency > max_latency)
			max_latency = cur_latency;
	}
	/* value in usecs, needs to be in nanoseconds */
	return 1000 * max_latency;
}

Linus Torvalds's avatar
Linus Torvalds committed
1053
/* Take a frequency, and issue the fid/vid transition command */
1054
1055
static int transition_frequency_fidvid(struct powernow_k8_data *data,
		unsigned int index)
Linus Torvalds's avatar
Linus Torvalds committed
1056
{
1057
1058
	u32 fid = 0;
	u32 vid = 0;
Dave Jones's avatar
Dave Jones committed
1059
	int res, i;
Linus Torvalds's avatar
Linus Torvalds committed
1060
1061
1062
1063
	struct cpufreq_freqs freqs;

	dprintk("cpu %d transition to index %u\n", smp_processor_id(), index);

1064
	/* fid/vid correctness check for k8 */
Linus Torvalds's avatar
Linus Torvalds committed
1065
	/* fid are the lower 8 bits of the index we stored into
1066
1067
	 * the cpufreq frequency table in find_psb_table, vid
	 * are the upper 8 bits.
Linus Torvalds's avatar
Linus Torvalds committed
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
	 */
	fid = data->powernow_table[index].index & 0xFF;
	vid = (data->powernow_table[index].index & 0xFF00) >> 8;

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

	if (query_current_values_with_pending_wait(data))
		return 1;

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

1083
1084
	if ((fid < HI_FID_TABLE_BOTTOM) &&
	    (data->currfid < HI_FID_TABLE_BOTTOM)) {
Dave Jones's avatar
Dave Jones committed
1085
1086
		printk(KERN_ERR PFX
		       "ignoring illegal change in lo freq table-%x to 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
1087
1088
1089
1090
1091
1092
1093
1094
		       data->currfid, fid);
		return 1;
	}

	dprintk("cpu %d, changing to fid 0x%x, vid 0x%x\n",
		smp_processor_id(), fid, vid);
	freqs.old = find_khz_freq_from_fid(data->currfid);
	freqs.new = find_khz_freq_from_fid(fid);
1095

1096
	for_each_cpu_mask_nr(i, *(data->available_cores)) {
Dave Jones's avatar
Dave Jones committed
1097
1098
1099
		freqs.cpu = i;
		cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
	}
Linus Torvalds's avatar
Linus Torvalds committed
1100
1101
1102

	res = transition_fid_vid(data, fid, vid);
	freqs.new = find_khz_freq_from_fid(data->currfid);
1103

1104
	for_each_cpu_mask_nr(i, *(data->available_cores)) {
1105
1106
1107
1108
1109
1110
1111
		freqs.cpu = i;
		cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
	}
	return res;
}

/* Take a frequency, and issue the hardware pstate transition command */
1112
1113
static int transition_frequency_pstate(struct powernow_k8_data *data,
		unsigned int index)
1114
1115
1116
1117
1118
1119
1120
{
	u32 pstate = 0;
	int res, i;
	struct cpufreq_freqs freqs;

	dprintk("cpu %d transition to index %u\n", smp_processor_id(), index);

1121
	/* get MSR index for hardware pstate transition */
1122
	pstate = index & HW_PSTATE_MASK;
1123
	if (pstate > data->max_hw_pstate)
1124
		return 0;
1125
1126
	freqs.old = find_khz_freq_from_pstate(data->powernow_table,
			data->currpstate);
1127
	freqs.new = find_khz_freq_from_pstate(data->powernow_table, pstate);
1128

1129
	for_each_cpu_mask_nr(i, *(data->available_cores)) {
1130
1131
1132
1133
1134
		freqs.cpu = i;
		cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
	}

	res = transition_pstate(data, pstate);
1135
	freqs.new = find_khz_freq_from_pstate(data->powernow_table, pstate);
1136

1137
	for_each_cpu_mask_nr(i, *(data->available_cores)) {
Dave Jones's avatar
Dave Jones committed
1138
1139
		freqs.cpu = i;
		cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
Dave Jones's avatar
Dave Jones committed
1140
	}
Linus Torvalds's avatar
Linus Torvalds committed
1141
1142
1143
1144
	return res;
}

/* Driver entry point to switch to the target frequency */
1145
1146
static int powernowk8_target(struct cpufreq_policy *pol,
		unsigned targfreq, unsigned relation)
Linus Torvalds's avatar
Linus Torvalds committed
1147
{
1148
	cpumask_t oldmask;
1149
	struct powernow_k8_data *data = per_cpu(powernow_data, pol->cpu);
1150
1151
	u32 checkfid;
	u32 checkvid;
Linus Torvalds's avatar
Linus Torvalds committed
1152
1153
1154
	unsigned int newstate;
	int ret = -EIO;

1155
1156
1157
	if (!data)
		return -EINVAL;

1158
1159
1160
	checkfid = data->currfid;
	checkvid = data->currvid;

Linus Torvalds's avatar
Linus Torvalds committed
1161
1162
	/* only run on specific CPU from here on */
	oldmask = current->cpus_allowed;
1163
	set_cpus_allowed_ptr(current, &cpumask_of_cpu(pol->cpu));
Linus Torvalds's avatar
Linus Torvalds committed
1164
1165

	if (smp_processor_id() != pol->cpu) {
1166
		printk(KERN_ERR PFX "limiting to cpu %u failed\n", pol->cpu);
Linus Torvalds's avatar
Linus Torvalds committed
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
		goto err_out;
	}

	if (pending_bit_stuck()) {
		printk(KERN_ERR PFX "failing targ, change pending bit set\n");
		goto err_out;
	}

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

1178
	if (query_current_values_with_pending_wait(data))
Linus Torvalds's avatar
Linus Torvalds committed
1179
1180
		goto err_out;

1181
	if (cpu_family != CPU_HW_PSTATE) {
1182
		dprintk("targ: curr fid 0x%x, vid 0x%x\n",
Linus Torvalds's avatar
Linus Torvalds committed
1183
1184
		data->currfid, data->currvid);

1185
1186
		if ((checkvid != data->currvid) ||
		    (checkfid != data->currfid)) {
1187
			printk(KERN_INFO PFX
1188
1189
1190
1191
				"error - out of sync, fix 0x%x 0x%x, "
				"vid 0x%x 0x%x\n",
				checkfid, data->currfid,
				checkvid, data->currvid);
1192
		}
Linus Torvalds's avatar
Linus Torvalds committed
1193
1194
	}

1195
1196
	if (cpufreq_frequency_table_target(pol, data->powernow_table,
				targfreq, relation, &newstate))
Linus Torvalds's avatar
Linus Torvalds committed
1197
1198
		goto err_out;

1199
	mutex_lock(&fidvid_mutex);
Dave Jones's avatar
Dave Jones committed
1200

Linus Torvalds's avatar
Linus Torvalds committed
1201
1202
	powernow_k8_acpi_pst_values(data, newstate);

1203
	if (cpu_family == CPU_HW_PSTATE)
1204
1205
1206
1207
		ret = transition_frequency_pstate(data, newstate);
	else
		ret = transition_frequency_fidvid(data, newstate);
	if (ret) {
Linus Torvalds's avatar
Linus Torvalds committed
1208
1209
		printk(KERN_ERR PFX "transition frequency failed\n");
		ret = 1;
1210
		mutex_unlock(&fidvid_mutex);
Linus Torvalds's avatar
Linus Torvalds committed
1211
1212
		goto err_out;
	}
1213
	mutex_unlock(&fidvid_mutex);
Dave Jones's avatar
Dave Jones committed
1214

1215
	if (cpu_family == CPU_HW_PSTATE)
1216
1217
		pol->cur = find_khz_freq_from_pstate(data->powernow_table,
				newstate);
1218
1219
	else
		pol->cur = find_khz_freq_from_fid(data->currfid);
Linus Torvalds's avatar
Linus Torvalds committed
1220
1221
1222
	ret = 0;

err_out:
1223
	set_cpus_allowed_ptr(current, &oldmask);
Linus Torvalds's avatar
Linus Torvalds committed
1224
1225
1226
1227
1228
1229
	return ret;
}

/* Driver entry point to verify the policy and range of frequencies */
static int powernowk8_verify(struct cpufreq_policy *pol)
{
1230
	struct powernow_k8_data *data = per_cpu(powernow_data, pol->cpu);
Linus Torvalds's avatar
Linus Torvalds committed
1231

1232
1233
1234
	if (!data)
		return -EINVAL;

Linus Torvalds's avatar
Linus Torvalds committed
1235
1236
1237
	return cpufreq_frequency_table_verify(pol, data->powernow_table);
}

1238
1239
1240
1241
static const char ACPI_PSS_BIOS_BUG_MSG[] =
	KERN_ERR FW_BUG PFX "No compatible ACPI _PSS objects found.\n"
	KERN_ERR FW_BUG PFX "Try again with latest BIOS.\n";

Linus Torvalds's avatar
Linus Torvalds committed
1242
/* per CPU init entry point to the driver */
1243
static int __cpuinit powernowk8_cpu_init(struct cpufreq_policy *pol)
Linus Torvalds's avatar
Linus Torvalds committed
1244
1245
{
	struct powernow_k8_data *data;
1246
	cpumask_t oldmask;
1247
	int rc;
Linus Torvalds's avatar
Linus Torvalds committed
1248

1249
1250
1251
	if (!cpu_online(pol->cpu))
		return -ENODEV;

Linus Torvalds's avatar
Linus Torvalds committed
1252
1253
1254
	if (!check_supported_cpu(pol->cpu))
		return -ENODEV;

1255
	data = kzalloc(sizeof(struct powernow_k8_data), GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
1256
1257
1258
1259
1260
1261
	if (!data) {
		printk(KERN_ERR PFX "unable to alloc powernow_k8_data");
		return -ENOMEM;
	}

	data->cpu = pol->cpu;
1262
	data->currpstate = HW_PSTATE_INVALID;
Linus Torvalds's avatar
Linus Torvalds committed
1263