Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Convert to use cpufreq(9).

This commit is contained in:
jruoho 2011-10-18 05:08:24 +00:00
parent b2508f4f43
commit 804fdee3ad
4 changed files with 121 additions and 161 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
sys/arch/x86/acpi/acpi_cpu_md.c
View File

@ -1,4 +1,4 @@
/* $NetBSD: acpi_cpu_md.c,v 1.67 2011/09/24 19:41:40 jruoho Exp $ */
/* $NetBSD: acpi_cpu_md.c,v 1.68 2011/10/18 05:08:24 jruoho Exp $ */
/*-
* Copyright (c) 2010, 2011 Jukka Ruohonen <jruohonen@iki.fi>
@ -27,10 +27,11 @@
* SUCH DAMAGE.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: acpi_cpu_md.c,v 1.67 2011/09/24 19:41:40 jruoho Exp $");
__KERNEL_RCSID(0, "$NetBSD: acpi_cpu_md.c,v 1.68 2011/10/18 05:08:24 jruoho Exp $");
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/cpufreq.h>
#include <sys/device.h>
#include <sys/kcore.h>
#include <sys/sysctl.h>
@ -791,6 +792,9 @@ acpicpu_md_pstate_get(struct acpicpu_softc *sc, uint32_t *freq)
*/
if ((sc->sc_flags & ACPICPU_FLAG_P_HWF) != 0) {
KASSERT(sc->sc_pstate_count > 0);
KASSERT(sc->sc_pstate[0].ps_freq != 0);
if (acpicpu_md_pstate_hwf(sc->sc_ci) == 100) {
*freq = sc->sc_pstate[0].ps_freq;
return 0;
@ -1136,15 +1140,14 @@ fail:
static int
acpicpu_md_pstate_sysctl_get(SYSCTLFN_ARGS)
{
struct cpu_info *ci = curcpu();
struct sysctlnode node;
uint32_t freq;
int err;
err = acpicpu_pstate_get(ci, &freq);
freq = cpufreq_get(curcpu());
if (err != 0)
return err;
if (freq == 0)
return ENXIO;
node = *rnode;
node.sysctl_data = &freq;
@ -1160,15 +1163,14 @@ acpicpu_md_pstate_sysctl_get(SYSCTLFN_ARGS)
static int
acpicpu_md_pstate_sysctl_set(SYSCTLFN_ARGS)
{
struct cpu_info *ci = curcpu();
struct sysctlnode node;
uint32_t freq;
int err;
err = acpicpu_pstate_get(ci, &freq);
freq = cpufreq_get(curcpu());
if (err != 0)
return err;
if (freq == 0)
return ENXIO;
node = *rnode;
node.sysctl_data = &freq;
@ -1178,7 +1180,7 @@ acpicpu_md_pstate_sysctl_set(SYSCTLFN_ARGS)
if (err != 0 || newp == NULL)
return err;
acpicpu_pstate_set(ci, freq);
cpufreq_set_all(freq);
return 0;
}

63
sys/dev/acpi/acpi_cpu.c
View File

@ -1,4 +1,4 @@
/* $NetBSD: acpi_cpu.c,v 1.44 2011/06/22 08:49:54 jruoho Exp $ */
/* $NetBSD: acpi_cpu.c,v 1.45 2011/10/18 05:08:24 jruoho Exp $ */
/*-
* Copyright (c) 2010, 2011 Jukka Ruohonen <jruohonen@iki.fi>
@ -27,7 +27,7 @@
* SUCH DAMAGE.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: acpi_cpu.c,v 1.44 2011/06/22 08:49:54 jruoho Exp $");
__KERNEL_RCSID(0, "$NetBSD: acpi_cpu.c,v 1.45 2011/10/18 05:08:24 jruoho Exp $");
#include <sys/param.h>
#include <sys/cpu.h>
@ -37,6 +37,7 @@ __KERNEL_RCSID(0, "$NetBSD: acpi_cpu.c,v 1.44 2011/06/22 08:49:54 jruoho Exp $")
#include <sys/module.h>
#include <sys/mutex.h>
#include <sys/sysctl.h>
#include <sys/cpufreq.h>
#include <dev/acpi/acpireg.h>
#include <dev/acpi/acpivar.h>
@ -66,7 +67,8 @@ static bool acpicpu_resume(device_t, const pmf_qual_t *);
static void acpicpu_evcnt_attach(device_t);
static void acpicpu_evcnt_detach(device_t);
static void acpicpu_debug_print(device_t);
static const char *acpicpu_debug_print_method(uint8_t);
static const char *acpicpu_debug_print_method_c(uint8_t);
static const char *acpicpu_debug_print_method_pt(uint8_t);
static const char *acpicpu_debug_print_dep(uint32_t);
static uint32_t acpicpu_count = 0;
@ -247,6 +249,7 @@ acpicpu_once_attach(void)
static int
acpicpu_once_detach(void)
{
struct cpu_info *ci = curcpu();
struct acpicpu_softc *sc;
if (acpicpu_count != 0)
@ -255,8 +258,15 @@ acpicpu_once_detach(void)
if (acpicpu_log != NULL)
sysctl_teardown(&acpicpu_log);
if (acpicpu_sc != NULL)
if (acpicpu_sc != NULL) {
sc = acpicpu_sc[ci->ci_acpiid];
if ((sc->sc_flags & ACPICPU_FLAG_P) != 0)
cpufreq_deregister();
kmem_free(acpicpu_sc, maxcpus * sizeof(*sc));
}
return 0;
}
@ -266,6 +276,8 @@ acpicpu_start(device_t self)
{
struct acpicpu_softc *sc = device_private(self);
static uint32_t count = 0;
struct cpufreq cf;
uint32_t i;
/*
* Run the state-specific initialization routines. These
@ -294,6 +306,34 @@ acpicpu_start(device_t self)
acpicpu_sysctl(self);
aprint_debug_dev(self, "ACPI CPUs started\n");
/*
* Register with cpufreq(9).
*/
if ((sc->sc_flags & ACPICPU_FLAG_P) != 0) {
(void)memset(&cf, 0, sizeof(struct cpufreq));
cf.cf_mp = false;
cf.cf_cookie = NULL;
cf.cf_get_freq = acpicpu_pstate_get;
cf.cf_set_freq = acpicpu_pstate_set;
cf.cf_state_count = sc->sc_pstate_count;
(void)strlcpy(cf.cf_name, "acpicpu", sizeof(cf.cf_name));
for (i = 0; i < sc->sc_pstate_count; i++) {
if (sc->sc_pstate[i].ps_freq == 0)
continue;
cf.cf_state[i].cfs_freq = sc->sc_pstate[i].ps_freq;
cf.cf_state[i].cfs_power = sc->sc_pstate[i].ps_power;
}
if (cpufreq_register(&cf) != 0)
aprint_error_dev(self, "failed to register cpufreq\n");
}
}
static void
@ -726,7 +766,7 @@ acpicpu_debug_print(device_t self)
aprint_verbose_dev(sc->sc_dev, "C%d: %3s, "
"lat %3u us, pow %5u mW%s\n", i,
acpicpu_debug_print_method(cs->cs_method),
acpicpu_debug_print_method_c(cs->cs_method),
cs->cs_latency, cs->cs_power,
(cs->cs_flags != 0) ? ", bus master check" : "");
}
@ -742,7 +782,7 @@ acpicpu_debug_print(device_t self)
aprint_verbose_dev(sc->sc_dev, "P%d: %3s, "
"lat %3u us, pow %5u mW, %4u MHz%s\n", i,
acpicpu_debug_print_method(method),
acpicpu_debug_print_method_pt(method),
ps->ps_latency, ps->ps_power, ps->ps_freq,
(ps->ps_flags & ACPICPU_FLAG_P_TURBO) != 0 ?
", turbo boost" : "");
@ -759,7 +799,7 @@ acpicpu_debug_print(device_t self)
aprint_verbose_dev(sc->sc_dev, "T%u: %3s, "
"lat %3u us, pow %5u mW, %3u %%\n", i,
acpicpu_debug_print_method(method),
acpicpu_debug_print_method_pt(method),
ts->ts_latency, ts->ts_power, ts->ts_percent);
}
@ -799,7 +839,7 @@ acpicpu_debug_print(device_t self)
}
static const char *
acpicpu_debug_print_method(uint8_t val)
acpicpu_debug_print_method_c(uint8_t val)
{
if (val == ACPICPU_C_STATE_FFH)
@ -811,6 +851,13 @@ acpicpu_debug_print_method(uint8_t val)
if (val == ACPICPU_C_STATE_SYSIO)
return "I/O";
return "???";
}
static const char *
acpicpu_debug_print_method_pt(uint8_t val)
{
if (val == ACPI_ADR_SPACE_SYSTEM_IO)
return "I/O";

7
sys/dev/acpi/acpi_cpu.h
View File

@ -1,4 +1,4 @@
/* $NetBSD: acpi_cpu.h,v 1.42 2011/06/22 08:49:54 jruoho Exp $ */
/* $NetBSD: acpi_cpu.h,v 1.43 2011/10/18 05:08:24 jruoho Exp $ */
/*-
* Copyright (c) 2010, 2011 Jukka Ruohonen <jruohonen@iki.fi>
@ -84,7 +84,6 @@
*/
#define ACPICPU_P_STATE_MAX 255 /* Arbitrary upper limit */
#define ACPICPU_P_STATE_RETRY 100
#define ACPICPU_P_STATE_UNKNOWN 0x0
/*
* T-states.
@ -245,8 +244,8 @@ void acpicpu_pstate_start(device_t);
void acpicpu_pstate_suspend(void *);
void acpicpu_pstate_resume(void *);
void acpicpu_pstate_callback(void *);
int acpicpu_pstate_get(struct cpu_info *, uint32_t *);
void acpicpu_pstate_set(struct cpu_info *, uint32_t);
void acpicpu_pstate_get(void *, void *);
void acpicpu_pstate_set(void *, void *);
void acpicpu_tstate_attach(device_t);
void acpicpu_tstate_detach(device_t);

152
sys/dev/acpi/acpi_cpu_pstate.c
View File

@ -1,4 +1,4 @@
/* $NetBSD: acpi_cpu_pstate.c,v 1.51 2011/06/22 08:49:54 jruoho Exp $ */
/* $NetBSD: acpi_cpu_pstate.c,v 1.52 2011/10/18 05:08:24 jruoho Exp $ */
/*-
* Copyright (c) 2010, 2011 Jukka Ruohonen <jruohonen@iki.fi>
@ -27,11 +27,11 @@
* SUCH DAMAGE.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: acpi_cpu_pstate.c,v 1.51 2011/06/22 08:49:54 jruoho Exp $");
__KERNEL_RCSID(0, "$NetBSD: acpi_cpu_pstate.c,v 1.52 2011/10/18 05:08:24 jruoho Exp $");
#include <sys/param.h>
#include <sys/cpufreq.h>
#include <sys/kmem.h>
#include <sys/xcall.h>
#include <dev/acpi/acpireg.h>
#include <dev/acpi/acpivar.h>
@ -53,7 +53,6 @@ static int acpicpu_pstate_min(struct acpicpu_softc *);
static void acpicpu_pstate_change(struct acpicpu_softc *);
static void acpicpu_pstate_reset(struct acpicpu_softc *);
static void acpicpu_pstate_bios(void);
static void acpicpu_pstate_set_xcall(void *, void *);
extern struct acpicpu_softc **acpicpu_sc;
@ -129,6 +128,7 @@ acpicpu_pstate_attach(device_t self)
if (ACPI_SUCCESS(rv))
sc->sc_flags |= ACPICPU_FLAG_P_DEP;
sc->sc_pstate_current = 0;
sc->sc_flags |= ACPICPU_FLAG_P;
acpicpu_pstate_bios();
@ -175,99 +175,33 @@ void
acpicpu_pstate_start(device_t self)
{
struct acpicpu_softc *sc = device_private(self);
struct acpicpu_pstate *ps;
uint32_t i;
int rv;
rv = acpicpu_md_pstate_start(sc);
if (rv != 0)
goto fail;
/*
* Initialize the states to P0.
*/
for (i = 0, rv = ENXIO; i < sc->sc_pstate_count; i++) {
ps = &sc->sc_pstate[i];
if (ps->ps_freq != 0) {
acpicpu_pstate_set(sc->sc_ci, ps->ps_freq);
if (acpicpu_md_pstate_start(sc) == 0)
return;
}
}
fail:
sc->sc_flags &= ~ACPICPU_FLAG_P;
aprint_error_dev(self, "failed to start P-states (err %d)\n", rv);
aprint_error_dev(self, "failed to start P-states\n");
}
void
acpicpu_pstate_suspend(void *aux)
{
struct acpicpu_pstate *ps = NULL;
struct acpicpu_softc *sc;
struct cpu_info *ci;
device_t self = aux;
uint64_t xc;
int32_t i;
sc = device_private(self);
ci = sc->sc_ci;
/*
* Reset any dynamic limits.
*/
sc = device_private(self);
mutex_enter(&sc->sc_mtx);
acpicpu_pstate_reset(sc);
/*
* Following design notes for Windows, we set the highest
* P-state when entering any of the system sleep states.
* When resuming, the saved P-state will be restored.
*
* Microsoft Corporation: Windows Native Processor
* Performance Control. Version 1.1a, November, 2002.
*/
sc->sc_pstate_saved = sc->sc_pstate_current;
for (i = sc->sc_pstate_count - 1; i >= 0; i--) {
if (sc->sc_pstate[i].ps_freq != 0) {
ps = &sc->sc_pstate[i];
break;
}
}
if (__predict_false(ps == NULL)) {
mutex_exit(&sc->sc_mtx);
return;
}
if (sc->sc_pstate_saved == ps->ps_freq) {
mutex_exit(&sc->sc_mtx);
return;
}
mutex_exit(&sc->sc_mtx);
xc = xc_unicast(0, acpicpu_pstate_set_xcall, &ps->ps_freq, NULL, ci);
xc_wait(xc);
}
void
acpicpu_pstate_resume(void *aux)
{
struct acpicpu_softc *sc;
device_t self = aux;
uint32_t freq;
uint64_t xc;
sc = device_private(self);
freq = sc->sc_pstate_saved;
xc = xc_unicast(0, acpicpu_pstate_set_xcall, &freq, NULL, sc->sc_ci);
xc_wait(xc);
/* Nothing. */
}
void
@ -276,10 +210,8 @@ acpicpu_pstate_callback(void *aux)
struct acpicpu_softc *sc;
device_t self = aux;
uint32_t freq;
uint64_t xc;
sc = device_private(self);
mutex_enter(&sc->sc_mtx);
acpicpu_pstate_change(sc);
@ -294,12 +226,10 @@ acpicpu_pstate_callback(void *aux)
}
mutex_exit(&sc->sc_mtx);
xc = xc_unicast(0, acpicpu_pstate_set_xcall, &freq, NULL, sc->sc_ci);
xc_wait(xc);
cpufreq_set(sc->sc_ci, freq);
}
ACPI_STATUS
static ACPI_STATUS
acpicpu_pstate_pss(struct acpicpu_softc *sc)
{
struct acpicpu_pstate *ps;
@ -529,7 +459,7 @@ acpicpu_pstate_xpss_add(struct acpicpu_pstate *ps, ACPI_OBJECT *obj)
return AE_OK;
}
ACPI_STATUS
static ACPI_STATUS
acpicpu_pstate_pct(struct acpicpu_softc *sc)
{
static const size_t size = sizeof(struct acpicpu_reg);
@ -635,8 +565,7 @@ acpicpu_pstate_pct(struct acpicpu_softc *sc)
(void)memcpy(&sc->sc_pstate_control, reg[0], size);
(void)memcpy(&sc->sc_pstate_status, reg[1], size);
if ((sc->sc_flags & ACPICPU_FLAG_P_XPSS) == 0)
goto out;
if ((sc->sc_flags & ACPICPU_FLAG_P_XPSS) != 0) {
/*
* At the very least, mandate that
@ -648,8 +577,8 @@ acpicpu_pstate_pct(struct acpicpu_softc *sc)
}
/*
* If XPSS is present, copy the MSR addresses
* to the P-state structures for convenience.
* If XPSS is present, copy the supplied
* MSR addresses to the P-state structures.
*/
for (i = 0; i < sc->sc_pstate_count; i++) {
@ -661,6 +590,7 @@ acpicpu_pstate_pct(struct acpicpu_softc *sc)
ps->ps_status_addr = sc->sc_pstate_status.reg_addr;
ps->ps_control_addr = sc->sc_pstate_control.reg_addr;
}
}
out:
if (buf.Pointer != NULL)
@ -863,12 +793,13 @@ acpicpu_pstate_bios(void)
(void)AcpiOsWritePort(addr, val, 8);
}
int
acpicpu_pstate_get(struct cpu_info *ci, uint32_t *freq)
void
acpicpu_pstate_get(void *aux, void *cpu_freq)
{
struct acpicpu_pstate *ps = NULL;
struct cpu_info *ci = curcpu();
struct acpicpu_softc *sc;
uint32_t i, val = 0;
uint32_t freq, i, val = 0;
uint64_t addr;
uint8_t width;
int rv;
@ -880,11 +811,6 @@ acpicpu_pstate_get(struct cpu_info *ci, uint32_t *freq)
goto fail;
}
if (__predict_false(sc->sc_cold != false)) {
rv = EBUSY;
goto fail;
}
if (__predict_false((sc->sc_flags & ACPICPU_FLAG_P) == 0)) {
rv = ENODEV;
goto fail;
@ -895,10 +821,10 @@ acpicpu_pstate_get(struct cpu_info *ci, uint32_t *freq)
/*
* Use the cached value, if available.
*/
if (sc->sc_pstate_current != ACPICPU_P_STATE_UNKNOWN) {
*freq = sc->sc_pstate_current;
if (sc->sc_pstate_current != 0) {
*(uint32_t *)cpu_freq = sc->sc_pstate_current;
mutex_exit(&sc->sc_mtx);
return 0;
return;
}
mutex_exit(&sc->sc_mtx);
@ -907,7 +833,7 @@ acpicpu_pstate_get(struct cpu_info *ci, uint32_t *freq)
case ACPI_ADR_SPACE_FIXED_HARDWARE:
rv = acpicpu_md_pstate_get(sc, freq);
rv = acpicpu_md_pstate_get(sc, &freq);
if (__predict_false(rv != 0))
goto fail;
@ -942,7 +868,7 @@ acpicpu_pstate_get(struct cpu_info *ci, uint32_t *freq)
goto fail;
}
*freq = ps->ps_freq;
freq = ps->ps_freq;
break;
default:
@ -951,33 +877,24 @@ acpicpu_pstate_get(struct cpu_info *ci, uint32_t *freq)
}
mutex_enter(&sc->sc_mtx);
sc->sc_pstate_current = *freq;
sc->sc_pstate_current = freq;
*(uint32_t *)cpu_freq = freq;
mutex_exit(&sc->sc_mtx);
return 0;
return;
fail:
aprint_error_dev(sc->sc_dev, "failed "
"to get frequency (err %d)\n", rv);
mutex_enter(&sc->sc_mtx);
*freq = sc->sc_pstate_current = ACPICPU_P_STATE_UNKNOWN;
sc->sc_pstate_current = 0;
*(uint32_t *)cpu_freq = 0;
mutex_exit(&sc->sc_mtx);
return rv;
}
void
acpicpu_pstate_set(struct cpu_info *ci, uint32_t freq)
{
uint64_t xc;
xc = xc_broadcast(0, acpicpu_pstate_set_xcall, &freq, NULL);
xc_wait(xc);
}
static void
acpicpu_pstate_set_xcall(void *arg1, void *arg2)
acpicpu_pstate_set(void *aux, void *cpu_freq)
{
struct acpicpu_pstate *ps = NULL;
struct cpu_info *ci = curcpu();
@ -987,7 +904,7 @@ acpicpu_pstate_set_xcall(void *arg1, void *arg2)
uint8_t width;
int rv;
freq = *(uint32_t *)arg1;
freq = *(uint32_t *)cpu_freq;
sc = acpicpu_sc[ci->ci_acpiid];
if (__predict_false(sc == NULL)) {
@ -995,11 +912,6 @@ acpicpu_pstate_set_xcall(void *arg1, void *arg2)
goto fail;
}
if (__predict_false(sc->sc_cold != false)) {
rv = EBUSY;
goto fail;
}
if (__predict_false((sc->sc_flags & ACPICPU_FLAG_P) == 0)) {
rv = ENODEV;
goto fail;
@ -1096,6 +1008,6 @@ fail:
"frequency to %u (err %d)\n", freq, rv);
mutex_enter(&sc->sc_mtx);
sc->sc_pstate_current = ACPICPU_P_STATE_UNKNOWN;
sc->sc_pstate_current = 0;
mutex_exit(&sc->sc_mtx);
}