1fec754d4SMike Smith /*- 298aa9cd0SNate Lawson * Copyright (c) 2003-2005 Nate Lawson (SDG) 3fec754d4SMike Smith * Copyright (c) 2001 Michael Smith 4fec754d4SMike Smith * All rights reserved. 5fec754d4SMike Smith * 6fec754d4SMike Smith * Redistribution and use in source and binary forms, with or without 7fec754d4SMike Smith * modification, are permitted provided that the following conditions 8fec754d4SMike Smith * are met: 9fec754d4SMike Smith * 1. Redistributions of source code must retain the above copyright 10fec754d4SMike Smith * notice, this list of conditions and the following disclaimer. 11fec754d4SMike Smith * 2. Redistributions in binary form must reproduce the above copyright 12fec754d4SMike Smith * notice, this list of conditions and the following disclaimer in the 13fec754d4SMike Smith * documentation and/or other materials provided with the distribution. 14fec754d4SMike Smith * 15fec754d4SMike Smith * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16fec754d4SMike Smith * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17fec754d4SMike Smith * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18fec754d4SMike Smith * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19fec754d4SMike Smith * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20fec754d4SMike Smith * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21fec754d4SMike Smith * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22fec754d4SMike Smith * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23fec754d4SMike Smith * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24fec754d4SMike Smith * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25fec754d4SMike Smith * SUCH DAMAGE. 26fec754d4SMike Smith */ 27fec754d4SMike Smith 28aad970f1SDavid E. O'Brien #include <sys/cdefs.h> 29aad970f1SDavid E. O'Brien __FBSDID("$FreeBSD$"); 30aad970f1SDavid E. O'Brien 31fec754d4SMike Smith #include "opt_acpi.h" 32fec754d4SMike Smith #include <sys/param.h> 33fec754d4SMike Smith #include <sys/bus.h> 3498aa9cd0SNate Lawson #include <sys/cpu.h> 3556a70eadSNate Lawson #include <sys/kernel.h> 36447a5fa1SJohn Baldwin #include <sys/malloc.h> 37fe12f24bSPoul-Henning Kamp #include <sys/module.h> 386b74f9b7SNate Lawson #include <sys/pcpu.h> 3956a70eadSNate Lawson #include <sys/power.h> 4056a70eadSNate Lawson #include <sys/proc.h> 4156a70eadSNate Lawson #include <sys/sbuf.h> 426b74f9b7SNate Lawson #include <sys/smp.h> 43fec754d4SMike Smith 446b74f9b7SNate Lawson #include <dev/pci/pcivar.h> 4556a70eadSNate Lawson #include <machine/atomic.h> 46fec754d4SMike Smith #include <machine/bus.h> 4756a70eadSNate Lawson #include <sys/rman.h> 48fec754d4SMike Smith 49fec754d4SMike Smith #include "acpi.h" 50fec754d4SMike Smith #include <dev/acpica/acpivar.h> 51fec754d4SMike Smith 52fec754d4SMike Smith /* 536b74f9b7SNate Lawson * Support for ACPI Processor devices, including ACPI 2.0 throttling 546b74f9b7SNate Lawson * and C[1-3] sleep states. 55fec754d4SMike Smith * 566b74f9b7SNate Lawson * TODO: implement scans of all CPUs to be sure all Cx states are 576b74f9b7SNate Lawson * equivalent. 58fec754d4SMike Smith */ 59fec754d4SMike Smith 60be2b1797SNate Lawson /* Hooks for the ACPI CA debugging infrastructure */ 61fec754d4SMike Smith #define _COMPONENT ACPI_PROCESSOR 629127281cSMike Smith ACPI_MODULE_NAME("PROCESSOR") 63fec754d4SMike Smith 646b74f9b7SNate Lawson struct acpi_cx { 656b74f9b7SNate Lawson struct resource *p_lvlx; /* Register to read to enter state. */ 666b74f9b7SNate Lawson uint32_t type; /* C1-3 (C4 and up treated as C3). */ 676b74f9b7SNate Lawson uint32_t trans_lat; /* Transition latency (usec). */ 686b74f9b7SNate Lawson uint32_t power; /* Power consumed (mW). */ 69f4eb0418SNate Lawson int res_type; /* Resource type for p_lvlx. */ 706b74f9b7SNate Lawson }; 716b74f9b7SNate Lawson #define MAX_CX_STATES 8 726b74f9b7SNate Lawson 73fec754d4SMike Smith struct acpi_cpu_softc { 74fec754d4SMike Smith device_t cpu_dev; 75fec754d4SMike Smith ACPI_HANDLE cpu_handle; 7698aa9cd0SNate Lawson struct pcpu *cpu_pcpu; 7798aa9cd0SNate Lawson uint32_t cpu_acpi_id; /* ACPI processor id */ 7856a70eadSNate Lawson uint32_t cpu_p_blk; /* ACPI P_BLK location */ 7956a70eadSNate Lawson uint32_t cpu_p_blk_len; /* P_BLK length (must be 6). */ 806b74f9b7SNate Lawson struct resource *cpu_p_cnt; /* Throttling control register */ 81f4eb0418SNate Lawson int cpu_p_type; /* Resource type for cpu_p_cnt. */ 826b74f9b7SNate Lawson struct acpi_cx cpu_cx_states[MAX_CX_STATES]; 8356a70eadSNate Lawson int cpu_cx_count; /* Number of valid Cx states. */ 84a2afe45aSNate Lawson int cpu_prev_sleep;/* Last idle sleep duration. */ 85fec754d4SMike Smith }; 86fec754d4SMike Smith 8798aa9cd0SNate Lawson struct acpi_cpu_device { 8898aa9cd0SNate Lawson struct resource_list ad_rl; 8998aa9cd0SNate Lawson }; 9098aa9cd0SNate Lawson 916b74f9b7SNate Lawson #define CPU_GET_REG(reg, width) \ 926b74f9b7SNate Lawson (bus_space_read_ ## width(rman_get_bustag((reg)), \ 936b74f9b7SNate Lawson rman_get_bushandle((reg)), 0)) 946b74f9b7SNate Lawson #define CPU_SET_REG(reg, width, val) \ 956b74f9b7SNate Lawson (bus_space_write_ ## width(rman_get_bustag((reg)), \ 966b74f9b7SNate Lawson rman_get_bushandle((reg)), 0, (val))) 97be2b1797SNate Lawson 98fec754d4SMike Smith /* 99b279c35aSNate Lawson * Speeds are stored in counts, from 1 to CPU_MAX_SPEED, and 100fec754d4SMike Smith * reported to the user in tenths of a percent. 101fec754d4SMike Smith */ 1026b74f9b7SNate Lawson static uint32_t cpu_duty_offset; 1036b74f9b7SNate Lawson static uint32_t cpu_duty_width; 104fec754d4SMike Smith #define CPU_MAX_SPEED (1 << cpu_duty_width) 105fec754d4SMike Smith #define CPU_SPEED_PERCENT(x) ((1000 * (x)) / CPU_MAX_SPEED) 1066b74f9b7SNate Lawson #define CPU_SPEED_PRINTABLE(x) (CPU_SPEED_PERCENT(x) / 10), \ 1076b74f9b7SNate Lawson (CPU_SPEED_PERCENT(x) % 10) 1086b74f9b7SNate Lawson #define CPU_P_CNT_THT_EN (1<<4) 1096b74f9b7SNate Lawson #define PM_USEC(x) ((x) >> 2) /* ~4 clocks per usec (3.57955 Mhz) */ 110fec754d4SMike Smith 1116b74f9b7SNate Lawson #define ACPI_CPU_NOTIFY_PERF_STATES 0x80 /* _PSS changed. */ 1126b74f9b7SNate Lawson #define ACPI_CPU_NOTIFY_CX_STATES 0x81 /* _CST changed. */ 113fec754d4SMike Smith 11418ececa0SNate Lawson #define CPU_QUIRK_NO_C3 (1<<0) /* C3-type states are not usable. */ 11518ececa0SNate Lawson #define CPU_QUIRK_NO_THROTTLE (1<<1) /* Throttling is not usable. */ 11618ececa0SNate Lawson #define CPU_QUIRK_NO_BM_CTRL (1<<2) /* No bus mastering control. */ 1176b74f9b7SNate Lawson 1186b74f9b7SNate Lawson #define PCI_VENDOR_INTEL 0x8086 1196b74f9b7SNate Lawson #define PCI_DEVICE_82371AB_3 0x7113 /* PIIX4 chipset for quirks. */ 1206b74f9b7SNate Lawson #define PCI_REVISION_A_STEP 0 1216b74f9b7SNate Lawson #define PCI_REVISION_B_STEP 1 1226b74f9b7SNate Lawson #define PCI_REVISION_4E 2 1236b74f9b7SNate Lawson #define PCI_REVISION_4M 3 1246b74f9b7SNate Lawson 1256b74f9b7SNate Lawson /* Platform hardware resource information. */ 1266b74f9b7SNate Lawson static uint32_t cpu_smi_cmd; /* Value to write to SMI_CMD. */ 1276b74f9b7SNate Lawson static uint8_t cpu_pstate_cnt;/* Register to take over throttling. */ 12856a70eadSNate Lawson static uint8_t cpu_cst_cnt; /* Indicate we are _CST aware. */ 129a2afe45aSNate Lawson static int cpu_rid; /* Driver-wide resource id. */ 130a2afe45aSNate Lawson static int cpu_quirks; /* Indicate any hardware bugs. */ 1316b74f9b7SNate Lawson 1326b74f9b7SNate Lawson /* Runtime state. */ 1336b74f9b7SNate Lawson static int cpu_cx_count; /* Number of valid states */ 134a2afe45aSNate Lawson static int cpu_non_c3; /* Index of lowest non-C3 state. */ 135a2afe45aSNate Lawson static u_int cpu_cx_stats[MAX_CX_STATES];/* Cx usage history. */ 1366b74f9b7SNate Lawson 1376b74f9b7SNate Lawson /* Values for sysctl. */ 13898aa9cd0SNate Lawson static struct sysctl_ctx_list acpi_cpu_sysctl_ctx; 13998aa9cd0SNate Lawson static struct sysctl_oid *acpi_cpu_sysctl_tree; 1400d8fb61aSNate Lawson static uint32_t cpu_throttle_state; 1410d8fb61aSNate Lawson static uint32_t cpu_throttle_max; 1426b74f9b7SNate Lawson static int cpu_cx_lowest; 1436b74f9b7SNate Lawson static char cpu_cx_supported[64]; 144fec754d4SMike Smith 145fec754d4SMike Smith static device_t *cpu_devices; 146fec754d4SMike Smith static int cpu_ndevices; 147447a5fa1SJohn Baldwin static struct acpi_cpu_softc **cpu_softc; 148d92a2ebdSNate Lawson ACPI_SERIAL_DECL(cpu, "ACPI CPU"); 149fec754d4SMike Smith 150fec754d4SMike Smith static int acpi_cpu_probe(device_t dev); 151fec754d4SMike Smith static int acpi_cpu_attach(device_t dev); 152b6426963SNate Lawson static int acpi_pcpu_get_id(uint32_t idx, uint32_t *acpi_id, 153b6426963SNate Lawson uint32_t *cpu_id); 15498aa9cd0SNate Lawson static struct resource_list *acpi_cpu_get_rlist(device_t dev, device_t child); 15598aa9cd0SNate Lawson static device_t acpi_cpu_add_child(device_t dev, int order, const char *name, 15698aa9cd0SNate Lawson int unit); 15798aa9cd0SNate Lawson static int acpi_cpu_read_ivar(device_t dev, device_t child, int index, 15898aa9cd0SNate Lawson uintptr_t *result); 15956a70eadSNate Lawson static int acpi_cpu_shutdown(device_t dev); 1606b74f9b7SNate Lawson static int acpi_cpu_throttle_probe(struct acpi_cpu_softc *sc); 1616b74f9b7SNate Lawson static int acpi_cpu_cx_probe(struct acpi_cpu_softc *sc); 1626b74f9b7SNate Lawson static int acpi_cpu_cx_cst(struct acpi_cpu_softc *sc); 1636b74f9b7SNate Lawson static void acpi_cpu_startup(void *arg); 1646b74f9b7SNate Lawson static void acpi_cpu_startup_throttling(void); 16556a70eadSNate Lawson static void acpi_cpu_startup_cx(void); 1666b74f9b7SNate Lawson static void acpi_cpu_throttle_set(uint32_t speed); 1676b74f9b7SNate Lawson static void acpi_cpu_idle(void); 1686b74f9b7SNate Lawson static void acpi_cpu_notify(ACPI_HANDLE h, UINT32 notify, void *context); 1696b74f9b7SNate Lawson static int acpi_cpu_quirks(struct acpi_cpu_softc *sc); 1706b74f9b7SNate Lawson static int acpi_cpu_throttle_sysctl(SYSCTL_HANDLER_ARGS); 171a2afe45aSNate Lawson static int acpi_cpu_usage_sysctl(SYSCTL_HANDLER_ARGS); 1726b74f9b7SNate Lawson static int acpi_cpu_cx_lowest_sysctl(SYSCTL_HANDLER_ARGS); 173fec754d4SMike Smith 174fec754d4SMike Smith static device_method_t acpi_cpu_methods[] = { 175fec754d4SMike Smith /* Device interface */ 176fec754d4SMike Smith DEVMETHOD(device_probe, acpi_cpu_probe), 177fec754d4SMike Smith DEVMETHOD(device_attach, acpi_cpu_attach), 17898aa9cd0SNate Lawson DEVMETHOD(device_detach, bus_generic_detach), 17956a70eadSNate Lawson DEVMETHOD(device_shutdown, acpi_cpu_shutdown), 18098aa9cd0SNate Lawson DEVMETHOD(device_suspend, bus_generic_suspend), 18198aa9cd0SNate Lawson DEVMETHOD(device_resume, bus_generic_resume), 18298aa9cd0SNate Lawson 18398aa9cd0SNate Lawson /* Bus interface */ 18498aa9cd0SNate Lawson DEVMETHOD(bus_add_child, acpi_cpu_add_child), 18598aa9cd0SNate Lawson DEVMETHOD(bus_read_ivar, acpi_cpu_read_ivar), 18698aa9cd0SNate Lawson DEVMETHOD(bus_get_resource_list, acpi_cpu_get_rlist), 18798aa9cd0SNate Lawson DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 18898aa9cd0SNate Lawson DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource), 18998aa9cd0SNate Lawson DEVMETHOD(bus_alloc_resource, bus_generic_rl_alloc_resource), 19098aa9cd0SNate Lawson DEVMETHOD(bus_release_resource, bus_generic_rl_release_resource), 19198aa9cd0SNate Lawson DEVMETHOD(bus_driver_added, bus_generic_driver_added), 19298aa9cd0SNate Lawson DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 19398aa9cd0SNate Lawson DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 19498aa9cd0SNate Lawson DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 19598aa9cd0SNate Lawson DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 196fec754d4SMike Smith 197fec754d4SMike Smith {0, 0} 198fec754d4SMike Smith }; 199fec754d4SMike Smith 200fec754d4SMike Smith static driver_t acpi_cpu_driver = { 201b0e2b625SNate Lawson "cpu", 202fec754d4SMike Smith acpi_cpu_methods, 203fec754d4SMike Smith sizeof(struct acpi_cpu_softc), 204fec754d4SMike Smith }; 205fec754d4SMike Smith 2067d3a0620SNate Lawson static devclass_t cpu_devclass; 20798aa9cd0SNate Lawson DRIVER_MODULE(cpu, acpi, acpi_cpu_driver, cpu_devclass, 0, 0); 208b0e2b625SNate Lawson MODULE_DEPEND(cpu, acpi, 1, 1, 1); 20956a70eadSNate Lawson 210fec754d4SMike Smith static int 211fec754d4SMike Smith acpi_cpu_probe(device_t dev) 212fec754d4SMike Smith { 213b0e2b625SNate Lawson int acpi_id, cpu_id, cx_count; 214b0e2b625SNate Lawson ACPI_BUFFER buf; 215b0e2b625SNate Lawson ACPI_HANDLE handle; 216b0e2b625SNate Lawson char msg[32]; 217b0e2b625SNate Lawson ACPI_OBJECT *obj; 218b0e2b625SNate Lawson ACPI_STATUS status; 219b0e2b625SNate Lawson 220b0e2b625SNate Lawson if (acpi_disabled("cpu") || acpi_get_type(dev) != ACPI_TYPE_PROCESSOR) 221b0e2b625SNate Lawson return (ENXIO); 222b0e2b625SNate Lawson 223b0e2b625SNate Lawson handle = acpi_get_handle(dev); 224447a5fa1SJohn Baldwin if (cpu_softc == NULL) 225447a5fa1SJohn Baldwin cpu_softc = malloc(sizeof(struct acpi_cpu_softc *) * 226447a5fa1SJohn Baldwin (mp_maxid + 1), M_TEMP /* XXX */, M_WAITOK | M_ZERO); 227b0e2b625SNate Lawson 228b0e2b625SNate Lawson /* Get our Processor object. */ 229b0e2b625SNate Lawson buf.Pointer = NULL; 230b0e2b625SNate Lawson buf.Length = ACPI_ALLOCATE_BUFFER; 231b0e2b625SNate Lawson status = AcpiEvaluateObject(handle, NULL, NULL, &buf); 232b0e2b625SNate Lawson if (ACPI_FAILURE(status)) { 233b0e2b625SNate Lawson device_printf(dev, "probe failed to get Processor obj - %s\n", 234b0e2b625SNate Lawson AcpiFormatException(status)); 235b0e2b625SNate Lawson return (ENXIO); 236b0e2b625SNate Lawson } 237b0e2b625SNate Lawson obj = (ACPI_OBJECT *)buf.Pointer; 238b0e2b625SNate Lawson if (obj->Type != ACPI_TYPE_PROCESSOR) { 239b0e2b625SNate Lawson device_printf(dev, "Processor object has bad type %d\n", obj->Type); 240b0e2b625SNate Lawson AcpiOsFree(obj); 241b0e2b625SNate Lawson return (ENXIO); 242fec754d4SMike Smith } 243be2b1797SNate Lawson 244b0e2b625SNate Lawson /* 245b0e2b625SNate Lawson * Find the processor associated with our unit. We could use the 246b0e2b625SNate Lawson * ProcId as a key, however, some boxes do not have the same values 247b0e2b625SNate Lawson * in their Processor object as the ProcId values in the MADT. 248b0e2b625SNate Lawson */ 249b0e2b625SNate Lawson acpi_id = obj->Processor.ProcId; 250b0e2b625SNate Lawson AcpiOsFree(obj); 251b0e2b625SNate Lawson if (acpi_pcpu_get_id(device_get_unit(dev), &acpi_id, &cpu_id) != 0) 252fec754d4SMike Smith return (ENXIO); 253b0e2b625SNate Lawson 254b0e2b625SNate Lawson /* 255b0e2b625SNate Lawson * Check if we already probed this processor. We scan the bus twice 256b0e2b625SNate Lawson * so it's possible we've already seen this one. 257b0e2b625SNate Lawson */ 258b0e2b625SNate Lawson if (cpu_softc[cpu_id] != NULL) 259b0e2b625SNate Lawson return (ENXIO); 260b0e2b625SNate Lawson 261b0e2b625SNate Lawson /* Get a count of Cx states for our device string. */ 262b0e2b625SNate Lawson cx_count = 0; 263b0e2b625SNate Lawson buf.Pointer = NULL; 264b0e2b625SNate Lawson buf.Length = ACPI_ALLOCATE_BUFFER; 265b0e2b625SNate Lawson status = AcpiEvaluateObject(handle, "_CST", NULL, &buf); 266b0e2b625SNate Lawson if (ACPI_SUCCESS(status)) { 267b0e2b625SNate Lawson obj = (ACPI_OBJECT *)buf.Pointer; 268b0e2b625SNate Lawson if (ACPI_PKG_VALID(obj, 2)) 269b0e2b625SNate Lawson acpi_PkgInt32(obj, 0, &cx_count); 270b0e2b625SNate Lawson AcpiOsFree(obj); 271b0e2b625SNate Lawson } else { 272b0e2b625SNate Lawson if (AcpiGbl_FADT->Plvl2Lat <= 100) 273b0e2b625SNate Lawson cx_count++; 274b0e2b625SNate Lawson if (AcpiGbl_FADT->Plvl3Lat <= 1000) 275b0e2b625SNate Lawson cx_count++; 276b0e2b625SNate Lawson if (cx_count > 0) 277b0e2b625SNate Lawson cx_count++; 278b0e2b625SNate Lawson } 279b0e2b625SNate Lawson if (cx_count > 0) 280b0e2b625SNate Lawson snprintf(msg, sizeof(msg), "ACPI CPU (%d Cx states)", cx_count); 281b0e2b625SNate Lawson else 282b0e2b625SNate Lawson strlcpy(msg, "ACPI CPU", sizeof(msg)); 283b0e2b625SNate Lawson device_set_desc_copy(dev, msg); 284b0e2b625SNate Lawson 285b0e2b625SNate Lawson /* Mark this processor as in-use and save our derived id for attach. */ 286b0e2b625SNate Lawson cpu_softc[cpu_id] = (void *)1; 287b0e2b625SNate Lawson acpi_set_magic(dev, cpu_id); 288b0e2b625SNate Lawson 289b0e2b625SNate Lawson return (0); 290fec754d4SMike Smith } 291fec754d4SMike Smith 292fec754d4SMike Smith static int 293fec754d4SMike Smith acpi_cpu_attach(device_t dev) 294fec754d4SMike Smith { 295b0e2b625SNate Lawson ACPI_BUFFER buf; 296b0e2b625SNate Lawson ACPI_OBJECT *obj; 29798aa9cd0SNate Lawson struct pcpu *pcpu_data; 298fec754d4SMike Smith struct acpi_cpu_softc *sc; 299fec754d4SMike Smith struct acpi_softc *acpi_sc; 300fec754d4SMike Smith ACPI_STATUS status; 30198aa9cd0SNate Lawson int cx_ret, cpu_id, thr_ret; 302fec754d4SMike Smith 303b4a05238SPeter Wemm ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 304fec754d4SMike Smith 305fec754d4SMike Smith sc = device_get_softc(dev); 306fec754d4SMike Smith sc->cpu_dev = dev; 307fec754d4SMike Smith sc->cpu_handle = acpi_get_handle(dev); 30898aa9cd0SNate Lawson cpu_id = acpi_get_magic(dev); 30998aa9cd0SNate Lawson cpu_softc[cpu_id] = sc; 31098aa9cd0SNate Lawson pcpu_data = pcpu_find(cpu_id); 31198aa9cd0SNate Lawson pcpu_data->pc_device = dev; 31298aa9cd0SNate Lawson sc->cpu_pcpu = pcpu_data; 313fec754d4SMike Smith 314b0e2b625SNate Lawson buf.Pointer = NULL; 315b0e2b625SNate Lawson buf.Length = ACPI_ALLOCATE_BUFFER; 3166b74f9b7SNate Lawson status = AcpiEvaluateObject(sc->cpu_handle, NULL, NULL, &buf); 3176b74f9b7SNate Lawson if (ACPI_FAILURE(status)) { 318b0e2b625SNate Lawson device_printf(dev, "attach failed to get Processor obj - %s\n", 3196b74f9b7SNate Lawson AcpiFormatException(status)); 3206b74f9b7SNate Lawson return (ENXIO); 321b0e2b625SNate Lawson } 322b0e2b625SNate Lawson obj = (ACPI_OBJECT *)buf.Pointer; 323b0e2b625SNate Lawson sc->cpu_p_blk = obj->Processor.PblkAddress; 324b0e2b625SNate Lawson sc->cpu_p_blk_len = obj->Processor.PblkLength; 32598aa9cd0SNate Lawson sc->cpu_acpi_id = obj->Processor.ProcId; 326b0e2b625SNate Lawson AcpiOsFree(obj); 32756a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, "acpi_cpu%d: P_BLK at %#x/%d\n", 32856a70eadSNate Lawson device_get_unit(dev), sc->cpu_p_blk, sc->cpu_p_blk_len)); 3296b74f9b7SNate Lawson 330fec754d4SMike Smith acpi_sc = acpi_device_get_parent_softc(dev); 331fec754d4SMike Smith sysctl_ctx_init(&acpi_cpu_sysctl_ctx); 332fec754d4SMike Smith acpi_cpu_sysctl_tree = SYSCTL_ADD_NODE(&acpi_cpu_sysctl_ctx, 33398aa9cd0SNate Lawson SYSCTL_CHILDREN(acpi_sc->acpi_sysctl_tree), OID_AUTO, "cpu", 33498aa9cd0SNate Lawson CTLFLAG_RD, 0, ""); 335fec754d4SMike Smith 3366b74f9b7SNate Lawson /* 3376b74f9b7SNate Lawson * Probe for throttling and Cx state support. 3386b74f9b7SNate Lawson * If none of these is present, free up unused resources. 3396b74f9b7SNate Lawson */ 3406b74f9b7SNate Lawson thr_ret = acpi_cpu_throttle_probe(sc); 3416b74f9b7SNate Lawson cx_ret = acpi_cpu_cx_probe(sc); 3426b74f9b7SNate Lawson if (thr_ret == 0 || cx_ret == 0) { 3436b74f9b7SNate Lawson status = AcpiInstallNotifyHandler(sc->cpu_handle, ACPI_DEVICE_NOTIFY, 3446b74f9b7SNate Lawson acpi_cpu_notify, sc); 34556a70eadSNate Lawson if (device_get_unit(dev) == 0) 34656a70eadSNate Lawson AcpiOsQueueForExecution(OSD_PRIORITY_LO, acpi_cpu_startup, NULL); 3476b74f9b7SNate Lawson } else { 3486b74f9b7SNate Lawson sysctl_ctx_free(&acpi_cpu_sysctl_ctx); 3496b74f9b7SNate Lawson } 3506b74f9b7SNate Lawson 35198aa9cd0SNate Lawson /* Call identify and then probe/attach for cpu child drivers. */ 35298aa9cd0SNate Lawson bus_generic_probe(dev); 35398aa9cd0SNate Lawson bus_generic_attach(dev); 35498aa9cd0SNate Lawson 35598aa9cd0SNate Lawson return (0); 3566b74f9b7SNate Lawson } 3576b74f9b7SNate Lawson 358b6426963SNate Lawson /* 359b6426963SNate Lawson * Find the nth present CPU and return its pc_cpuid as well as set the 360b6426963SNate Lawson * pc_acpi_id from the most reliable source. 361b6426963SNate Lawson */ 362b6426963SNate Lawson static int 363b6426963SNate Lawson acpi_pcpu_get_id(uint32_t idx, uint32_t *acpi_id, uint32_t *cpu_id) 364b6426963SNate Lawson { 365b6426963SNate Lawson struct pcpu *pcpu_data; 366b6426963SNate Lawson uint32_t i; 367b6426963SNate Lawson 368b6426963SNate Lawson KASSERT(acpi_id != NULL, ("Null acpi_id")); 369b6426963SNate Lawson KASSERT(cpu_id != NULL, ("Null cpu_id")); 370447a5fa1SJohn Baldwin for (i = 0; i <= mp_maxid; i++) { 371b6426963SNate Lawson if (CPU_ABSENT(i)) 372b6426963SNate Lawson continue; 373b6426963SNate Lawson pcpu_data = pcpu_find(i); 374b6426963SNate Lawson KASSERT(pcpu_data != NULL, ("no pcpu data for %d", i)); 375b6426963SNate Lawson if (idx-- == 0) { 376b6426963SNate Lawson /* 377b6426963SNate Lawson * If pc_acpi_id was not initialized (e.g., a non-APIC UP box) 378b6426963SNate Lawson * override it with the value from the ASL. Otherwise, if the 379b6426963SNate Lawson * two don't match, prefer the MADT-derived value. Finally, 380b6426963SNate Lawson * return the pc_cpuid to reference this processor. 381b6426963SNate Lawson */ 382b6426963SNate Lawson if (pcpu_data->pc_acpi_id == 0xffffffff) 383b6426963SNate Lawson pcpu_data->pc_acpi_id = *acpi_id; 384b6426963SNate Lawson else if (pcpu_data->pc_acpi_id != *acpi_id) 385b6426963SNate Lawson *acpi_id = pcpu_data->pc_acpi_id; 386b6426963SNate Lawson *cpu_id = pcpu_data->pc_cpuid; 387b6426963SNate Lawson return (0); 388b6426963SNate Lawson } 389b6426963SNate Lawson } 390b6426963SNate Lawson 391b6426963SNate Lawson return (ESRCH); 392b6426963SNate Lawson } 393b6426963SNate Lawson 39498aa9cd0SNate Lawson static struct resource_list * 39598aa9cd0SNate Lawson acpi_cpu_get_rlist(device_t dev, device_t child) 39698aa9cd0SNate Lawson { 39798aa9cd0SNate Lawson struct acpi_cpu_device *ad; 39898aa9cd0SNate Lawson 39998aa9cd0SNate Lawson ad = device_get_ivars(child); 40098aa9cd0SNate Lawson if (ad == NULL) 40198aa9cd0SNate Lawson return (NULL); 40298aa9cd0SNate Lawson return (&ad->ad_rl); 40398aa9cd0SNate Lawson } 40498aa9cd0SNate Lawson 40598aa9cd0SNate Lawson static device_t 40698aa9cd0SNate Lawson acpi_cpu_add_child(device_t dev, int order, const char *name, int unit) 40798aa9cd0SNate Lawson { 40898aa9cd0SNate Lawson struct acpi_cpu_device *ad; 40998aa9cd0SNate Lawson device_t child; 41098aa9cd0SNate Lawson 41198aa9cd0SNate Lawson if ((ad = malloc(sizeof(*ad), M_TEMP, M_NOWAIT | M_ZERO)) == NULL) 41298aa9cd0SNate Lawson return (NULL); 41398aa9cd0SNate Lawson 41498aa9cd0SNate Lawson resource_list_init(&ad->ad_rl); 41598aa9cd0SNate Lawson 41698aa9cd0SNate Lawson child = device_add_child_ordered(dev, order, name, unit); 41798aa9cd0SNate Lawson if (child != NULL) 41898aa9cd0SNate Lawson device_set_ivars(child, ad); 41998aa9cd0SNate Lawson return (child); 42098aa9cd0SNate Lawson } 42198aa9cd0SNate Lawson 42298aa9cd0SNate Lawson static int 42398aa9cd0SNate Lawson acpi_cpu_read_ivar(device_t dev, device_t child, int index, uintptr_t *result) 42498aa9cd0SNate Lawson { 42598aa9cd0SNate Lawson struct acpi_cpu_softc *sc; 42698aa9cd0SNate Lawson 42798aa9cd0SNate Lawson sc = device_get_softc(dev); 42898aa9cd0SNate Lawson switch (index) { 42998aa9cd0SNate Lawson case ACPI_IVAR_HANDLE: 43098aa9cd0SNate Lawson *result = (uintptr_t)sc->cpu_handle; 43198aa9cd0SNate Lawson break; 43298aa9cd0SNate Lawson case CPU_IVAR_PCPU: 43398aa9cd0SNate Lawson *result = (uintptr_t)sc->cpu_pcpu; 43498aa9cd0SNate Lawson break; 43598aa9cd0SNate Lawson default: 43698aa9cd0SNate Lawson return (ENOENT); 43798aa9cd0SNate Lawson } 43898aa9cd0SNate Lawson return (0); 43998aa9cd0SNate Lawson } 44098aa9cd0SNate Lawson 4416b74f9b7SNate Lawson static int 44256a70eadSNate Lawson acpi_cpu_shutdown(device_t dev) 44356a70eadSNate Lawson { 44456a70eadSNate Lawson ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 44556a70eadSNate Lawson 44698aa9cd0SNate Lawson /* Allow children to shutdown first. */ 44798aa9cd0SNate Lawson bus_generic_shutdown(dev); 44898aa9cd0SNate Lawson 44956a70eadSNate Lawson /* Disable any entry to the idle function. */ 45056a70eadSNate Lawson cpu_cx_count = 0; 45156a70eadSNate Lawson 452a2afe45aSNate Lawson /* Signal and wait for all processors to exit acpi_cpu_idle(). */ 45356a70eadSNate Lawson smp_rendezvous(NULL, NULL, NULL, NULL); 45456a70eadSNate Lawson 45556a70eadSNate Lawson return_VALUE (0); 45656a70eadSNate Lawson } 45756a70eadSNate Lawson 45856a70eadSNate Lawson static int 4596b74f9b7SNate Lawson acpi_cpu_throttle_probe(struct acpi_cpu_softc *sc) 4606b74f9b7SNate Lawson { 4616b74f9b7SNate Lawson uint32_t duty_end; 4626b74f9b7SNate Lawson ACPI_BUFFER buf; 4636b74f9b7SNate Lawson ACPI_OBJECT obj; 4646b74f9b7SNate Lawson ACPI_GENERIC_ADDRESS gas; 4656b74f9b7SNate Lawson ACPI_STATUS status; 4666b74f9b7SNate Lawson 4676b74f9b7SNate Lawson ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 4686b74f9b7SNate Lawson 4696b74f9b7SNate Lawson /* Get throttling parameters from the FADT. 0 means not supported. */ 47056a70eadSNate Lawson if (device_get_unit(sc->cpu_dev) == 0) { 4716b74f9b7SNate Lawson cpu_smi_cmd = AcpiGbl_FADT->SmiCmd; 4726b74f9b7SNate Lawson cpu_pstate_cnt = AcpiGbl_FADT->PstateCnt; 47356a70eadSNate Lawson cpu_cst_cnt = AcpiGbl_FADT->CstCnt; 4746b74f9b7SNate Lawson cpu_duty_offset = AcpiGbl_FADT->DutyOffset; 4756b74f9b7SNate Lawson cpu_duty_width = AcpiGbl_FADT->DutyWidth; 47656a70eadSNate Lawson } 4776b74f9b7SNate Lawson if (cpu_duty_width == 0 || (cpu_quirks & CPU_QUIRK_NO_THROTTLE) != 0) 4786b74f9b7SNate Lawson return (ENXIO); 4796b74f9b7SNate Lawson 4806b74f9b7SNate Lawson /* Validate the duty offset/width. */ 4816b74f9b7SNate Lawson duty_end = cpu_duty_offset + cpu_duty_width - 1; 4826b74f9b7SNate Lawson if (duty_end > 31) { 4836b74f9b7SNate Lawson device_printf(sc->cpu_dev, "CLK_VAL field overflows P_CNT register\n"); 4846b74f9b7SNate Lawson return (ENXIO); 4856b74f9b7SNate Lawson } 4866b74f9b7SNate Lawson if (cpu_duty_offset <= 4 && duty_end >= 4) { 4876b74f9b7SNate Lawson device_printf(sc->cpu_dev, "CLK_VAL field overlaps THT_EN bit\n"); 4886b74f9b7SNate Lawson return (ENXIO); 4896b74f9b7SNate Lawson } 4906b74f9b7SNate Lawson 4916b74f9b7SNate Lawson /* 4926b74f9b7SNate Lawson * If not present, fall back to using the processor's P_BLK to find 4936b74f9b7SNate Lawson * the P_CNT register. 4946b74f9b7SNate Lawson * 4956b74f9b7SNate Lawson * Note that some systems seem to duplicate the P_BLK pointer 4966b74f9b7SNate Lawson * across multiple CPUs, so not getting the resource is not fatal. 4976b74f9b7SNate Lawson */ 4986b74f9b7SNate Lawson buf.Pointer = &obj; 4996b74f9b7SNate Lawson buf.Length = sizeof(obj); 5006b74f9b7SNate Lawson status = AcpiEvaluateObject(sc->cpu_handle, "_PTC", NULL, &buf); 5016b74f9b7SNate Lawson if (ACPI_SUCCESS(status)) { 5026b74f9b7SNate Lawson if (obj.Buffer.Length < sizeof(ACPI_GENERIC_ADDRESS) + 3) { 5036b74f9b7SNate Lawson device_printf(sc->cpu_dev, "_PTC buffer too small\n"); 5046b74f9b7SNate Lawson return (ENXIO); 5056b74f9b7SNate Lawson } 5066b74f9b7SNate Lawson memcpy(&gas, obj.Buffer.Pointer + 3, sizeof(gas)); 507f4eb0418SNate Lawson acpi_bus_alloc_gas(sc->cpu_dev, &sc->cpu_p_type, &cpu_rid, &gas, 508f4eb0418SNate Lawson &sc->cpu_p_cnt); 5096b74f9b7SNate Lawson if (sc->cpu_p_cnt != NULL) { 51056a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, "acpi_cpu%d: P_CNT from _PTC\n", 5116b74f9b7SNate Lawson device_get_unit(sc->cpu_dev))); 5126b74f9b7SNate Lawson } 5136b74f9b7SNate Lawson } 5146b74f9b7SNate Lawson 5156b74f9b7SNate Lawson /* If _PTC not present or other failure, try the P_BLK. */ 5166b74f9b7SNate Lawson if (sc->cpu_p_cnt == NULL) { 517c181b89bSNate Lawson /* 518c181b89bSNate Lawson * The spec says P_BLK must be 6 bytes long. However, some 519c181b89bSNate Lawson * systems use it to indicate a fractional set of features 520c181b89bSNate Lawson * present so we take anything >= 4. 521c181b89bSNate Lawson */ 522c181b89bSNate Lawson if (sc->cpu_p_blk_len < 4) 5236b74f9b7SNate Lawson return (ENXIO); 52456a70eadSNate Lawson gas.Address = sc->cpu_p_blk; 5256b74f9b7SNate Lawson gas.AddressSpaceId = ACPI_ADR_SPACE_SYSTEM_IO; 5266b74f9b7SNate Lawson gas.RegisterBitWidth = 32; 527f4eb0418SNate Lawson acpi_bus_alloc_gas(sc->cpu_dev, &sc->cpu_p_type, &cpu_rid, &gas, 528f4eb0418SNate Lawson &sc->cpu_p_cnt); 5296b74f9b7SNate Lawson if (sc->cpu_p_cnt != NULL) { 53056a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, "acpi_cpu%d: P_CNT from P_BLK\n", 5316b74f9b7SNate Lawson device_get_unit(sc->cpu_dev))); 5326b74f9b7SNate Lawson } else { 5336b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Failed to attach throttling P_CNT\n"); 5346b74f9b7SNate Lawson return (ENXIO); 5356b74f9b7SNate Lawson } 5366b74f9b7SNate Lawson } 5376b74f9b7SNate Lawson cpu_rid++; 5386b74f9b7SNate Lawson 5396b74f9b7SNate Lawson return (0); 540fec754d4SMike Smith } 541fec754d4SMike Smith 5426b74f9b7SNate Lawson static int 5436b74f9b7SNate Lawson acpi_cpu_cx_probe(struct acpi_cpu_softc *sc) 5446b74f9b7SNate Lawson { 5456b74f9b7SNate Lawson ACPI_GENERIC_ADDRESS gas; 5466b74f9b7SNate Lawson struct acpi_cx *cx_ptr; 54756a70eadSNate Lawson int error; 54856a70eadSNate Lawson 54956a70eadSNate Lawson ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 5506b74f9b7SNate Lawson 55118ececa0SNate Lawson /* 55218ececa0SNate Lawson * Bus mastering arbitration control is needed to keep caches coherent 553f435261dSNate Lawson * while sleeping in C3. If it's not present but a working flush cache 554f435261dSNate Lawson * instruction is present, flush the caches before entering C3 instead. 555f435261dSNate Lawson * Otherwise, just disable C3 completely. 55618ececa0SNate Lawson */ 5576b74f9b7SNate Lawson if (AcpiGbl_FADT->V1_Pm2CntBlk == 0 || AcpiGbl_FADT->Pm2CntLen == 0) { 558f435261dSNate Lawson if (AcpiGbl_FADT->WbInvd && AcpiGbl_FADT->WbInvdFlush == 0) { 55918ececa0SNate Lawson cpu_quirks |= CPU_QUIRK_NO_BM_CTRL; 56056a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, 56118ececa0SNate Lawson "acpi_cpu%d: no BM control, using flush cache method\n", 56256a70eadSNate Lawson device_get_unit(sc->cpu_dev))); 563f435261dSNate Lawson } else { 564f435261dSNate Lawson cpu_quirks |= CPU_QUIRK_NO_C3; 565f435261dSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, 566f435261dSNate Lawson "acpi_cpu%d: no BM control, C3 not available\n", 567f435261dSNate Lawson device_get_unit(sc->cpu_dev))); 568f435261dSNate Lawson } 569fec754d4SMike Smith } 570fec754d4SMike Smith 571fec754d4SMike Smith /* 5726b74f9b7SNate Lawson * First, check for the ACPI 2.0 _CST sleep states object. 5736b74f9b7SNate Lawson * If not usable, fall back to the P_BLK's P_LVL2 and P_LVL3. 574fec754d4SMike Smith */ 57556a70eadSNate Lawson sc->cpu_cx_count = 0; 5766b74f9b7SNate Lawson error = acpi_cpu_cx_cst(sc); 5776b74f9b7SNate Lawson if (error != 0) { 5786b74f9b7SNate Lawson cx_ptr = sc->cpu_cx_states; 579fec754d4SMike Smith 5806b74f9b7SNate Lawson /* C1 has been required since just after ACPI 1.0 */ 5816b74f9b7SNate Lawson cx_ptr->type = ACPI_STATE_C1; 5826b74f9b7SNate Lawson cx_ptr->trans_lat = 0; 5836b74f9b7SNate Lawson cpu_non_c3 = 0; 5846b74f9b7SNate Lawson cx_ptr++; 58556a70eadSNate Lawson sc->cpu_cx_count++; 58656a70eadSNate Lawson 587c181b89bSNate Lawson /* 588c181b89bSNate Lawson * The spec says P_BLK must be 6 bytes long. However, some systems 589c181b89bSNate Lawson * use it to indicate a fractional set of features present so we 590c181b89bSNate Lawson * take 5 as C2. Some may also have a value of 7 to indicate 591c181b89bSNate Lawson * another C3 but most use _CST for this (as required) and having 592c181b89bSNate Lawson * "only" C1-C3 is not a hardship. 593c181b89bSNate Lawson */ 594c181b89bSNate Lawson if (sc->cpu_p_blk_len < 5) 59556a70eadSNate Lawson goto done; 596fec754d4SMike Smith 5976b74f9b7SNate Lawson /* Validate and allocate resources for C2 (P_LVL2). */ 5986b74f9b7SNate Lawson gas.AddressSpaceId = ACPI_ADR_SPACE_SYSTEM_IO; 5996b74f9b7SNate Lawson gas.RegisterBitWidth = 8; 600e5ada020SNate Lawson if (AcpiGbl_FADT->Plvl2Lat <= 100) { 60156a70eadSNate Lawson gas.Address = sc->cpu_p_blk + 4; 602f4eb0418SNate Lawson acpi_bus_alloc_gas(sc->cpu_dev, &cx_ptr->res_type, &cpu_rid, &gas, 603f4eb0418SNate Lawson &cx_ptr->p_lvlx); 6046b74f9b7SNate Lawson if (cx_ptr->p_lvlx != NULL) { 6056b74f9b7SNate Lawson cpu_rid++; 6066b74f9b7SNate Lawson cx_ptr->type = ACPI_STATE_C2; 6076b74f9b7SNate Lawson cx_ptr->trans_lat = AcpiGbl_FADT->Plvl2Lat; 6086b74f9b7SNate Lawson cpu_non_c3 = 1; 6096b74f9b7SNate Lawson cx_ptr++; 61056a70eadSNate Lawson sc->cpu_cx_count++; 611fec754d4SMike Smith } 612fec754d4SMike Smith } 613c181b89bSNate Lawson if (sc->cpu_p_blk_len < 6) 614c181b89bSNate Lawson goto done; 615be2b1797SNate Lawson 6166b74f9b7SNate Lawson /* Validate and allocate resources for C3 (P_LVL3). */ 617e5ada020SNate Lawson if (AcpiGbl_FADT->Plvl3Lat <= 1000 && 6186b74f9b7SNate Lawson (cpu_quirks & CPU_QUIRK_NO_C3) == 0) { 61956a70eadSNate Lawson gas.Address = sc->cpu_p_blk + 5; 620f4eb0418SNate Lawson acpi_bus_alloc_gas(sc->cpu_dev, &cx_ptr->res_type, &cpu_rid, &gas, 621f4eb0418SNate Lawson &cx_ptr->p_lvlx); 6226b74f9b7SNate Lawson if (cx_ptr->p_lvlx != NULL) { 6236b74f9b7SNate Lawson cpu_rid++; 6246b74f9b7SNate Lawson cx_ptr->type = ACPI_STATE_C3; 6256b74f9b7SNate Lawson cx_ptr->trans_lat = AcpiGbl_FADT->Plvl3Lat; 6266b74f9b7SNate Lawson cx_ptr++; 62756a70eadSNate Lawson sc->cpu_cx_count++; 6286b74f9b7SNate Lawson } 6296b74f9b7SNate Lawson } 6306b74f9b7SNate Lawson } 6316b74f9b7SNate Lawson 63256a70eadSNate Lawson done: 6336b74f9b7SNate Lawson /* If no valid registers were found, don't attach. */ 63456a70eadSNate Lawson if (sc->cpu_cx_count == 0) 6356b74f9b7SNate Lawson return (ENXIO); 6366b74f9b7SNate Lawson 637a2afe45aSNate Lawson /* Use initial sleep value of 1 sec. to start with lowest idle state. */ 638a2afe45aSNate Lawson sc->cpu_prev_sleep = 1000000; 639a2afe45aSNate Lawson 6406b74f9b7SNate Lawson return (0); 6416b74f9b7SNate Lawson } 6426b74f9b7SNate Lawson 6436b74f9b7SNate Lawson /* 6446b74f9b7SNate Lawson * Parse a _CST package and set up its Cx states. Since the _CST object 6456b74f9b7SNate Lawson * can change dynamically, our notify handler may call this function 6466b74f9b7SNate Lawson * to clean up and probe the new _CST package. 6476b74f9b7SNate Lawson */ 6486b74f9b7SNate Lawson static int 6496b74f9b7SNate Lawson acpi_cpu_cx_cst(struct acpi_cpu_softc *sc) 6506b74f9b7SNate Lawson { 6516b74f9b7SNate Lawson struct acpi_cx *cx_ptr; 6526b74f9b7SNate Lawson ACPI_STATUS status; 6536b74f9b7SNate Lawson ACPI_BUFFER buf; 6546b74f9b7SNate Lawson ACPI_OBJECT *top; 6556b74f9b7SNate Lawson ACPI_OBJECT *pkg; 6566b74f9b7SNate Lawson uint32_t count; 6576b74f9b7SNate Lawson int i; 6586b74f9b7SNate Lawson 65956a70eadSNate Lawson ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 66056a70eadSNate Lawson 6616b74f9b7SNate Lawson buf.Pointer = NULL; 6626b74f9b7SNate Lawson buf.Length = ACPI_ALLOCATE_BUFFER; 6636b74f9b7SNate Lawson status = AcpiEvaluateObject(sc->cpu_handle, "_CST", NULL, &buf); 6646b74f9b7SNate Lawson if (ACPI_FAILURE(status)) 6656b74f9b7SNate Lawson return (ENXIO); 6666b74f9b7SNate Lawson 6676b74f9b7SNate Lawson /* _CST is a package with a count and at least one Cx package. */ 6686b74f9b7SNate Lawson top = (ACPI_OBJECT *)buf.Pointer; 66921cea91fSNate Lawson if (!ACPI_PKG_VALID(top, 2) || acpi_PkgInt32(top, 0, &count) != 0) { 6706b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Invalid _CST package\n"); 6716b74f9b7SNate Lawson AcpiOsFree(buf.Pointer); 6726b74f9b7SNate Lawson return (ENXIO); 6736b74f9b7SNate Lawson } 6746b74f9b7SNate Lawson if (count != top->Package.Count - 1) { 6756b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Invalid _CST state count (%d != %d)\n", 6766b74f9b7SNate Lawson count, top->Package.Count - 1); 6776b74f9b7SNate Lawson count = top->Package.Count - 1; 6786b74f9b7SNate Lawson } 6796b74f9b7SNate Lawson if (count > MAX_CX_STATES) { 68056a70eadSNate Lawson device_printf(sc->cpu_dev, "_CST has too many states (%d)\n", count); 6816b74f9b7SNate Lawson count = MAX_CX_STATES; 6826b74f9b7SNate Lawson } 6836b74f9b7SNate Lawson 6846b74f9b7SNate Lawson /* Set up all valid states. */ 68556a70eadSNate Lawson sc->cpu_cx_count = 0; 6866b74f9b7SNate Lawson cx_ptr = sc->cpu_cx_states; 6876b74f9b7SNate Lawson for (i = 0; i < count; i++) { 6886b74f9b7SNate Lawson pkg = &top->Package.Elements[i + 1]; 68921cea91fSNate Lawson if (!ACPI_PKG_VALID(pkg, 4) || 69021cea91fSNate Lawson acpi_PkgInt32(pkg, 1, &cx_ptr->type) != 0 || 69121cea91fSNate Lawson acpi_PkgInt32(pkg, 2, &cx_ptr->trans_lat) != 0 || 69221cea91fSNate Lawson acpi_PkgInt32(pkg, 3, &cx_ptr->power) != 0) { 69321cea91fSNate Lawson 6946b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Skipping invalid Cx state package\n"); 6956b74f9b7SNate Lawson continue; 6966b74f9b7SNate Lawson } 6976b74f9b7SNate Lawson 6986b74f9b7SNate Lawson /* Validate the state to see if we should use it. */ 6996b74f9b7SNate Lawson switch (cx_ptr->type) { 7006b74f9b7SNate Lawson case ACPI_STATE_C1: 7016b74f9b7SNate Lawson cpu_non_c3 = i; 7026b74f9b7SNate Lawson cx_ptr++; 70356a70eadSNate Lawson sc->cpu_cx_count++; 7046b74f9b7SNate Lawson continue; 7056b74f9b7SNate Lawson case ACPI_STATE_C2: 7066b74f9b7SNate Lawson if (cx_ptr->trans_lat > 100) { 70756a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, 70856a70eadSNate Lawson "acpi_cpu%d: C2[%d] not available.\n", 70956a70eadSNate Lawson device_get_unit(sc->cpu_dev), i)); 7106b74f9b7SNate Lawson continue; 7116b74f9b7SNate Lawson } 7126b74f9b7SNate Lawson cpu_non_c3 = i; 7136b74f9b7SNate Lawson break; 7146b74f9b7SNate Lawson case ACPI_STATE_C3: 7156b74f9b7SNate Lawson default: 7166b74f9b7SNate Lawson if (cx_ptr->trans_lat > 1000 || 7176b74f9b7SNate Lawson (cpu_quirks & CPU_QUIRK_NO_C3) != 0) { 7186b74f9b7SNate Lawson 71956a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, 72056a70eadSNate Lawson "acpi_cpu%d: C3[%d] not available.\n", 72156a70eadSNate Lawson device_get_unit(sc->cpu_dev), i)); 7226b74f9b7SNate Lawson continue; 7236b74f9b7SNate Lawson } 7246b74f9b7SNate Lawson break; 7256b74f9b7SNate Lawson } 7266b74f9b7SNate Lawson 7276b74f9b7SNate Lawson #ifdef notyet 7286b74f9b7SNate Lawson /* Free up any previous register. */ 7296b74f9b7SNate Lawson if (cx_ptr->p_lvlx != NULL) { 7306b74f9b7SNate Lawson bus_release_resource(sc->cpu_dev, 0, 0, cx_ptr->p_lvlx); 7316b74f9b7SNate Lawson cx_ptr->p_lvlx = NULL; 7326b74f9b7SNate Lawson } 7336b74f9b7SNate Lawson #endif 7346b74f9b7SNate Lawson 7356b74f9b7SNate Lawson /* Allocate the control register for C2 or C3. */ 736f4eb0418SNate Lawson acpi_PkgGas(sc->cpu_dev, pkg, 0, &cx_ptr->res_type, &cpu_rid, 737f4eb0418SNate Lawson &cx_ptr->p_lvlx); 738f4eb0418SNate Lawson if (cx_ptr->p_lvlx) { 7396b74f9b7SNate Lawson cpu_rid++; 74056a70eadSNate Lawson ACPI_DEBUG_PRINT((ACPI_DB_INFO, 74156a70eadSNate Lawson "acpi_cpu%d: Got C%d - %d latency\n", 74256a70eadSNate Lawson device_get_unit(sc->cpu_dev), cx_ptr->type, 74356a70eadSNate Lawson cx_ptr->trans_lat)); 7446b74f9b7SNate Lawson cx_ptr++; 74556a70eadSNate Lawson sc->cpu_cx_count++; 7466b74f9b7SNate Lawson } 7476b74f9b7SNate Lawson } 7486b74f9b7SNate Lawson AcpiOsFree(buf.Pointer); 7496b74f9b7SNate Lawson 7506b74f9b7SNate Lawson return (0); 751fec754d4SMike Smith } 752fec754d4SMike Smith 753fec754d4SMike Smith /* 754fec754d4SMike Smith * Call this *after* all CPUs have been attached. 755fec754d4SMike Smith */ 756fec754d4SMike Smith static void 7576b74f9b7SNate Lawson acpi_cpu_startup(void *arg) 758fec754d4SMike Smith { 75956a70eadSNate Lawson struct acpi_cpu_softc *sc; 76056a70eadSNate Lawson int count, i; 761fec754d4SMike Smith 762be2b1797SNate Lawson /* Get set of CPU devices */ 76398aa9cd0SNate Lawson devclass_get_devices(cpu_devclass, &cpu_devices, &cpu_ndevices); 764fec754d4SMike Smith 765ae56b59fSNate Lawson /* Check for quirks via the first CPU device. */ 766ae56b59fSNate Lawson sc = device_get_softc(cpu_devices[0]); 767ae56b59fSNate Lawson acpi_cpu_quirks(sc); 768ae56b59fSNate Lawson 76956a70eadSNate Lawson /* 77056a70eadSNate Lawson * Make sure all the processors' Cx counts match. We should probably 77156a70eadSNate Lawson * also check the contents of each. However, no known systems have 77256a70eadSNate Lawson * non-matching Cx counts so we'll deal with this later. 77356a70eadSNate Lawson */ 77456a70eadSNate Lawson count = MAX_CX_STATES; 77556a70eadSNate Lawson for (i = 0; i < cpu_ndevices; i++) { 77656a70eadSNate Lawson sc = device_get_softc(cpu_devices[i]); 77756a70eadSNate Lawson count = min(sc->cpu_cx_count, count); 77856a70eadSNate Lawson } 77956a70eadSNate Lawson cpu_cx_count = count; 78056a70eadSNate Lawson 78156a70eadSNate Lawson /* Perform throttling and Cx final initialization. */ 78256a70eadSNate Lawson sc = device_get_softc(cpu_devices[0]); 7836b74f9b7SNate Lawson if (sc->cpu_p_cnt != NULL) 7846b74f9b7SNate Lawson acpi_cpu_startup_throttling(); 78556a70eadSNate Lawson if (cpu_cx_count > 0) 78656a70eadSNate Lawson acpi_cpu_startup_cx(); 7876b74f9b7SNate Lawson } 7886b74f9b7SNate Lawson 78956a70eadSNate Lawson /* 79056a70eadSNate Lawson * Takes the ACPI lock to avoid fighting anyone over the SMI command 79156a70eadSNate Lawson * port. 79256a70eadSNate Lawson */ 7936b74f9b7SNate Lawson static void 7946b74f9b7SNate Lawson acpi_cpu_startup_throttling() 7956b74f9b7SNate Lawson { 7966b74f9b7SNate Lawson 797ae56b59fSNate Lawson /* If throttling is not usable, don't initialize it. */ 798ae56b59fSNate Lawson if (cpu_quirks & CPU_QUIRK_NO_THROTTLE) 799ae56b59fSNate Lawson return; 800ae56b59fSNate Lawson 801be2b1797SNate Lawson /* Initialise throttling states */ 8020d8fb61aSNate Lawson cpu_throttle_max = CPU_MAX_SPEED; 8030d8fb61aSNate Lawson cpu_throttle_state = CPU_MAX_SPEED; 804be2b1797SNate Lawson 80556a70eadSNate Lawson SYSCTL_ADD_INT(&acpi_cpu_sysctl_ctx, 80656a70eadSNate Lawson SYSCTL_CHILDREN(acpi_cpu_sysctl_tree), 8070d8fb61aSNate Lawson OID_AUTO, "throttle_max", CTLFLAG_RD, 8080d8fb61aSNate Lawson &cpu_throttle_max, 0, "maximum CPU speed"); 80956a70eadSNate Lawson SYSCTL_ADD_PROC(&acpi_cpu_sysctl_ctx, 81056a70eadSNate Lawson SYSCTL_CHILDREN(acpi_cpu_sysctl_tree), 8110d8fb61aSNate Lawson OID_AUTO, "throttle_state", 8120d8fb61aSNate Lawson CTLTYPE_INT | CTLFLAG_RW, &cpu_throttle_state, 8130d8fb61aSNate Lawson 0, acpi_cpu_throttle_sysctl, "I", "current CPU speed"); 814fec754d4SMike Smith 81556a70eadSNate Lawson /* If ACPI 2.0+, signal platform that we are taking over throttling. */ 816d92a2ebdSNate Lawson if (cpu_pstate_cnt != 0) { 817d92a2ebdSNate Lawson ACPI_LOCK(acpi); 81856a70eadSNate Lawson AcpiOsWritePort(cpu_smi_cmd, cpu_pstate_cnt, 8); 819d92a2ebdSNate Lawson ACPI_UNLOCK(acpi); 820d92a2ebdSNate Lawson } 821fec754d4SMike Smith 8220d8fb61aSNate Lawson /* Set initial speed to maximum. */ 823d92a2ebdSNate Lawson ACPI_SERIAL_BEGIN(cpu); 8240d8fb61aSNate Lawson acpi_cpu_throttle_set(cpu_throttle_max); 825d92a2ebdSNate Lawson ACPI_SERIAL_END(cpu); 826fec754d4SMike Smith 827a40f20c7SNate Lawson printf("acpi_cpu: throttling enabled, %d steps (100%% to %d.%d%%), " 828a40f20c7SNate Lawson "currently %d.%d%%\n", CPU_MAX_SPEED, CPU_SPEED_PRINTABLE(1), 8290d8fb61aSNate Lawson CPU_SPEED_PRINTABLE(cpu_throttle_state)); 830fec754d4SMike Smith } 831fec754d4SMike Smith 83256a70eadSNate Lawson static void 83356a70eadSNate Lawson acpi_cpu_startup_cx() 83456a70eadSNate Lawson { 83556a70eadSNate Lawson struct acpi_cpu_softc *sc; 83656a70eadSNate Lawson struct sbuf sb; 83756a70eadSNate Lawson int i; 83856a70eadSNate Lawson 839ae56b59fSNate Lawson /* 840ae56b59fSNate Lawson * Set up the list of Cx states, eliminating C3 states by truncating 841ae56b59fSNate Lawson * cpu_cx_count if quirks indicate C3 is not usable. 842ae56b59fSNate Lawson */ 84356a70eadSNate Lawson sc = device_get_softc(cpu_devices[0]); 84456a70eadSNate Lawson sbuf_new(&sb, cpu_cx_supported, sizeof(cpu_cx_supported), SBUF_FIXEDLEN); 845ae56b59fSNate Lawson for (i = 0; i < cpu_cx_count; i++) { 846ae56b59fSNate Lawson if ((cpu_quirks & CPU_QUIRK_NO_C3) == 0 || 847ae56b59fSNate Lawson sc->cpu_cx_states[i].type != ACPI_STATE_C3) 848ccc09458SNate Lawson sbuf_printf(&sb, "C%d/%d ", i + 1, sc->cpu_cx_states[i].trans_lat); 849ae56b59fSNate Lawson else 850ae56b59fSNate Lawson cpu_cx_count = i; 851ae56b59fSNate Lawson } 85256a70eadSNate Lawson sbuf_trim(&sb); 85356a70eadSNate Lawson sbuf_finish(&sb); 85456a70eadSNate Lawson SYSCTL_ADD_STRING(&acpi_cpu_sysctl_ctx, 85556a70eadSNate Lawson SYSCTL_CHILDREN(acpi_cpu_sysctl_tree), 85656a70eadSNate Lawson OID_AUTO, "cx_supported", CTLFLAG_RD, cpu_cx_supported, 85756a70eadSNate Lawson 0, "Cx/microsecond values for supported Cx states"); 85856a70eadSNate Lawson SYSCTL_ADD_PROC(&acpi_cpu_sysctl_ctx, 85956a70eadSNate Lawson SYSCTL_CHILDREN(acpi_cpu_sysctl_tree), 860ccc09458SNate Lawson OID_AUTO, "cx_lowest", CTLTYPE_STRING | CTLFLAG_RW, 861ccc09458SNate Lawson NULL, 0, acpi_cpu_cx_lowest_sysctl, "A", 86256a70eadSNate Lawson "lowest Cx sleep state to use"); 86356a70eadSNate Lawson SYSCTL_ADD_PROC(&acpi_cpu_sysctl_ctx, 86456a70eadSNate Lawson SYSCTL_CHILDREN(acpi_cpu_sysctl_tree), 865a2afe45aSNate Lawson OID_AUTO, "cx_usage", CTLTYPE_STRING | CTLFLAG_RD, 866a2afe45aSNate Lawson NULL, 0, acpi_cpu_usage_sysctl, "A", 867a2afe45aSNate Lawson "percent usage for each Cx state"); 86856a70eadSNate Lawson 86956a70eadSNate Lawson #ifdef notyet 87056a70eadSNate Lawson /* Signal platform that we can handle _CST notification. */ 87156a70eadSNate Lawson if (cpu_cst_cnt != 0) { 872d92a2ebdSNate Lawson ACPI_LOCK(acpi); 87356a70eadSNate Lawson AcpiOsWritePort(cpu_smi_cmd, cpu_cst_cnt, 8); 874d92a2ebdSNate Lawson ACPI_UNLOCK(acpi); 87556a70eadSNate Lawson } 87656a70eadSNate Lawson #endif 87756a70eadSNate Lawson 87856a70eadSNate Lawson /* Take over idling from cpu_idle_default(). */ 87956a70eadSNate Lawson cpu_idle_hook = acpi_cpu_idle; 88056a70eadSNate Lawson } 88156a70eadSNate Lawson 882fec754d4SMike Smith /* 883fec754d4SMike Smith * Set CPUs to the new state. 884fec754d4SMike Smith * 885fec754d4SMike Smith * Must be called with the ACPI lock held. 886fec754d4SMike Smith */ 887fec754d4SMike Smith static void 8886b74f9b7SNate Lawson acpi_cpu_throttle_set(uint32_t speed) 889fec754d4SMike Smith { 890fec754d4SMike Smith struct acpi_cpu_softc *sc; 891fec754d4SMike Smith int i; 8926b74f9b7SNate Lawson uint32_t p_cnt, clk_val; 893fec754d4SMike Smith 894d92a2ebdSNate Lawson ACPI_SERIAL_ASSERT(cpu); 895fec754d4SMike Smith 896be2b1797SNate Lawson /* Iterate over processors */ 897fec754d4SMike Smith for (i = 0; i < cpu_ndevices; i++) { 898fec754d4SMike Smith sc = device_get_softc(cpu_devices[i]); 8996b74f9b7SNate Lawson if (sc->cpu_p_cnt == NULL) 900fec754d4SMike Smith continue; 901fec754d4SMike Smith 902be2b1797SNate Lawson /* Get the current P_CNT value and disable throttling */ 9036b74f9b7SNate Lawson p_cnt = CPU_GET_REG(sc->cpu_p_cnt, 4); 904fec754d4SMike Smith p_cnt &= ~CPU_P_CNT_THT_EN; 9056b74f9b7SNate Lawson CPU_SET_REG(sc->cpu_p_cnt, 4, p_cnt); 906fec754d4SMike Smith 907be2b1797SNate Lawson /* If we're at maximum speed, that's all */ 908fec754d4SMike Smith if (speed < CPU_MAX_SPEED) { 909be2b1797SNate Lawson /* Mask the old CLK_VAL off and or-in the new value */ 910b279c35aSNate Lawson clk_val = (CPU_MAX_SPEED - 1) << cpu_duty_offset; 911fec754d4SMike Smith p_cnt &= ~clk_val; 912fec754d4SMike Smith p_cnt |= (speed << cpu_duty_offset); 913fec754d4SMike Smith 914be2b1797SNate Lawson /* Write the new P_CNT value and then enable throttling */ 9156b74f9b7SNate Lawson CPU_SET_REG(sc->cpu_p_cnt, 4, p_cnt); 916fec754d4SMike Smith p_cnt |= CPU_P_CNT_THT_EN; 9176b74f9b7SNate Lawson CPU_SET_REG(sc->cpu_p_cnt, 4, p_cnt); 918fec754d4SMike Smith } 9196971b3c7SMitsuru IWASAKI ACPI_VPRINT(sc->cpu_dev, acpi_device_get_parent_softc(sc->cpu_dev), 9206971b3c7SMitsuru IWASAKI "set speed to %d.%d%%\n", CPU_SPEED_PRINTABLE(speed)); 921fec754d4SMike Smith } 9220d8fb61aSNate Lawson cpu_throttle_state = speed; 923fec754d4SMike Smith } 924fec754d4SMike Smith 925fec754d4SMike Smith /* 926a2afe45aSNate Lawson * Idle the CPU in the lowest state possible. This function is called with 927a2afe45aSNate Lawson * interrupts disabled. Note that once it re-enables interrupts, a task 928a2afe45aSNate Lawson * switch can occur so do not access shared data (i.e. the softc) after 929a2afe45aSNate Lawson * interrupts are re-enabled. 9306b74f9b7SNate Lawson */ 9316b74f9b7SNate Lawson static void 9326b74f9b7SNate Lawson acpi_cpu_idle() 9336b74f9b7SNate Lawson { 9346b74f9b7SNate Lawson struct acpi_cpu_softc *sc; 93556a70eadSNate Lawson struct acpi_cx *cx_next; 9366b74f9b7SNate Lawson uint32_t start_time, end_time; 937a2afe45aSNate Lawson int bm_active, cx_next_idx, i; 9386b74f9b7SNate Lawson 9396b74f9b7SNate Lawson /* If disabled, return immediately. */ 94056a70eadSNate Lawson if (cpu_cx_count == 0) { 9416b74f9b7SNate Lawson ACPI_ENABLE_IRQS(); 9426b74f9b7SNate Lawson return; 9436b74f9b7SNate Lawson } 9446b74f9b7SNate Lawson 945cd1f3db9SNate Lawson /* 946cd1f3db9SNate Lawson * Look up our CPU id to get our softc. If it's NULL, we'll use C1 947cd1f3db9SNate Lawson * since there is no ACPI processor object for this CPU. This occurs 948cd1f3db9SNate Lawson * for logical CPUs in the HTT case. 949cd1f3db9SNate Lawson */ 950cd1f3db9SNate Lawson sc = cpu_softc[PCPU_GET(cpuid)]; 951cd1f3db9SNate Lawson if (sc == NULL) { 952cd1f3db9SNate Lawson acpi_cpu_c1(); 953cd1f3db9SNate Lawson return; 954cd1f3db9SNate Lawson } 955cd1f3db9SNate Lawson 956a2afe45aSNate Lawson /* 957a2afe45aSNate Lawson * If we slept 100 us or more, use the lowest Cx state. Otherwise, 958a2afe45aSNate Lawson * find the lowest state that has a latency less than or equal to 959a2afe45aSNate Lawson * the length of our last sleep. 960a2afe45aSNate Lawson */ 961a2afe45aSNate Lawson cx_next_idx = cpu_cx_lowest; 962a2afe45aSNate Lawson if (sc->cpu_prev_sleep < 100) 963a2afe45aSNate Lawson for (i = cpu_cx_lowest; i >= 0; i--) 964a2afe45aSNate Lawson if (sc->cpu_cx_states[i].trans_lat <= sc->cpu_prev_sleep) { 965a2afe45aSNate Lawson cx_next_idx = i; 966a2afe45aSNate Lawson break; 967a2afe45aSNate Lawson } 96856a70eadSNate Lawson 9696b74f9b7SNate Lawson /* 9706b74f9b7SNate Lawson * Check for bus master activity. If there was activity, clear 9716b74f9b7SNate Lawson * the bit and use the lowest non-C3 state. Note that the USB 9726b74f9b7SNate Lawson * driver polling for new devices keeps this bit set all the 973f435261dSNate Lawson * time if USB is loaded. 9746b74f9b7SNate Lawson */ 97518ececa0SNate Lawson if ((cpu_quirks & CPU_QUIRK_NO_BM_CTRL) == 0) { 9766b74f9b7SNate Lawson AcpiGetRegister(ACPI_BITREG_BUS_MASTER_STATUS, &bm_active, 9776b74f9b7SNate Lawson ACPI_MTX_DO_NOT_LOCK); 9786b74f9b7SNate Lawson if (bm_active != 0) { 9796b74f9b7SNate Lawson AcpiSetRegister(ACPI_BITREG_BUS_MASTER_STATUS, 1, 9806b74f9b7SNate Lawson ACPI_MTX_DO_NOT_LOCK); 981a2afe45aSNate Lawson cx_next_idx = min(cx_next_idx, cpu_non_c3); 9826b74f9b7SNate Lawson } 983f435261dSNate Lawson } 9846b74f9b7SNate Lawson 985a2afe45aSNate Lawson /* Select the next state and update statistics. */ 986a2afe45aSNate Lawson cx_next = &sc->cpu_cx_states[cx_next_idx]; 987a2afe45aSNate Lawson cpu_cx_stats[cx_next_idx]++; 988a2afe45aSNate Lawson KASSERT(cx_next->type != ACPI_STATE_C0, ("acpi_cpu_idle: C0 sleep")); 9896b74f9b7SNate Lawson 9906b74f9b7SNate Lawson /* 991a2afe45aSNate Lawson * Execute HLT (or equivalent) and wait for an interrupt. We can't 992a2afe45aSNate Lawson * calculate the time spent in C1 since the place we wake up is an 993a2afe45aSNate Lawson * ISR. Assume we slept one quantum and return. 9946b74f9b7SNate Lawson */ 995a2afe45aSNate Lawson if (cx_next->type == ACPI_STATE_C1) { 996a2afe45aSNate Lawson sc->cpu_prev_sleep = 1000000 / hz; 997a2afe45aSNate Lawson acpi_cpu_c1(); 998a2afe45aSNate Lawson return; 999a2afe45aSNate Lawson } 1000a2afe45aSNate Lawson 1001f435261dSNate Lawson /* 1002f435261dSNate Lawson * For C3, disable bus master arbitration and enable bus master wake 1003f435261dSNate Lawson * if BM control is available, otherwise flush the CPU cache. 1004f435261dSNate Lawson */ 1005a2afe45aSNate Lawson if (cx_next->type == ACPI_STATE_C3) { 1006f435261dSNate Lawson if ((cpu_quirks & CPU_QUIRK_NO_BM_CTRL) == 0) { 1007a2afe45aSNate Lawson AcpiSetRegister(ACPI_BITREG_ARB_DISABLE, 1, ACPI_MTX_DO_NOT_LOCK); 1008f435261dSNate Lawson AcpiSetRegister(ACPI_BITREG_BUS_MASTER_RLD, 1, 1009f435261dSNate Lawson ACPI_MTX_DO_NOT_LOCK); 1010f435261dSNate Lawson } else 1011f435261dSNate Lawson ACPI_FLUSH_CPU_CACHE(); 1012a2afe45aSNate Lawson } 1013a2afe45aSNate Lawson 10146b74f9b7SNate Lawson /* 1015a2afe45aSNate Lawson * Read from P_LVLx to enter C2(+), checking time spent asleep. 10166b74f9b7SNate Lawson * Use the ACPI timer for measuring sleep time. Since we need to 10176b74f9b7SNate Lawson * get the time very close to the CPU start/stop clock logic, this 10186b74f9b7SNate Lawson * is the only reliable time source. 10196b74f9b7SNate Lawson */ 10206b74f9b7SNate Lawson AcpiHwLowLevelRead(32, &start_time, &AcpiGbl_FADT->XPmTmrBlk); 10216b74f9b7SNate Lawson CPU_GET_REG(cx_next->p_lvlx, 1); 10226b74f9b7SNate Lawson 10236b74f9b7SNate Lawson /* 10246b74f9b7SNate Lawson * Read the end time twice. Since it may take an arbitrary time 10256b74f9b7SNate Lawson * to enter the idle state, the first read may be executed before 10266b74f9b7SNate Lawson * the processor has stopped. Doing it again provides enough 10276b74f9b7SNate Lawson * margin that we are certain to have a correct value. 10286b74f9b7SNate Lawson */ 10296b74f9b7SNate Lawson AcpiHwLowLevelRead(32, &end_time, &AcpiGbl_FADT->XPmTmrBlk); 10306b74f9b7SNate Lawson AcpiHwLowLevelRead(32, &end_time, &AcpiGbl_FADT->XPmTmrBlk); 10316b74f9b7SNate Lawson 10326b74f9b7SNate Lawson /* Enable bus master arbitration and disable bus master wakeup. */ 103318ececa0SNate Lawson if (cx_next->type == ACPI_STATE_C3 && 103418ececa0SNate Lawson (cpu_quirks & CPU_QUIRK_NO_BM_CTRL) == 0) { 10356b74f9b7SNate Lawson AcpiSetRegister(ACPI_BITREG_ARB_DISABLE, 0, ACPI_MTX_DO_NOT_LOCK); 10366b74f9b7SNate Lawson AcpiSetRegister(ACPI_BITREG_BUS_MASTER_RLD, 0, ACPI_MTX_DO_NOT_LOCK); 10376b74f9b7SNate Lawson } 10386b74f9b7SNate Lawson 10396b74f9b7SNate Lawson /* Find the actual time asleep in microseconds, minus overhead. */ 1040eea17c34SNate Lawson end_time = acpi_TimerDelta(end_time, start_time); 1041a2afe45aSNate Lawson sc->cpu_prev_sleep = PM_USEC(end_time) - cx_next->trans_lat; 1042a2afe45aSNate Lawson ACPI_ENABLE_IRQS(); 10436b74f9b7SNate Lawson } 10446b74f9b7SNate Lawson 10456b74f9b7SNate Lawson /* 10466b74f9b7SNate Lawson * Re-evaluate the _PSS and _CST objects when we are notified that they 10476b74f9b7SNate Lawson * have changed. 104856a70eadSNate Lawson * 10496b74f9b7SNate Lawson * XXX Re-evaluation disabled until locking is done. 10506b74f9b7SNate Lawson */ 10516b74f9b7SNate Lawson static void 10526b74f9b7SNate Lawson acpi_cpu_notify(ACPI_HANDLE h, UINT32 notify, void *context) 10536b74f9b7SNate Lawson { 10546b74f9b7SNate Lawson struct acpi_cpu_softc *sc = (struct acpi_cpu_softc *)context; 10556b74f9b7SNate Lawson 10566b74f9b7SNate Lawson switch (notify) { 10576b74f9b7SNate Lawson case ACPI_CPU_NOTIFY_PERF_STATES: 10586b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Performance states changed\n"); 10596b74f9b7SNate Lawson /* acpi_cpu_px_available(sc); */ 10606b74f9b7SNate Lawson break; 10616b74f9b7SNate Lawson case ACPI_CPU_NOTIFY_CX_STATES: 10626b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Cx states changed\n"); 10636b74f9b7SNate Lawson /* acpi_cpu_cx_cst(sc); */ 10646b74f9b7SNate Lawson break; 10656b74f9b7SNate Lawson default: 10666b74f9b7SNate Lawson device_printf(sc->cpu_dev, "Unknown notify %#x\n", notify); 10676b74f9b7SNate Lawson break; 10686b74f9b7SNate Lawson } 10696b74f9b7SNate Lawson } 10706b74f9b7SNate Lawson 10716b74f9b7SNate Lawson static int 10726b74f9b7SNate Lawson acpi_cpu_quirks(struct acpi_cpu_softc *sc) 10736b74f9b7SNate Lawson { 1074ae56b59fSNate Lawson device_t acpi_dev; 10756b74f9b7SNate Lawson 10766b74f9b7SNate Lawson /* 1077f435261dSNate Lawson * C3 on multiple CPUs requires using the expensive flush cache 1078f435261dSNate Lawson * instruction. 10796b74f9b7SNate Lawson */ 1080447a5fa1SJohn Baldwin if (mp_ncpus > 1) 108118ececa0SNate Lawson cpu_quirks |= CPU_QUIRK_NO_BM_CTRL; 10826b74f9b7SNate Lawson 10836b74f9b7SNate Lawson /* Look for various quirks of the PIIX4 part. */ 10846b74f9b7SNate Lawson acpi_dev = pci_find_device(PCI_VENDOR_INTEL, PCI_DEVICE_82371AB_3); 10856b74f9b7SNate Lawson if (acpi_dev != NULL) { 10866b74f9b7SNate Lawson switch (pci_get_revid(acpi_dev)) { 10876b74f9b7SNate Lawson /* 10886b74f9b7SNate Lawson * Disable throttling control on PIIX4 A and B-step. 10896b74f9b7SNate Lawson * See specification changes #13 ("Manual Throttle Duty Cycle") 10906b74f9b7SNate Lawson * and #14 ("Enabling and Disabling Manual Throttle"), plus 10916b74f9b7SNate Lawson * erratum #5 ("STPCLK# Deassertion Time") from the January 10926b74f9b7SNate Lawson * 2002 PIIX4 specification update. Note that few (if any) 10936b74f9b7SNate Lawson * mobile systems ever used this part. 10946b74f9b7SNate Lawson */ 10956b74f9b7SNate Lawson case PCI_REVISION_A_STEP: 10966b74f9b7SNate Lawson case PCI_REVISION_B_STEP: 10976b74f9b7SNate Lawson cpu_quirks |= CPU_QUIRK_NO_THROTTLE; 10986b74f9b7SNate Lawson /* FALLTHROUGH */ 10996b74f9b7SNate Lawson /* 11006b74f9b7SNate Lawson * Disable C3 support for all PIIX4 chipsets. Some of these parts 11016b74f9b7SNate Lawson * do not report the BMIDE status to the BM status register and 11026b74f9b7SNate Lawson * others have a livelock bug if Type-F DMA is enabled. Linux 11036b74f9b7SNate Lawson * works around the BMIDE bug by reading the BM status directly 11046b74f9b7SNate Lawson * but we take the simpler approach of disabling C3 for these 11056b74f9b7SNate Lawson * parts. 11066b74f9b7SNate Lawson * 11076b74f9b7SNate Lawson * See erratum #18 ("C3 Power State/BMIDE and Type-F DMA 11086b74f9b7SNate Lawson * Livelock") from the January 2002 PIIX4 specification update. 11096b74f9b7SNate Lawson * Applies to all PIIX4 models. 11106b74f9b7SNate Lawson */ 11116b74f9b7SNate Lawson case PCI_REVISION_4E: 11126b74f9b7SNate Lawson case PCI_REVISION_4M: 11136b74f9b7SNate Lawson cpu_quirks |= CPU_QUIRK_NO_C3; 11146b74f9b7SNate Lawson break; 11156b74f9b7SNate Lawson default: 11166b74f9b7SNate Lawson break; 11176b74f9b7SNate Lawson } 11186b74f9b7SNate Lawson } 11196b74f9b7SNate Lawson 11206b74f9b7SNate Lawson return (0); 11216b74f9b7SNate Lawson } 11226b74f9b7SNate Lawson 11230d8fb61aSNate Lawson /* Handle changes in the CPU throttling setting. */ 1124fec754d4SMike Smith static int 11256b74f9b7SNate Lawson acpi_cpu_throttle_sysctl(SYSCTL_HANDLER_ARGS) 1126fec754d4SMike Smith { 11276b74f9b7SNate Lawson uint32_t *argp; 11286b74f9b7SNate Lawson uint32_t arg; 1129fec754d4SMike Smith int error; 1130fec754d4SMike Smith 11316b74f9b7SNate Lawson argp = (uint32_t *)oidp->oid_arg1; 1132fec754d4SMike Smith arg = *argp; 1133fec754d4SMike Smith error = sysctl_handle_int(oidp, &arg, 0, req); 1134fec754d4SMike Smith 1135be2b1797SNate Lawson /* Error or no new value */ 1136be2b1797SNate Lawson if (error != 0 || req->newptr == NULL) 1137fec754d4SMike Smith return (error); 11380d8fb61aSNate Lawson if (arg < 1 || arg > cpu_throttle_max) 1139fec754d4SMike Smith return (EINVAL); 1140fec754d4SMike Smith 11410d8fb61aSNate Lawson /* If throttling changed, notify the BIOS of the new rate. */ 1142d92a2ebdSNate Lawson ACPI_SERIAL_BEGIN(cpu); 11430d8fb61aSNate Lawson if (*argp != arg) { 1144fec754d4SMike Smith *argp = arg; 11450d8fb61aSNate Lawson acpi_cpu_throttle_set(arg); 11460d8fb61aSNate Lawson } 1147d92a2ebdSNate Lawson ACPI_SERIAL_END(cpu); 1148fec754d4SMike Smith 1149fec754d4SMike Smith return (0); 1150fec754d4SMike Smith } 11516b74f9b7SNate Lawson 11526b74f9b7SNate Lawson static int 1153a2afe45aSNate Lawson acpi_cpu_usage_sysctl(SYSCTL_HANDLER_ARGS) 11546b74f9b7SNate Lawson { 11556b74f9b7SNate Lawson struct sbuf sb; 11566b74f9b7SNate Lawson char buf[128]; 11576b74f9b7SNate Lawson int i; 11584a03551dSNate Lawson uintmax_t fract, sum, whole; 11596b74f9b7SNate Lawson 11603e7fa136SNate Lawson sum = 0; 1161a2afe45aSNate Lawson for (i = 0; i < cpu_cx_count; i++) 1162a2afe45aSNate Lawson sum += cpu_cx_stats[i]; 11636b74f9b7SNate Lawson sbuf_new(&sb, buf, sizeof(buf), SBUF_FIXEDLEN); 11643e7fa136SNate Lawson for (i = 0; i < cpu_cx_count; i++) { 11653e7fa136SNate Lawson if (sum > 0) { 11664a03551dSNate Lawson whole = (uintmax_t)cpu_cx_stats[i] * 100; 11673e7fa136SNate Lawson fract = (whole % sum) * 100; 11683e7fa136SNate Lawson sbuf_printf(&sb, "%u.%02u%% ", (u_int)(whole / sum), 11693e7fa136SNate Lawson (u_int)(fract / sum)); 11703e7fa136SNate Lawson } else 11713e7fa136SNate Lawson sbuf_printf(&sb, "0%% "); 11723e7fa136SNate Lawson } 11736b74f9b7SNate Lawson sbuf_trim(&sb); 11746b74f9b7SNate Lawson sbuf_finish(&sb); 1175ccc09458SNate Lawson sysctl_handle_string(oidp, sbuf_data(&sb), sbuf_len(&sb), req); 1176ccc09458SNate Lawson sbuf_delete(&sb); 11776b74f9b7SNate Lawson 11786b74f9b7SNate Lawson return (0); 11796b74f9b7SNate Lawson } 11806b74f9b7SNate Lawson 11816b74f9b7SNate Lawson static int 11826b74f9b7SNate Lawson acpi_cpu_cx_lowest_sysctl(SYSCTL_HANDLER_ARGS) 11836b74f9b7SNate Lawson { 11846b74f9b7SNate Lawson struct acpi_cpu_softc *sc; 1185ccc09458SNate Lawson char state[8]; 11866b74f9b7SNate Lawson int val, error, i; 11876b74f9b7SNate Lawson 11886b74f9b7SNate Lawson sc = device_get_softc(cpu_devices[0]); 1189ccc09458SNate Lawson snprintf(state, sizeof(state), "C%d", cpu_cx_lowest + 1); 1190ccc09458SNate Lawson error = sysctl_handle_string(oidp, state, sizeof(state), req); 11916b74f9b7SNate Lawson if (error != 0 || req->newptr == NULL) 11926b74f9b7SNate Lawson return (error); 1193ccc09458SNate Lawson if (strlen(state) < 2 || toupper(state[0]) != 'C') 1194ccc09458SNate Lawson return (EINVAL); 1195ccc09458SNate Lawson val = (int) strtol(state + 1, NULL, 10) - 1; 119656a70eadSNate Lawson if (val < 0 || val > cpu_cx_count - 1) 11976b74f9b7SNate Lawson return (EINVAL); 11986b74f9b7SNate Lawson 1199d92a2ebdSNate Lawson ACPI_SERIAL_BEGIN(cpu); 12006b74f9b7SNate Lawson cpu_cx_lowest = val; 12016b74f9b7SNate Lawson 12026b74f9b7SNate Lawson /* If not disabling, cache the new lowest non-C3 state. */ 12036b74f9b7SNate Lawson cpu_non_c3 = 0; 12046b74f9b7SNate Lawson for (i = cpu_cx_lowest; i >= 0; i--) { 12056b74f9b7SNate Lawson if (sc->cpu_cx_states[i].type < ACPI_STATE_C3) { 12066b74f9b7SNate Lawson cpu_non_c3 = i; 12076b74f9b7SNate Lawson break; 12086b74f9b7SNate Lawson } 12096b74f9b7SNate Lawson } 12106b74f9b7SNate Lawson 12116b74f9b7SNate Lawson /* Reset the statistics counters. */ 1212a2afe45aSNate Lawson bzero(cpu_cx_stats, sizeof(cpu_cx_stats)); 1213d92a2ebdSNate Lawson ACPI_SERIAL_END(cpu); 12146b74f9b7SNate Lawson 12156b74f9b7SNate Lawson return (0); 12166b74f9b7SNate Lawson } 1217