/*	$OpenBSD: powernow.c,v 1.3 2006/12/12 23:14:27 dim Exp $	*/
/*
 * Copyright (c) 2004 Ted Unangst
 * All rights reserved.
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

/*
 * AMD K6 PowerNow driver, see AMD tech doc #23525
 * Numerous hints from Linux cpufreq driver
 */

#include <sys/param.h>
#include <sys/sysctl.h>

#include <machine/cpu.h>
#include <machine/cpufunc.h>
#include <machine/specialreg.h>
#include <machine/pio.h>

/* table 27 in amd 23535.  entries after 45 taken from linux cpufreq */
struct {
	int mult;	/* not actually used, maybe for cpuspeed */
	int magic;
} k6_multipliers[] = {
	{ 20, 4 },
	{ 30, 5 },
	{ 35, 7 },
	{ 40, 2 },
	{ 45, 0 },
	{ 55, 3 },
	{ 50, 1 },
	{ 60, 6 },
};
#define NUM_K6_ENTRIES (sizeof k6_multipliers / sizeof k6_multipliers[0])

int	k6_maxindex;	/* no setting higher than this */

/* linux says: "it doesn't matter where, as long as it is unused */
#define K6PORT 0xfff0

void
k6_powernow_init(void)
{
	uint64_t msrval;
	uint32_t portval;
	int i;

	/* on */
	msrval = K6PORT | 0x1;
	wrmsr(MSR_K6_EPMR, msrval);
	/* read */
	portval = inl(K6PORT + 8);
	/* off */
	wrmsr(MSR_K6_EPMR, 0LL);

	portval = (portval >> 5) & 7;

	for (i = 0; i < NUM_K6_ENTRIES; i++)
		if (portval == k6_multipliers[i].magic) {
			k6_maxindex = i;
			break;
		}
	if (i == NUM_K6_ENTRIES) {
		printf("bad value for current multiplier\n");
		return;
	}

	cpu_setperf = k6_powernow_setperf;
}

void
k6_powernow_setperf(int level)
{
	uint64_t msrval;
	uint32_t portval;
	int index;

	index = level * k6_maxindex / 100;

	/* on */
	msrval = K6PORT | 0x1;
	wrmsr(MSR_K6_EPMR, msrval);
	/* read and update */
	portval = inl(K6PORT + 8);
	portval &= 0xf;
	portval |= 1 << 12 | 1 << 10 | 1 << 9 |
	    k6_multipliers[index].magic << 5;
	outl(K6PORT + 8, portval);
	/* off */
	wrmsr(MSR_K6_EPMR, 0LL);
}