longhaul.c 22.3 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4 5 6 7 8 9 10
/*
 *  (C) 2001-2004  Dave Jones. <davej@codemonkey.org.uk>
 *  (C) 2002  Padraig Brady. <padraig@antefacto.com>
 *
 *  Licensed under the terms of the GNU GPL License version 2.
 *  Based upon datasheets & sample CPUs kindly provided by VIA.
 *
 *  VIA have currently 3 different versions of Longhaul.
 *  Version 1 (Longhaul) uses the BCR2 MSR at 0x1147.
 *   It is present only in Samuel 1 (C5A), Samuel 2 (C5B) stepping 0.
11 12 13
 *  Version 2 of longhaul is backward compatible with v1, but adds
 *   LONGHAUL MSR for purpose of both frequency and voltage scaling.
 *   Present in Samuel 2 (steppings 1-7 only) (C5B), and Ezra (C5C).
Linus Torvalds's avatar
Linus Torvalds committed
14
 *  Version 3 of longhaul got renamed to Powersaver and redesigned
15
 *   to use only the POWERSAVER MSR at 0x110a.
Linus Torvalds's avatar
Linus Torvalds committed
16 17 18 19 20 21 22 23 24 25 26 27 28
 *   It is present in Ezra-T (C5M), Nehemiah (C5X) and above.
 *   It's pretty much the same feature wise to longhaul v2, though
 *   there is provision for scaling FSB too, but this doesn't work
 *   too well in practice so we don't even try to use this.
 *
 *  BIG FAT DISCLAIMER: Work in progress code. Possibly *dangerous*
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
#include <linux/cpufreq.h>
29
#include <linux/pci.h>
Linus Torvalds's avatar
Linus Torvalds committed
30 31 32 33 34 35
#include <linux/slab.h>
#include <linux/string.h>

#include <asm/msr.h>
#include <asm/timex.h>
#include <asm/io.h>
36 37 38
#include <asm/acpi.h>
#include <linux/acpi.h>
#include <acpi/processor.h>
Linus Torvalds's avatar
Linus Torvalds committed
39 40 41 42 43 44 45 46 47 48 49 50 51 52

#include "longhaul.h"

#define PFX "longhaul: "

#define TYPE_LONGHAUL_V1	1
#define TYPE_LONGHAUL_V2	2
#define TYPE_POWERSAVER		3

#define	CPU_SAMUEL	1
#define	CPU_SAMUEL2	2
#define	CPU_EZRA	3
#define	CPU_EZRA_T	4
#define	CPU_NEHEMIAH	5
53
#define	CPU_NEHEMIAH_C	6
Linus Torvalds's avatar
Linus Torvalds committed
54

55 56 57 58
/* Flags */
#define USE_ACPI_C3		(1 << 1)
#define USE_NORTHBRIDGE		(1 << 2)

Linus Torvalds's avatar
Linus Torvalds committed
59
static int cpu_model;
60
static unsigned int numscales=16;
Linus Torvalds's avatar
Linus Torvalds committed
61
static unsigned int fsb;
62

63 64
static const struct mV_pos *vrm_mV_table;
static const unsigned char *mV_vrm_table;
65
struct f_msr {
66 67
	u8 vrm;
	u8 pos;
68 69 70 71
};
static struct f_msr f_msr_table[32];

static unsigned int highest_speed, lowest_speed; /* kHz */
Linus Torvalds's avatar
Linus Torvalds committed
72 73
static unsigned int minmult, maxmult;
static int can_scale_voltage;
74 75
static struct acpi_processor *pr = NULL;
static struct acpi_processor_cx *cx = NULL;
76
static u8 longhaul_flags;
77
static u8 longhaul_pos;
Linus Torvalds's avatar
Linus Torvalds committed
78 79

/* Module parameters */
80
static int scale_voltage;
Linus Torvalds's avatar
Linus Torvalds committed
81 82 83 84 85 86 87 88 89

#define dprintk(msg...) cpufreq_debug_printk(CPUFREQ_DEBUG_DRIVER, "longhaul", msg)


/* Clock ratios multiplied by 10 */
static int clock_ratio[32];
static int eblcr_table[32];
static int longhaul_version;
static struct cpufreq_frequency_table *longhaul_table;
90
static unsigned int old_ratio = -1;
Linus Torvalds's avatar
Linus Torvalds committed
91 92 93 94 95 96

#ifdef CONFIG_CPU_FREQ_DEBUG
static char speedbuffer[8];

static char *print_speed(int speed)
{
97 98 99 100 101 102 103 104 105 106 107
	if (speed < 1000) {
		snprintf(speedbuffer, sizeof(speedbuffer),"%dMHz", speed);
		return speedbuffer;
	}

	if (speed%1000 == 0)
		snprintf(speedbuffer, sizeof(speedbuffer),
			"%dGHz", speed/1000);
	else
		snprintf(speedbuffer, sizeof(speedbuffer),
			"%d.%dGHz", speed/1000, (speed%1000)/100);
Linus Torvalds's avatar
Linus Torvalds committed
108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137

	return speedbuffer;
}
#endif


static unsigned int calc_speed(int mult)
{
	int khz;
	khz = (mult/10)*fsb;
	if (mult%10)
		khz += fsb/2;
	khz *= 1000;
	return khz;
}


static int longhaul_get_cpu_mult(void)
{
	unsigned long invalue=0,lo, hi;

	rdmsr (MSR_IA32_EBL_CR_POWERON, lo, hi);
	invalue = (lo & (1<<22|1<<23|1<<24|1<<25)) >>22;
	if (longhaul_version==TYPE_LONGHAUL_V2 || longhaul_version==TYPE_POWERSAVER) {
		if (lo & (1<<27))
			invalue+=16;
	}
	return eblcr_table[invalue];
}

138
/* For processor with BCR2 MSR */
Linus Torvalds's avatar
Linus Torvalds committed
139

140
static void do_longhaul1(unsigned int clock_ratio_index)
Linus Torvalds's avatar
Linus Torvalds committed
141
{
142
	union msr_bcr2 bcr2;
Linus Torvalds's avatar
Linus Torvalds committed
143

144 145 146 147
	rdmsrl(MSR_VIA_BCR2, bcr2.val);
	/* Enable software clock multiplier */
	bcr2.bits.ESOFTBF = 1;
	bcr2.bits.CLOCKMUL = clock_ratio_index;
Linus Torvalds's avatar
Linus Torvalds committed
148

149 150 151 152
	/* Sync to timer tick */
	safe_halt();
	/* Change frequency on next halt or sleep */
	wrmsrl(MSR_VIA_BCR2, bcr2.val);
153 154 155
	/* Invoke transition */
	ACPI_FLUSH_CPU_CACHE();
	halt();
156 157 158 159 160 161 162

	/* Disable software clock multiplier */
	local_irq_disable();
	rdmsrl(MSR_VIA_BCR2, bcr2.val);
	bcr2.bits.ESOFTBF = 0;
	wrmsrl(MSR_VIA_BCR2, bcr2.val);
}
163

164
/* For processor with Longhaul MSR */
165

166 167 168
static void do_powersaver(int cx_address, unsigned int clock_ratio_index)
{
	union msr_longhaul longhaul;
169
	u8 dest_pos;
170
	u32 t;
171

172 173
	dest_pos = f_msr_table[clock_ratio_index].pos;

174
	rdmsrl(MSR_VIA_LONGHAUL, longhaul.val);
175
	/* Setup new frequency */
176 177 178
	longhaul.bits.RevisionKey = longhaul.bits.RevisionID;
	longhaul.bits.SoftBusRatio = clock_ratio_index & 0xf;
	longhaul.bits.SoftBusRatio4 = (clock_ratio_index & 0x10) >> 4;
179 180
	/* Setup new voltage */
	if (can_scale_voltage)
181
		longhaul.bits.SoftVID = f_msr_table[clock_ratio_index].vrm;
182 183 184 185
	/* Sync to timer tick */
	safe_halt();
	/* Raise voltage if necessary */
	if (can_scale_voltage && longhaul_pos < dest_pos) {
186
		longhaul.bits.EnableSoftVID = 1;
187 188 189 190 191 192 193 194 195 196 197
		wrmsrl(MSR_VIA_LONGHAUL, longhaul.val);
		/* Change voltage */
		if (!cx_address) {
			ACPI_FLUSH_CPU_CACHE();
			halt();
		} else {
			ACPI_FLUSH_CPU_CACHE();
			/* Invoke C3 */
			inb(cx_address);
			/* Dummy op - must do something useless after P_LVL3
			 * read */
198
			t = inl(acpi_gbl_FADT.xpm_timer_block.address);
199 200 201 202
		}
		longhaul.bits.EnableSoftVID = 0;
		wrmsrl(MSR_VIA_LONGHAUL, longhaul.val);
		longhaul_pos = dest_pos;
203 204
	}

205
	/* Change frequency on next halt or sleep */
206
	longhaul.bits.EnableSoftBusRatio = 1;
207
	wrmsrl(MSR_VIA_LONGHAUL, longhaul.val);
208
	if (!cx_address) {
209 210 211 212 213 214 215
		ACPI_FLUSH_CPU_CACHE();
		halt();
	} else {
		ACPI_FLUSH_CPU_CACHE();
		/* Invoke C3 */
		inb(cx_address);
		/* Dummy op - must do something useless after P_LVL3 read */
216
		t = inl(acpi_gbl_FADT.xpm_timer_block.address);
217
	}
218 219 220
	/* Disable bus ratio bit */
	longhaul.bits.EnableSoftBusRatio = 0;
	wrmsrl(MSR_VIA_LONGHAUL, longhaul.val);
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235

	/* Reduce voltage if necessary */
	if (can_scale_voltage && longhaul_pos > dest_pos) {
		longhaul.bits.EnableSoftVID = 1;
		wrmsrl(MSR_VIA_LONGHAUL, longhaul.val);
		/* Change voltage */
		if (!cx_address) {
			ACPI_FLUSH_CPU_CACHE();
			halt();
		} else {
			ACPI_FLUSH_CPU_CACHE();
			/* Invoke C3 */
			inb(cx_address);
			/* Dummy op - must do something useless after P_LVL3
			 * read */
236
			t = inl(acpi_gbl_FADT.xpm_timer_block.address);
237 238 239 240 241
		}
		longhaul.bits.EnableSoftVID = 0;
		wrmsrl(MSR_VIA_LONGHAUL, longhaul.val);
		longhaul_pos = dest_pos;
	}
Linus Torvalds's avatar
Linus Torvalds committed
242 243 244 245 246 247 248 249 250 251 252 253 254
}

/**
 * longhaul_set_cpu_frequency()
 * @clock_ratio_index : bitpattern of the new multiplier.
 *
 * Sets a new clock ratio.
 */

static void longhaul_setstate(unsigned int clock_ratio_index)
{
	int speed, mult;
	struct cpufreq_freqs freqs;
255 256
	unsigned long flags;
	unsigned int pic1_mask, pic2_mask;
257 258
	u32 bm_status = 0;
	u32 bm_timeout = 100000;
Linus Torvalds's avatar
Linus Torvalds committed
259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280

	if (old_ratio == clock_ratio_index)
		return;
	old_ratio = clock_ratio_index;

	mult = clock_ratio[clock_ratio_index];
	if (mult == -1)
		return;

	speed = calc_speed(mult);
	if ((speed > highest_speed) || (speed < lowest_speed))
		return;

	freqs.old = calc_speed(longhaul_get_cpu_mult());
	freqs.new = speed;
	freqs.cpu = 0; /* longhaul.c is UP only driver */

	cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);

	dprintk ("Setting to FSB:%dMHz Mult:%d.%dx (%s)\n",
			fsb, mult/10, mult%10, print_speed(speed/1000));

281 282 283 284 285 286 287 288
	preempt_disable();
	local_irq_save(flags);

	pic2_mask = inb(0xA1);
	pic1_mask = inb(0x21);	/* works on C3. save mask. */
	outb(0xFF,0xA1);	/* Overkill */
	outb(0xFE,0x21);	/* TMR0 only */

289 290 291 292 293 294 295 296 297 298 299 300
	/* Wait while PCI bus is busy. */
	if (longhaul_flags & USE_NORTHBRIDGE
	    || ((pr != NULL) && pr->flags.bm_control)) {
		acpi_get_register(ACPI_BITREG_BUS_MASTER_STATUS, &bm_status);
		while (bm_status && bm_timeout) {
			acpi_set_register(ACPI_BITREG_BUS_MASTER_STATUS, 1);
			bm_timeout--;
			acpi_get_register(ACPI_BITREG_BUS_MASTER_STATUS,
					  &bm_status);
		}
	}

301 302 303 304
	if (longhaul_flags & USE_NORTHBRIDGE) {
		/* Disable AGP and PCI arbiters */
		outb(3, 0x22);
	} else if ((pr != NULL) && pr->flags.bm_control) {
305
 		/* Disable bus master arbitration */
306
		acpi_set_register(ACPI_BITREG_ARB_DISABLE, 1);
307
	}
Linus Torvalds's avatar
Linus Torvalds committed
308 309 310 311 312 313 314
	switch (longhaul_version) {

	/*
	 * Longhaul v1. (Samuel[C5A] and Samuel2 stepping 0[C5B])
	 * Software controlled multipliers only.
	 */
	case TYPE_LONGHAUL_V1:
315
		do_longhaul1(clock_ratio_index);
Linus Torvalds's avatar
Linus Torvalds committed
316 317 318
		break;

	/*
319 320
	 * Longhaul v2 appears in Samuel2 Steppings 1->7 [C5B] and Ezra [C5C]
	 *
Linus Torvalds's avatar
Linus Torvalds committed
321 322 323 324
	 * Longhaul v3 (aka Powersaver). (Ezra-T [C5M] & Nehemiah [C5N])
	 * Nehemiah can do FSB scaling too, but this has never been proven
	 * to work in practice.
	 */
325
	case TYPE_LONGHAUL_V2:
Linus Torvalds's avatar
Linus Torvalds committed
326
	case TYPE_POWERSAVER:
327 328
		if (longhaul_flags & USE_ACPI_C3) {
			/* Don't allow wakeup */
329
			acpi_set_register(ACPI_BITREG_BUS_MASTER_RLD, 0);
330 331 332 333
			do_powersaver(cx->address, clock_ratio_index);
		} else {
			do_powersaver(0, clock_ratio_index);
		}
Linus Torvalds's avatar
Linus Torvalds committed
334 335 336
		break;
	}

337 338 339 340
	if (longhaul_flags & USE_NORTHBRIDGE) {
		/* Enable arbiters */
		outb(0, 0x22);
	} else if ((pr != NULL) && pr->flags.bm_control) {
341
		/* Enable bus master arbitration */
342
		acpi_set_register(ACPI_BITREG_ARB_DISABLE, 0);
343 344 345 346 347 348 349
	}
	outb(pic2_mask,0xA1);	/* restore mask */
	outb(pic1_mask,0x21);

	local_irq_restore(flags);
	preempt_enable();

350
	freqs.new = calc_speed(longhaul_get_cpu_mult());
Linus Torvalds's avatar
Linus Torvalds committed
351
	cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
352 353 354 355

	if (!bm_timeout)
		printk(KERN_INFO PFX "Warning: Timeout while waiting for "
			"idle PCI bus.\n");
Linus Torvalds's avatar
Linus Torvalds committed
356 357 358 359 360 361 362 363 364 365 366 367 368
}

/*
 * Centaur decided to make life a little more tricky.
 * Only longhaul v1 is allowed to read EBLCR BSEL[0:1].
 * Samuel2 and above have to try and guess what the FSB is.
 * We do this by assuming we booted at maximum multiplier, and interpolate
 * between that value multiplied by possible FSBs and cpu_mhz which
 * was calculated at boot time. Really ugly, but no other way to do this.
 */

#define ROUNDING	0xf

369
static int guess_fsb(int mult)
Linus Torvalds's avatar
Linus Torvalds committed
370
{
371
	int speed = cpu_khz / 1000;
Linus Torvalds's avatar
Linus Torvalds committed
372
	int i;
373 374 375 376 377 378 379 380 381
	int speeds[] = { 666, 1000, 1333, 2000 };
	int f_max, f_min;

	for (i = 0; i < 4; i++) {
		f_max = ((speeds[i] * mult) + 50) / 100;
		f_max += (ROUNDING / 2);
		f_min = f_max - ROUNDING;
		if ((speed <= f_max) && (speed >= f_min))
			return speeds[i] / 10;
Linus Torvalds's avatar
Linus Torvalds committed
382 383 384 385 386 387 388 389
	}
	return 0;
}


static int __init longhaul_get_ranges(void)
{
	unsigned int j, k = 0;
390
	int mult;
Linus Torvalds's avatar
Linus Torvalds committed
391

392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
	/* Get current frequency */
	mult = longhaul_get_cpu_mult();
	if (mult == -1) {
		printk(KERN_INFO PFX "Invalid (reserved) multiplier!\n");
		return -EINVAL;
	}
	fsb = guess_fsb(mult);
	if (fsb == 0) {
		printk(KERN_INFO PFX "Invalid (reserved) FSB!\n");
		return -EINVAL;
	}
	/* Get max multiplier - as we always did.
	 * Longhaul MSR is usefull only when voltage scaling is enabled.
	 * C3 is booting at max anyway. */
	maxmult = mult;
	/* Get min multiplier */
408 409 410
	switch (cpu_model) {
	case CPU_NEHEMIAH:
		minmult = 50;
Linus Torvalds's avatar
Linus Torvalds committed
411
		break;
412 413 414 415 416
	case CPU_NEHEMIAH_C:
		minmult = 40;
		break;
	default:
		minmult = 30;
417
		break;
Linus Torvalds's avatar
Linus Torvalds committed
418 419 420 421 422 423 424 425
	}

	dprintk ("MinMult:%d.%dx MaxMult:%d.%dx\n",
		 minmult/10, minmult%10, maxmult/10, maxmult%10);

	highest_speed = calc_speed(maxmult);
	lowest_speed = calc_speed(minmult);
	dprintk ("FSB:%dMHz  Lowest speed: %s   Highest speed:%s\n", fsb,
426
		 print_speed(lowest_speed/1000),
Linus Torvalds's avatar
Linus Torvalds committed
427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467
		 print_speed(highest_speed/1000));

	if (lowest_speed == highest_speed) {
		printk (KERN_INFO PFX "highestspeed == lowest, aborting.\n");
		return -EINVAL;
	}
	if (lowest_speed > highest_speed) {
		printk (KERN_INFO PFX "nonsense! lowest (%d > %d) !\n",
			lowest_speed, highest_speed);
		return -EINVAL;
	}

	longhaul_table = kmalloc((numscales + 1) * sizeof(struct cpufreq_frequency_table), GFP_KERNEL);
	if(!longhaul_table)
		return -ENOMEM;

	for (j=0; j < numscales; j++) {
		unsigned int ratio;
		ratio = clock_ratio[j];
		if (ratio == -1)
			continue;
		if (ratio > maxmult || ratio < minmult)
			continue;
		longhaul_table[k].frequency = calc_speed(ratio);
		longhaul_table[k].index	= j;
		k++;
	}

	longhaul_table[k].frequency = CPUFREQ_TABLE_END;
	if (!k) {
		kfree (longhaul_table);
		return -EINVAL;
	}

	return 0;
}


static void __init longhaul_setup_voltagescaling(void)
{
	union msr_longhaul longhaul;
468 469
	struct mV_pos minvid, maxvid;
	unsigned int j, speed, pos, kHz_step, numvscales;
470
	int min_vid_speed;
Linus Torvalds's avatar
Linus Torvalds committed
471

472 473 474
	rdmsrl(MSR_VIA_LONGHAUL, longhaul.val);
	if (!(longhaul.bits.RevisionID & 1)) {
		printk(KERN_INFO PFX "Voltage scaling not supported by CPU.\n");
Linus Torvalds's avatar
Linus Torvalds committed
475
		return;
476 477 478 479 480 481 482 483
	}

	if (!longhaul.bits.VRMRev) {
		printk (KERN_INFO PFX "VRM 8.5\n");
		vrm_mV_table = &vrm85_mV[0];
		mV_vrm_table = &mV_vrm85[0];
	} else {
		printk (KERN_INFO PFX "Mobile VRM\n");
484 485
		if (cpu_model < CPU_NEHEMIAH)
			return;
486 487 488
		vrm_mV_table = &mobilevrm_mV[0];
		mV_vrm_table = &mV_mobilevrm[0];
	}
Linus Torvalds's avatar
Linus Torvalds committed
489

490 491
	minvid = vrm_mV_table[longhaul.bits.MinimumVID];
	maxvid = vrm_mV_table[longhaul.bits.MaximumVID];
Linus Torvalds's avatar
Linus Torvalds committed
492

493
	if (minvid.mV == 0 || maxvid.mV == 0 || minvid.mV > maxvid.mV) {
Linus Torvalds's avatar
Linus Torvalds committed
494 495
		printk (KERN_INFO PFX "Bogus values Min:%d.%03d Max:%d.%03d. "
					"Voltage scaling disabled.\n",
496
					minvid.mV/1000, minvid.mV%1000, maxvid.mV/1000, maxvid.mV%1000);
Linus Torvalds's avatar
Linus Torvalds committed
497 498 499
		return;
	}

500
	if (minvid.mV == maxvid.mV) {
Linus Torvalds's avatar
Linus Torvalds committed
501 502
		printk (KERN_INFO PFX "Claims to support voltage scaling but min & max are "
				"both %d.%03d. Voltage scaling disabled\n",
503
				maxvid.mV/1000, maxvid.mV%1000);
Linus Torvalds's avatar
Linus Torvalds committed
504 505 506
		return;
	}

507 508 509 510 511 512
	/* How many voltage steps */
	numvscales = maxvid.pos - minvid.pos + 1;
	printk(KERN_INFO PFX
		"Max VID=%d.%03d  "
		"Min VID=%d.%03d, "
		"%d possible voltage scales\n",
513 514 515
		maxvid.mV/1000, maxvid.mV%1000,
		minvid.mV/1000, minvid.mV%1000,
		numvscales);
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542

	/* Calculate max frequency at min voltage */
	j = longhaul.bits.MinMHzBR;
	if (longhaul.bits.MinMHzBR4)
		j += 16;
	min_vid_speed = eblcr_table[j];
	if (min_vid_speed == -1)
		return;
	switch (longhaul.bits.MinMHzFSB) {
	case 0:
		min_vid_speed *= 13333;
		break;
	case 1:
		min_vid_speed *= 10000;
		break;
	case 3:
		min_vid_speed *= 6666;
		break;
	default:
		return;
		break;
	}
	if (min_vid_speed >= highest_speed)
		return;
	/* Calculate kHz for one voltage step */
	kHz_step = (highest_speed - min_vid_speed) / numvscales;

543

544 545 546
	j = 0;
	while (longhaul_table[j].frequency != CPUFREQ_TABLE_END) {
		speed = longhaul_table[j].frequency;
547 548 549 550
		if (speed > min_vid_speed)
			pos = (speed - min_vid_speed) / kHz_step + minvid.pos;
		else
			pos = minvid.pos;
551
		f_msr_table[longhaul_table[j].index].vrm = mV_vrm_table[pos];
552
		f_msr_table[longhaul_table[j].index].pos = pos;
553
		j++;
Linus Torvalds's avatar
Linus Torvalds committed
554 555
	}

556
	longhaul_pos = maxvid.pos;
Linus Torvalds's avatar
Linus Torvalds committed
557
	can_scale_voltage = 1;
558 559
	printk(KERN_INFO PFX "Voltage scaling enabled. "
		"Use of \"conservative\" governor is highly recommended.\n");
Linus Torvalds's avatar
Linus Torvalds committed
560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592
}


static int longhaul_verify(struct cpufreq_policy *policy)
{
	return cpufreq_frequency_table_verify(policy, longhaul_table);
}


static int longhaul_target(struct cpufreq_policy *policy,
			    unsigned int target_freq, unsigned int relation)
{
	unsigned int table_index = 0;
	unsigned int new_clock_ratio = 0;

	if (cpufreq_frequency_table_target(policy, longhaul_table, target_freq, relation, &table_index))
		return -EINVAL;

	new_clock_ratio = longhaul_table[table_index].index & 0xFF;

	longhaul_setstate(new_clock_ratio);

	return 0;
}


static unsigned int longhaul_get(unsigned int cpu)
{
	if (cpu)
		return 0;
	return calc_speed(longhaul_get_cpu_mult());
}

593 594 595
static acpi_status longhaul_walk_callback(acpi_handle obj_handle,
					  u32 nesting_level,
					  void *context, void **return_value)
596 597 598 599 600 601 602 603 604
{
	struct acpi_device *d;

	if ( acpi_bus_get_device(obj_handle, &d) ) {
		return 0;
	}
	*return_value = (void *)acpi_driver_data(d);
	return 1;
}
Linus Torvalds's avatar
Linus Torvalds committed
605

606 607 608 609
/* VIA don't support PM2 reg, but have something similar */
static int enable_arbiter_disable(void)
{
	struct pci_dev *dev;
610
	int status;
611
	int reg;
612 613
	u8 pci_cmd;

614
	status = 1;
615
	/* Find PLE133 host bridge */
616
	reg = 0x78;
617 618
	dev = pci_get_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8601_0,
			     NULL);
619 620 621
	/* Find CLE266 host bridge */
	if (dev == NULL) {
		reg = 0x76;
622 623
		dev = pci_get_device(PCI_VENDOR_ID_VIA,
				     PCI_DEVICE_ID_VIA_862X_0, NULL);
624 625
		/* Find CN400 V-Link host bridge */
		if (dev == NULL)
626
			dev = pci_get_device(PCI_VENDOR_ID_VIA, 0x7259, NULL);
627
	}
628 629
	if (dev != NULL) {
		/* Enable access to port 0x22 */
630
		pci_read_config_byte(dev, reg, &pci_cmd);
631
		if (!(pci_cmd & 1<<7)) {
632
			pci_cmd |= 1<<7;
633
			pci_write_config_byte(dev, reg, pci_cmd);
634 635 636 637
			pci_read_config_byte(dev, reg, &pci_cmd);
			if (!(pci_cmd & 1<<7)) {
				printk(KERN_ERR PFX
					"Can't enable access to port 0x22.\n");
638
				status = 0;
639
			}
640
		}
641 642
		pci_dev_put(dev);
		return status;
643 644 645 646
	}
	return 0;
}

647
static int longhaul_setup_southbridge(void)
648 649 650 651 652
{
	struct pci_dev *dev;
	u8 pci_cmd;

	/* Find VT8235 southbridge */
653
	dev = pci_get_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8235, NULL);
654 655 656 657
	if (dev == NULL)
	/* Find VT8237 southbridge */
		dev = pci_get_device(PCI_VENDOR_ID_VIA,
				     PCI_DEVICE_ID_VIA_8237, NULL);
658 659 660 661 662 663 664 665 666 667 668
	if (dev != NULL) {
		/* Set transition time to max */
		pci_read_config_byte(dev, 0xec, &pci_cmd);
		pci_cmd &= ~(1 << 2);
		pci_write_config_byte(dev, 0xec, pci_cmd);
		pci_read_config_byte(dev, 0xe4, &pci_cmd);
		pci_cmd &= ~(1 << 7);
		pci_write_config_byte(dev, 0xe4, pci_cmd);
		pci_read_config_byte(dev, 0xe5, &pci_cmd);
		pci_cmd |= 1 << 7;
		pci_write_config_byte(dev, 0xe5, pci_cmd);
669
		pci_dev_put(dev);
670 671 672 673 674
		return 1;
	}
	return 0;
}

Linus Torvalds's avatar
Linus Torvalds committed
675 676 677 678 679
static int __init longhaul_cpu_init(struct cpufreq_policy *policy)
{
	struct cpuinfo_x86 *c = cpu_data;
	char *cpuname=NULL;
	int ret;
680
	u32 lo, hi;
Linus Torvalds's avatar
Linus Torvalds committed
681

682
	/* Check what we have on this motherboard */
Linus Torvalds's avatar
Linus Torvalds committed
683 684 685 686 687 688 689 690 691 692 693 694
	switch (c->x86_model) {
	case 6:
		cpu_model = CPU_SAMUEL;
		cpuname = "C3 'Samuel' [C5A]";
		longhaul_version = TYPE_LONGHAUL_V1;
		memcpy (clock_ratio, samuel1_clock_ratio, sizeof(samuel1_clock_ratio));
		memcpy (eblcr_table, samuel1_eblcr, sizeof(samuel1_eblcr));
		break;

	case 7:
		switch (c->x86_mask) {
		case 0:
695
			longhaul_version = TYPE_LONGHAUL_V1;
Linus Torvalds's avatar
Linus Torvalds committed
696 697
			cpu_model = CPU_SAMUEL2;
			cpuname = "C3 'Samuel 2' [C5B]";
698 699 700 701 702 703
			/* Note, this is not a typo, early Samuel2's had
			 * Samuel1 ratios. */
			memcpy(clock_ratio, samuel1_clock_ratio,
				sizeof(samuel1_clock_ratio));
			memcpy(eblcr_table, samuel2_eblcr,
				sizeof(samuel2_eblcr));
Linus Torvalds's avatar
Linus Torvalds committed
704 705
			break;
		case 1 ... 15:
706
			longhaul_version = TYPE_LONGHAUL_V1;
Linus Torvalds's avatar
Linus Torvalds committed
707 708 709 710 711 712 713
			if (c->x86_mask < 8) {
				cpu_model = CPU_SAMUEL2;
				cpuname = "C3 'Samuel 2' [C5B]";
			} else {
				cpu_model = CPU_EZRA;
				cpuname = "C3 'Ezra' [C5C]";
			}
714 715 716 717
			memcpy(clock_ratio, ezra_clock_ratio,
				sizeof(ezra_clock_ratio));
			memcpy(eblcr_table, ezra_eblcr,
				sizeof(ezra_eblcr));
Linus Torvalds's avatar
Linus Torvalds committed
718 719 720 721 722 723 724 725 726 727 728 729 730 731 732
			break;
		}
		break;

	case 8:
		cpu_model = CPU_EZRA_T;
		cpuname = "C3 'Ezra-T' [C5M]";
		longhaul_version = TYPE_POWERSAVER;
		numscales=32;
		memcpy (clock_ratio, ezrat_clock_ratio, sizeof(ezrat_clock_ratio));
		memcpy (eblcr_table, ezrat_eblcr, sizeof(ezrat_eblcr));
		break;

	case 9:
		longhaul_version = TYPE_POWERSAVER;
733 734 735 736 737
		numscales = 32;
		memcpy(clock_ratio,
		       nehemiah_clock_ratio,
		       sizeof(nehemiah_clock_ratio));
		memcpy(eblcr_table, nehemiah_eblcr, sizeof(nehemiah_eblcr));
Linus Torvalds's avatar
Linus Torvalds committed
738 739
		switch (c->x86_mask) {
		case 0 ... 1:
740
			cpu_model = CPU_NEHEMIAH;
741
			cpuname = "C3 'Nehemiah A' [C5XLOE]";
Linus Torvalds's avatar
Linus Torvalds committed
742 743
			break;
		case 2 ... 4:
744
			cpu_model = CPU_NEHEMIAH;
745
			cpuname = "C3 'Nehemiah B' [C5XLOH]";
Linus Torvalds's avatar
Linus Torvalds committed
746 747
			break;
		case 5 ... 15:
748
			cpu_model = CPU_NEHEMIAH_C;
749
			cpuname = "C3 'Nehemiah C' [C5P]";
Linus Torvalds's avatar
Linus Torvalds committed
750 751 752 753 754 755 756 757
			break;
		}
		break;

	default:
		cpuname = "Unknown";
		break;
	}
758 759 760 761 762 763 764
	/* Check Longhaul ver. 2 */
	if (longhaul_version == TYPE_LONGHAUL_V2) {
		rdmsr(MSR_VIA_LONGHAUL, lo, hi);
		if (lo == 0 && hi == 0)
			/* Looks like MSR isn't present */
			longhaul_version = TYPE_LONGHAUL_V1;
	}
Linus Torvalds's avatar
Linus Torvalds committed
765 766 767 768 769 770 771 772 773 774 775 776

	printk (KERN_INFO PFX "VIA %s CPU detected.  ", cpuname);
	switch (longhaul_version) {
	case TYPE_LONGHAUL_V1:
	case TYPE_LONGHAUL_V2:
		printk ("Longhaul v%d supported.\n", longhaul_version);
		break;
	case TYPE_POWERSAVER:
		printk ("Powersaver supported.\n");
		break;
	};

777
	/* Doesn't hurt */
778
	longhaul_setup_southbridge();
779

780
	/* Find ACPI data for processor */
781 782 783
	acpi_walk_namespace(ACPI_TYPE_PROCESSOR, ACPI_ROOT_OBJECT,
				ACPI_UINT32_MAX, &longhaul_walk_callback,
				NULL, (void *)&pr);
784

785
	/* Check ACPI support for C3 state */
786
	if (pr != NULL && longhaul_version == TYPE_POWERSAVER) {
787
		cx = &pr->power.states[ACPI_STATE_C3];
788
		if (cx->address > 0 && cx->latency <= 1000)
789
			longhaul_flags |= USE_ACPI_C3;
790
	}
791
	/* Check if northbridge is friendly */
792
	if (enable_arbiter_disable())
793
		longhaul_flags |= USE_NORTHBRIDGE;
794

795
	/* Check ACPI support for bus master arbiter disable */
796 797 798
	if (!(longhaul_flags & USE_ACPI_C3
	     || longhaul_flags & USE_NORTHBRIDGE)
	    && ((pr == NULL) || !(pr->flags.bm_control))) {
799 800 801
		printk(KERN_ERR PFX
			"No ACPI support. Unsupported northbridge.\n");
		return -ENODEV;
802
	}
803

804
	if (longhaul_flags & USE_NORTHBRIDGE)
805 806 807
		printk(KERN_INFO PFX "Using northbridge support.\n");
	if (longhaul_flags & USE_ACPI_C3)
		printk(KERN_INFO PFX "Using ACPI support.\n");
808

Linus Torvalds's avatar
Linus Torvalds committed
809 810 811 812
	ret = longhaul_get_ranges();
	if (ret != 0)
		return ret;

813
	if ((longhaul_version != TYPE_LONGHAUL_V1) && (scale_voltage != 0))
Linus Torvalds's avatar
Linus Torvalds committed
814 815 816
		longhaul_setup_voltagescaling();

	policy->governor = CPUFREQ_DEFAULT_GOVERNOR;
817
	policy->cpuinfo.transition_latency = 200000;	/* nsec */
Linus Torvalds's avatar
Linus Torvalds committed
818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839
	policy->cur = calc_speed(longhaul_get_cpu_mult());

	ret = cpufreq_frequency_table_cpuinfo(policy, longhaul_table);
	if (ret)
		return ret;

	cpufreq_frequency_table_get_attr(longhaul_table, policy->cpu);

	return 0;
}

static int __devexit longhaul_cpu_exit(struct cpufreq_policy *policy)
{
	cpufreq_frequency_table_put_attr(policy->cpu);
	return 0;
}

static struct freq_attr* longhaul_attr[] = {
	&cpufreq_freq_attr_scaling_available_freqs,
	NULL,
};

840
static struct cpufreq_driver longhaul_driver = {
Linus Torvalds's avatar
Linus Torvalds committed
841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
	.verify	= longhaul_verify,
	.target	= longhaul_target,
	.get	= longhaul_get,
	.init	= longhaul_cpu_init,
	.exit	= __devexit_p(longhaul_cpu_exit),
	.name	= "longhaul",
	.owner	= THIS_MODULE,
	.attr	= longhaul_attr,
};


static int __init longhaul_init(void)
{
	struct cpuinfo_x86 *c = cpu_data;

	if (c->x86_vendor != X86_VENDOR_CENTAUR || c->x86 != 6)
		return -ENODEV;

859 860 861
#ifdef CONFIG_SMP
	if (num_online_cpus() > 1) {
		printk(KERN_ERR PFX "More than 1 CPU detected, longhaul disabled.\n");
862
		return -ENODEV;
863 864 865 866 867 868 869 870
	}
#endif
#ifdef CONFIG_X86_IO_APIC
	if (cpu_has_apic) {
		printk(KERN_ERR PFX "APIC detected. Longhaul is currently broken in this configuration.\n");
		return -ENODEV;
	}
#endif
Linus Torvalds's avatar
Linus Torvalds committed
871 872 873
	switch (c->x86_model) {
	case 6 ... 9:
		return cpufreq_register_driver(&longhaul_driver);
874 875
	case 10:
		printk(KERN_ERR PFX "Use acpi-cpufreq driver for VIA C7\n");
Linus Torvalds's avatar
Linus Torvalds committed
876
	default:
Dave Jones's avatar
Dave Jones committed
877
		;;
Linus Torvalds's avatar
Linus Torvalds committed
878 879 880 881 882 883 884 885
	}

	return -ENODEV;
}


static void __exit longhaul_exit(void)
{
886
	int i;
Linus Torvalds's avatar
Linus Torvalds committed
887 888 889 890 891 892 893 894 895 896 897 898

	for (i=0; i < numscales; i++) {
		if (clock_ratio[i] == maxmult) {
			longhaul_setstate(i);
			break;
		}
	}

	cpufreq_unregister_driver(&longhaul_driver);
	kfree(longhaul_table);
}

899 900
module_param (scale_voltage, int, 0644);
MODULE_PARM_DESC(scale_voltage, "Scale voltage of processor");
Linus Torvalds's avatar
Linus Torvalds committed
901 902 903 904 905

MODULE_AUTHOR ("Dave Jones <davej@codemonkey.org.uk>");
MODULE_DESCRIPTION ("Longhaul driver for VIA Cyrix processors.");
MODULE_LICENSE ("GPL");

906
late_initcall(longhaul_init);
Linus Torvalds's avatar
Linus Torvalds committed
907
module_exit(longhaul_exit);