xref: /freebsd/sys/dev/acpica/acpi_cpu.c (revision f51d43fe01b9898f633947e6fed6a33da32c77c5)
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>
41*f51d43feSAndriy Gapon #include <sys/sched.h>
4256a70eadSNate Lawson #include <sys/sbuf.h>
436b74f9b7SNate Lawson #include <sys/smp.h>
44fec754d4SMike Smith 
456b74f9b7SNate Lawson #include <dev/pci/pcivar.h>
4656a70eadSNate Lawson #include <machine/atomic.h>
47fec754d4SMike Smith #include <machine/bus.h>
48e1c9d39eSJung-uk Kim #if defined(__amd64__) || defined(__i386__)
49e1c9d39eSJung-uk Kim #include <machine/clock.h>
50e1c9d39eSJung-uk Kim #endif
5156a70eadSNate Lawson #include <sys/rman.h>
52fec754d4SMike Smith 
53129d3046SJung-uk Kim #include <contrib/dev/acpica/include/acpi.h>
54129d3046SJung-uk Kim #include <contrib/dev/acpica/include/accommon.h>
55129d3046SJung-uk Kim 
56fec754d4SMike Smith #include <dev/acpica/acpivar.h>
57fec754d4SMike Smith 
58fec754d4SMike Smith /*
598c5468e3SNate Lawson  * Support for ACPI Processor devices, including C[1-3] sleep states.
60fec754d4SMike Smith  */
61fec754d4SMike Smith 
62be2b1797SNate Lawson /* Hooks for the ACPI CA debugging infrastructure */
63fec754d4SMike Smith #define _COMPONENT	ACPI_PROCESSOR
649127281cSMike Smith ACPI_MODULE_NAME("PROCESSOR")
65fec754d4SMike Smith 
666b74f9b7SNate Lawson struct acpi_cx {
676b74f9b7SNate Lawson     struct resource	*p_lvlx;	/* Register to read to enter state. */
686b74f9b7SNate Lawson     uint32_t		 type;		/* C1-3 (C4 and up treated as C3). */
696b74f9b7SNate Lawson     uint32_t		 trans_lat;	/* Transition latency (usec). */
706b74f9b7SNate Lawson     uint32_t		 power;		/* Power consumed (mW). */
71f4eb0418SNate Lawson     int			 res_type;	/* Resource type for p_lvlx. */
72*f51d43feSAndriy Gapon     int			 res_rid;	/* Resource ID for p_lvlx. */
736b74f9b7SNate Lawson };
746b74f9b7SNate Lawson #define MAX_CX_STATES	 8
756b74f9b7SNate Lawson 
76fec754d4SMike Smith struct acpi_cpu_softc {
77fec754d4SMike Smith     device_t		 cpu_dev;
78fec754d4SMike Smith     ACPI_HANDLE		 cpu_handle;
7998aa9cd0SNate Lawson     struct pcpu		*cpu_pcpu;
8098aa9cd0SNate Lawson     uint32_t		 cpu_acpi_id;	/* ACPI processor id */
8156a70eadSNate Lawson     uint32_t		 cpu_p_blk;	/* ACPI P_BLK location */
8256a70eadSNate Lawson     uint32_t		 cpu_p_blk_len;	/* P_BLK length (must be 6). */
836b74f9b7SNate Lawson     struct acpi_cx	 cpu_cx_states[MAX_CX_STATES];
8456a70eadSNate Lawson     int			 cpu_cx_count;	/* Number of valid Cx states. */
85a2afe45aSNate Lawson     int			 cpu_prev_sleep;/* Last idle sleep duration. */
86b29224c2SNate Lawson     int			 cpu_features;	/* Child driver supported features. */
87907b6777SNate Lawson     /* Runtime state. */
88907b6777SNate Lawson     int			 cpu_non_c3;	/* Index of lowest non-C3 state. */
89907b6777SNate Lawson     u_int		 cpu_cx_stats[MAX_CX_STATES];/* Cx usage history. */
90907b6777SNate Lawson     /* Values for sysctl. */
91907b6777SNate Lawson     struct sysctl_ctx_list cpu_sysctl_ctx;
92907b6777SNate Lawson     struct sysctl_oid	*cpu_sysctl_tree;
9355fb7f36SSean Bruno     int			 cpu_cx_lowest;
94d30b88afSAndriy Gapon     int			 cpu_cx_lowest_lim;
95907b6777SNate Lawson     char 		 cpu_cx_supported[64];
96fec754d4SMike Smith };
97fec754d4SMike Smith 
9898aa9cd0SNate Lawson struct acpi_cpu_device {
9998aa9cd0SNate Lawson     struct resource_list	ad_rl;
10098aa9cd0SNate Lawson };
10198aa9cd0SNate Lawson 
1026b74f9b7SNate Lawson #define CPU_GET_REG(reg, width) 					\
1036b74f9b7SNate Lawson     (bus_space_read_ ## width(rman_get_bustag((reg)), 			\
1046b74f9b7SNate Lawson 		      rman_get_bushandle((reg)), 0))
1056b74f9b7SNate Lawson #define CPU_SET_REG(reg, width, val)					\
1066b74f9b7SNate Lawson     (bus_space_write_ ## width(rman_get_bustag((reg)), 			\
1076b74f9b7SNate Lawson 		       rman_get_bushandle((reg)), 0, (val)))
108be2b1797SNate Lawson 
1096b74f9b7SNate Lawson #define PM_USEC(x)	 ((x) >> 2)	/* ~4 clocks per usec (3.57955 Mhz) */
110fec754d4SMike Smith 
1118b888c66SNate Lawson #define ACPI_NOTIFY_CX_STATES	0x81	/* _CST changed. */
112fec754d4SMike Smith 
11318ececa0SNate Lawson #define CPU_QUIRK_NO_C3		(1<<0)	/* C3-type states are not usable. */
11418ececa0SNate Lawson #define CPU_QUIRK_NO_BM_CTRL	(1<<2)	/* No bus mastering control. */
1156b74f9b7SNate Lawson 
1166b74f9b7SNate Lawson #define PCI_VENDOR_INTEL	0x8086
1176b74f9b7SNate Lawson #define PCI_DEVICE_82371AB_3	0x7113	/* PIIX4 chipset for quirks. */
1186b74f9b7SNate Lawson #define PCI_REVISION_A_STEP	0
1196b74f9b7SNate Lawson #define PCI_REVISION_B_STEP	1
1206b74f9b7SNate Lawson #define PCI_REVISION_4E		2
1216b74f9b7SNate Lawson #define PCI_REVISION_4M		3
1228a000acaSRui Paulo #define PIIX4_DEVACTB_REG	0x58
1238a000acaSRui Paulo #define PIIX4_BRLD_EN_IRQ0	(1<<0)
1248a000acaSRui Paulo #define PIIX4_BRLD_EN_IRQ	(1<<1)
1258a000acaSRui Paulo #define PIIX4_BRLD_EN_IRQ8	(1<<5)
1268a000acaSRui Paulo #define PIIX4_STOP_BREAK_MASK	(PIIX4_BRLD_EN_IRQ0 | PIIX4_BRLD_EN_IRQ | PIIX4_BRLD_EN_IRQ8)
1278a000acaSRui Paulo #define PIIX4_PCNTRL_BST_EN	(1<<10)
1286b74f9b7SNate Lawson 
129e4cd9dcfSJohn Baldwin /* Allow users to ignore processor orders in MADT. */
130e4cd9dcfSJohn Baldwin static int cpu_unordered;
131e4cd9dcfSJohn Baldwin TUNABLE_INT("debug.acpi.cpu_unordered", &cpu_unordered);
132e4cd9dcfSJohn Baldwin SYSCTL_INT(_debug_acpi, OID_AUTO, cpu_unordered, CTLFLAG_RDTUN,
133e4cd9dcfSJohn Baldwin     &cpu_unordered, 0,
134e4cd9dcfSJohn Baldwin     "Do not use the MADT to match ACPI Processor objects to CPUs.");
135e4cd9dcfSJohn Baldwin 
1366b74f9b7SNate Lawson /* Platform hardware resource information. */
1376b74f9b7SNate Lawson static uint32_t		 cpu_smi_cmd;	/* Value to write to SMI_CMD. */
13856a70eadSNate Lawson static uint8_t		 cpu_cst_cnt;	/* Indicate we are _CST aware. */
139a2afe45aSNate Lawson static int		 cpu_quirks;	/* Indicate any hardware bugs. */
1406b74f9b7SNate Lawson 
1416b74f9b7SNate Lawson /* Runtime state. */
142907b6777SNate Lawson static int		 cpu_disable_idle; /* Disable entry to idle function */
1436b74f9b7SNate Lawson 
1446b74f9b7SNate Lawson /* Values for sysctl. */
145907b6777SNate Lawson static struct sysctl_ctx_list cpu_sysctl_ctx;
146907b6777SNate Lawson static struct sysctl_oid *cpu_sysctl_tree;
147907b6777SNate Lawson static int		 cpu_cx_generic;
148d30b88afSAndriy Gapon static int		 cpu_cx_lowest_lim;
149fec754d4SMike Smith 
150fec754d4SMike Smith static device_t		*cpu_devices;
151fec754d4SMike Smith static int		 cpu_ndevices;
152447a5fa1SJohn Baldwin static struct acpi_cpu_softc **cpu_softc;
153d92a2ebdSNate Lawson ACPI_SERIAL_DECL(cpu, "ACPI CPU");
154fec754d4SMike Smith 
155fec754d4SMike Smith static int	acpi_cpu_probe(device_t dev);
156fec754d4SMike Smith static int	acpi_cpu_attach(device_t dev);
1573331373cSNate Lawson static int	acpi_cpu_suspend(device_t dev);
1583331373cSNate Lawson static int	acpi_cpu_resume(device_t dev);
159e4cd9dcfSJohn Baldwin static int	acpi_pcpu_get_id(device_t dev, uint32_t *acpi_id,
160b6426963SNate Lawson 		    uint32_t *cpu_id);
16198aa9cd0SNate Lawson static struct resource_list *acpi_cpu_get_rlist(device_t dev, device_t child);
1623d844eddSAndriy Gapon static device_t	acpi_cpu_add_child(device_t dev, u_int order, const char *name,
16398aa9cd0SNate Lawson 		    int unit);
16498aa9cd0SNate Lawson static int	acpi_cpu_read_ivar(device_t dev, device_t child, int index,
16598aa9cd0SNate Lawson 		    uintptr_t *result);
16656a70eadSNate Lawson static int	acpi_cpu_shutdown(device_t dev);
167907b6777SNate Lawson static void	acpi_cpu_cx_probe(struct acpi_cpu_softc *sc);
168907b6777SNate Lawson static void	acpi_cpu_generic_cx_probe(struct acpi_cpu_softc *sc);
1696b74f9b7SNate Lawson static int	acpi_cpu_cx_cst(struct acpi_cpu_softc *sc);
1706b74f9b7SNate Lawson static void	acpi_cpu_startup(void *arg);
171907b6777SNate Lawson static void	acpi_cpu_startup_cx(struct acpi_cpu_softc *sc);
17289ab2a7aSRui Paulo static void	acpi_cpu_cx_list(struct acpi_cpu_softc *sc);
1736b74f9b7SNate Lawson static void	acpi_cpu_idle(void);
1746b74f9b7SNate Lawson static void	acpi_cpu_notify(ACPI_HANDLE h, UINT32 notify, void *context);
175907b6777SNate Lawson static int	acpi_cpu_quirks(void);
176a2afe45aSNate Lawson static int	acpi_cpu_usage_sysctl(SYSCTL_HANDLER_ARGS);
177d30b88afSAndriy Gapon static int	acpi_cpu_set_cx_lowest(struct acpi_cpu_softc *sc);
1786b74f9b7SNate Lawson static int	acpi_cpu_cx_lowest_sysctl(SYSCTL_HANDLER_ARGS);
179907b6777SNate Lawson static int	acpi_cpu_global_cx_lowest_sysctl(SYSCTL_HANDLER_ARGS);
180fec754d4SMike Smith 
181fec754d4SMike Smith static device_method_t acpi_cpu_methods[] = {
182fec754d4SMike Smith     /* Device interface */
183fec754d4SMike Smith     DEVMETHOD(device_probe,	acpi_cpu_probe),
184fec754d4SMike Smith     DEVMETHOD(device_attach,	acpi_cpu_attach),
18598aa9cd0SNate Lawson     DEVMETHOD(device_detach,	bus_generic_detach),
18656a70eadSNate Lawson     DEVMETHOD(device_shutdown,	acpi_cpu_shutdown),
1873331373cSNate Lawson     DEVMETHOD(device_suspend,	acpi_cpu_suspend),
1883331373cSNate Lawson     DEVMETHOD(device_resume,	acpi_cpu_resume),
18998aa9cd0SNate Lawson 
19098aa9cd0SNate Lawson     /* Bus interface */
19198aa9cd0SNate Lawson     DEVMETHOD(bus_add_child,	acpi_cpu_add_child),
19298aa9cd0SNate Lawson     DEVMETHOD(bus_read_ivar,	acpi_cpu_read_ivar),
19398aa9cd0SNate Lawson     DEVMETHOD(bus_get_resource_list, acpi_cpu_get_rlist),
19498aa9cd0SNate Lawson     DEVMETHOD(bus_get_resource,	bus_generic_rl_get_resource),
19598aa9cd0SNate Lawson     DEVMETHOD(bus_set_resource,	bus_generic_rl_set_resource),
19698aa9cd0SNate Lawson     DEVMETHOD(bus_alloc_resource, bus_generic_rl_alloc_resource),
19798aa9cd0SNate Lawson     DEVMETHOD(bus_release_resource, bus_generic_rl_release_resource),
19898aa9cd0SNate Lawson     DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
19998aa9cd0SNate Lawson     DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
20098aa9cd0SNate Lawson     DEVMETHOD(bus_setup_intr,	bus_generic_setup_intr),
20198aa9cd0SNate Lawson     DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
202fec754d4SMike Smith 
2034b7ec270SMarius Strobl     DEVMETHOD_END
204fec754d4SMike Smith };
205fec754d4SMike Smith 
206fec754d4SMike Smith static driver_t acpi_cpu_driver = {
207b0e2b625SNate Lawson     "cpu",
208fec754d4SMike Smith     acpi_cpu_methods,
209fec754d4SMike Smith     sizeof(struct acpi_cpu_softc),
210fec754d4SMike Smith };
211fec754d4SMike Smith 
2123045c8afSNate Lawson static devclass_t acpi_cpu_devclass;
2133045c8afSNate Lawson DRIVER_MODULE(cpu, acpi, acpi_cpu_driver, acpi_cpu_devclass, 0, 0);
214b0e2b625SNate Lawson MODULE_DEPEND(cpu, acpi, 1, 1, 1);
21556a70eadSNate Lawson 
216fec754d4SMike Smith static int
217fec754d4SMike Smith acpi_cpu_probe(device_t dev)
218fec754d4SMike Smith {
219b29224c2SNate Lawson     int			   acpi_id, cpu_id;
220b0e2b625SNate Lawson     ACPI_BUFFER		   buf;
221b0e2b625SNate Lawson     ACPI_HANDLE		   handle;
222b0e2b625SNate Lawson     ACPI_OBJECT		   *obj;
223b0e2b625SNate Lawson     ACPI_STATUS		   status;
224b0e2b625SNate Lawson 
225b0e2b625SNate Lawson     if (acpi_disabled("cpu") || acpi_get_type(dev) != ACPI_TYPE_PROCESSOR)
226b0e2b625SNate Lawson 	return (ENXIO);
227b0e2b625SNate Lawson 
228b0e2b625SNate Lawson     handle = acpi_get_handle(dev);
229447a5fa1SJohn Baldwin     if (cpu_softc == NULL)
230447a5fa1SJohn Baldwin 	cpu_softc = malloc(sizeof(struct acpi_cpu_softc *) *
231447a5fa1SJohn Baldwin 	    (mp_maxid + 1), M_TEMP /* XXX */, M_WAITOK | M_ZERO);
232b0e2b625SNate Lawson 
233b0e2b625SNate Lawson     /* Get our Processor object. */
234b0e2b625SNate Lawson     buf.Pointer = NULL;
235b0e2b625SNate Lawson     buf.Length = ACPI_ALLOCATE_BUFFER;
236b0e2b625SNate Lawson     status = AcpiEvaluateObject(handle, NULL, NULL, &buf);
237b0e2b625SNate Lawson     if (ACPI_FAILURE(status)) {
238b0e2b625SNate Lawson 	device_printf(dev, "probe failed to get Processor obj - %s\n",
239b0e2b625SNate Lawson 		      AcpiFormatException(status));
240b0e2b625SNate Lawson 	return (ENXIO);
241b0e2b625SNate Lawson     }
242b0e2b625SNate Lawson     obj = (ACPI_OBJECT *)buf.Pointer;
243b0e2b625SNate Lawson     if (obj->Type != ACPI_TYPE_PROCESSOR) {
244b0e2b625SNate Lawson 	device_printf(dev, "Processor object has bad type %d\n", obj->Type);
245b0e2b625SNate Lawson 	AcpiOsFree(obj);
246b0e2b625SNate Lawson 	return (ENXIO);
247fec754d4SMike Smith     }
248be2b1797SNate Lawson 
249b0e2b625SNate Lawson     /*
250b0e2b625SNate Lawson      * Find the processor associated with our unit.  We could use the
251b0e2b625SNate Lawson      * ProcId as a key, however, some boxes do not have the same values
252b0e2b625SNate Lawson      * in their Processor object as the ProcId values in the MADT.
253b0e2b625SNate Lawson      */
254b0e2b625SNate Lawson     acpi_id = obj->Processor.ProcId;
255b0e2b625SNate Lawson     AcpiOsFree(obj);
256e4cd9dcfSJohn Baldwin     if (acpi_pcpu_get_id(dev, &acpi_id, &cpu_id) != 0)
257fec754d4SMike Smith 	return (ENXIO);
258b0e2b625SNate Lawson 
259b0e2b625SNate Lawson     /*
260b0e2b625SNate Lawson      * Check if we already probed this processor.  We scan the bus twice
261b0e2b625SNate Lawson      * so it's possible we've already seen this one.
262b0e2b625SNate Lawson      */
263b0e2b625SNate Lawson     if (cpu_softc[cpu_id] != NULL)
264b0e2b625SNate Lawson 	return (ENXIO);
265b0e2b625SNate Lawson 
266b0e2b625SNate Lawson     /* Mark this processor as in-use and save our derived id for attach. */
267b0e2b625SNate Lawson     cpu_softc[cpu_id] = (void *)1;
268f6eb382cSAndriy Gapon     acpi_set_private(dev, (void*)(intptr_t)cpu_id);
269b29224c2SNate Lawson     device_set_desc(dev, "ACPI CPU");
270b0e2b625SNate Lawson 
271b0e2b625SNate Lawson     return (0);
272fec754d4SMike Smith }
273fec754d4SMike Smith 
274fec754d4SMike Smith static int
275fec754d4SMike Smith acpi_cpu_attach(device_t dev)
276fec754d4SMike Smith {
277b0e2b625SNate Lawson     ACPI_BUFFER		   buf;
278c961facaSNate Lawson     ACPI_OBJECT		   arg[4], *obj;
279bce92885SNate Lawson     ACPI_OBJECT_LIST	   arglist;
28098aa9cd0SNate Lawson     struct pcpu		   *pcpu_data;
281fec754d4SMike Smith     struct acpi_cpu_softc *sc;
282fec754d4SMike Smith     struct acpi_softc	  *acpi_sc;
283fec754d4SMike Smith     ACPI_STATUS		   status;
284b29224c2SNate Lawson     u_int		   features;
285b29224c2SNate Lawson     int			   cpu_id, drv_count, i;
286b29224c2SNate Lawson     driver_t 		  **drivers;
287bce92885SNate Lawson     uint32_t		   cap_set[3];
288fec754d4SMike Smith 
289c961facaSNate Lawson     /* UUID needed by _OSC evaluation */
290c961facaSNate Lawson     static uint8_t cpu_oscuuid[16] = { 0x16, 0xA6, 0x77, 0x40, 0x0C, 0x29,
291c961facaSNate Lawson 				       0xBE, 0x47, 0x9E, 0xBD, 0xD8, 0x70,
292c961facaSNate Lawson 				       0x58, 0x71, 0x39, 0x53 };
293c961facaSNate Lawson 
294b4a05238SPeter Wemm     ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
295fec754d4SMike Smith 
296fec754d4SMike Smith     sc = device_get_softc(dev);
297fec754d4SMike Smith     sc->cpu_dev = dev;
298fec754d4SMike Smith     sc->cpu_handle = acpi_get_handle(dev);
299f6eb382cSAndriy Gapon     cpu_id = (int)(intptr_t)acpi_get_private(dev);
30098aa9cd0SNate Lawson     cpu_softc[cpu_id] = sc;
30198aa9cd0SNate Lawson     pcpu_data = pcpu_find(cpu_id);
30298aa9cd0SNate Lawson     pcpu_data->pc_device = dev;
30398aa9cd0SNate Lawson     sc->cpu_pcpu = pcpu_data;
3042be4e471SJung-uk Kim     cpu_smi_cmd = AcpiGbl_FADT.SmiCommand;
3052be4e471SJung-uk Kim     cpu_cst_cnt = AcpiGbl_FADT.CstControl;
306fec754d4SMike Smith 
307b0e2b625SNate Lawson     buf.Pointer = NULL;
308b0e2b625SNate Lawson     buf.Length = ACPI_ALLOCATE_BUFFER;
3096b74f9b7SNate Lawson     status = AcpiEvaluateObject(sc->cpu_handle, NULL, NULL, &buf);
3106b74f9b7SNate Lawson     if (ACPI_FAILURE(status)) {
311b0e2b625SNate Lawson 	device_printf(dev, "attach failed to get Processor obj - %s\n",
3126b74f9b7SNate Lawson 		      AcpiFormatException(status));
3136b74f9b7SNate Lawson 	return (ENXIO);
314b0e2b625SNate Lawson     }
315b0e2b625SNate Lawson     obj = (ACPI_OBJECT *)buf.Pointer;
316b0e2b625SNate Lawson     sc->cpu_p_blk = obj->Processor.PblkAddress;
317b0e2b625SNate Lawson     sc->cpu_p_blk_len = obj->Processor.PblkLength;
31898aa9cd0SNate Lawson     sc->cpu_acpi_id = obj->Processor.ProcId;
319b0e2b625SNate Lawson     AcpiOsFree(obj);
32056a70eadSNate Lawson     ACPI_DEBUG_PRINT((ACPI_DB_INFO, "acpi_cpu%d: P_BLK at %#x/%d\n",
32156a70eadSNate Lawson 		     device_get_unit(dev), sc->cpu_p_blk, sc->cpu_p_blk_len));
3226b74f9b7SNate Lawson 
323907b6777SNate Lawson     /*
324907b6777SNate Lawson      * If this is the first cpu we attach, create and initialize the generic
325907b6777SNate Lawson      * resources that will be used by all acpi cpu devices.
326907b6777SNate Lawson      */
327907b6777SNate Lawson     if (device_get_unit(dev) == 0) {
328907b6777SNate Lawson 	/* Assume we won't be using generic Cx mode by default */
329907b6777SNate Lawson 	cpu_cx_generic = FALSE;
330907b6777SNate Lawson 
331907b6777SNate Lawson 	/* Install hw.acpi.cpu sysctl tree */
332fec754d4SMike Smith 	acpi_sc = acpi_device_get_parent_softc(dev);
333907b6777SNate Lawson 	sysctl_ctx_init(&cpu_sysctl_ctx);
334907b6777SNate Lawson 	cpu_sysctl_tree = SYSCTL_ADD_NODE(&cpu_sysctl_ctx,
33598aa9cd0SNate Lawson 	    SYSCTL_CHILDREN(acpi_sc->acpi_sysctl_tree), OID_AUTO, "cpu",
336907b6777SNate Lawson 	    CTLFLAG_RD, 0, "node for CPU children");
337907b6777SNate Lawson 
338907b6777SNate Lawson 	/* Queue post cpu-probing task handler */
3392be4e471SJung-uk Kim 	AcpiOsExecute(OSL_NOTIFY_HANDLER, acpi_cpu_startup, NULL);
340907b6777SNate Lawson     }
341fec754d4SMike Smith 
3426b74f9b7SNate Lawson     /*
343b29224c2SNate Lawson      * Before calling any CPU methods, collect child driver feature hints
344f2d94257SNate Lawson      * and notify ACPI of them.  We support unified SMP power control
345f2d94257SNate Lawson      * so advertise this ourselves.  Note this is not the same as independent
346f2d94257SNate Lawson      * SMP control where each CPU can have different settings.
347b29224c2SNate Lawson      */
348f2d94257SNate Lawson     sc->cpu_features = ACPI_CAP_SMP_SAME | ACPI_CAP_SMP_SAME_C3;
349b29224c2SNate Lawson     if (devclass_get_drivers(acpi_cpu_devclass, &drivers, &drv_count) == 0) {
350b29224c2SNate Lawson 	for (i = 0; i < drv_count; i++) {
351b29224c2SNate Lawson 	    if (ACPI_GET_FEATURES(drivers[i], &features) == 0)
352b29224c2SNate Lawson 		sc->cpu_features |= features;
353b29224c2SNate Lawson 	}
354b29224c2SNate Lawson 	free(drivers, M_TEMP);
355b29224c2SNate Lawson     }
356bce92885SNate Lawson 
357bce92885SNate Lawson     /*
358f4ab0cccSAndriy Gapon      * CPU capabilities are specified in
359f4ab0cccSAndriy Gapon      * Intel Processor Vendor-Specific ACPI Interface Specification.
360bce92885SNate Lawson      */
361bce92885SNate Lawson     if (sc->cpu_features) {
362c961facaSNate Lawson 	arglist.Pointer = arg;
363c961facaSNate Lawson 	arglist.Count = 4;
364c961facaSNate Lawson 	arg[0].Type = ACPI_TYPE_BUFFER;
365c961facaSNate Lawson 	arg[0].Buffer.Length = sizeof(cpu_oscuuid);
366c961facaSNate Lawson 	arg[0].Buffer.Pointer = cpu_oscuuid;	/* UUID */
367c961facaSNate Lawson 	arg[1].Type = ACPI_TYPE_INTEGER;
368c961facaSNate Lawson 	arg[1].Integer.Value = 1;		/* revision */
369c961facaSNate Lawson 	arg[2].Type = ACPI_TYPE_INTEGER;
370c961facaSNate Lawson 	arg[2].Integer.Value = 1;		/* count */
371c961facaSNate Lawson 	arg[3].Type = ACPI_TYPE_BUFFER;
372c961facaSNate Lawson 	arg[3].Buffer.Length = sizeof(cap_set);	/* Capabilities buffer */
373c961facaSNate Lawson 	arg[3].Buffer.Pointer = (uint8_t *)cap_set;
374877a6d99SAndriy Gapon 	cap_set[0] = 0;				/* status */
375877a6d99SAndriy Gapon 	cap_set[1] = sc->cpu_features;
376f4ab0cccSAndriy Gapon 	status = AcpiEvaluateObject(sc->cpu_handle, "_OSC", &arglist, NULL);
377f4ab0cccSAndriy Gapon 	if (ACPI_SUCCESS(status)) {
378f4ab0cccSAndriy Gapon 	    if (cap_set[0] != 0)
379f4ab0cccSAndriy Gapon 		device_printf(dev, "_OSC returned status %#x\n", cap_set[0]);
380f4ab0cccSAndriy Gapon 	}
381f4ab0cccSAndriy Gapon 	else {
382f4ab0cccSAndriy Gapon 	    arglist.Pointer = arg;
383f4ab0cccSAndriy Gapon 	    arglist.Count = 1;
384f4ab0cccSAndriy Gapon 	    arg[0].Type = ACPI_TYPE_BUFFER;
385f4ab0cccSAndriy Gapon 	    arg[0].Buffer.Length = sizeof(cap_set);
386f4ab0cccSAndriy Gapon 	    arg[0].Buffer.Pointer = (uint8_t *)cap_set;
387f4ab0cccSAndriy Gapon 	    cap_set[0] = 1; /* revision */
388f4ab0cccSAndriy Gapon 	    cap_set[1] = 1; /* number of capabilities integers */
389f4ab0cccSAndriy Gapon 	    cap_set[2] = sc->cpu_features;
390f4ab0cccSAndriy Gapon 	    AcpiEvaluateObject(sc->cpu_handle, "_PDC", &arglist, NULL);
391f4ab0cccSAndriy Gapon 	}
392bce92885SNate Lawson     }
393b29224c2SNate Lawson 
394907b6777SNate Lawson     /* Probe for Cx state support. */
395907b6777SNate Lawson     acpi_cpu_cx_probe(sc);
3966b74f9b7SNate Lawson 
39798aa9cd0SNate Lawson     return (0);
3986b74f9b7SNate Lawson }
3996b74f9b7SNate Lawson 
400aa835160SAndriy Gapon static void
401aa835160SAndriy Gapon acpi_cpu_postattach(void *unused __unused)
402aa835160SAndriy Gapon {
403aa835160SAndriy Gapon     device_t *devices;
404aa835160SAndriy Gapon     int err;
405aa835160SAndriy Gapon     int i, n;
406aa835160SAndriy Gapon 
407aa835160SAndriy Gapon     err = devclass_get_devices(acpi_cpu_devclass, &devices, &n);
408aa835160SAndriy Gapon     if (err != 0) {
409aa835160SAndriy Gapon 	printf("devclass_get_devices(acpi_cpu_devclass) failed\n");
410aa835160SAndriy Gapon 	return;
411aa835160SAndriy Gapon     }
412aa835160SAndriy Gapon     for (i = 0; i < n; i++)
413aa835160SAndriy Gapon 	bus_generic_probe(devices[i]);
414aa835160SAndriy Gapon     for (i = 0; i < n; i++)
415aa835160SAndriy Gapon 	bus_generic_attach(devices[i]);
416aa835160SAndriy Gapon     free(devices, M_TEMP);
417aa835160SAndriy Gapon }
418aa835160SAndriy Gapon 
419aa835160SAndriy Gapon SYSINIT(acpi_cpu, SI_SUB_CONFIGURE, SI_ORDER_MIDDLE,
420aa835160SAndriy Gapon     acpi_cpu_postattach, NULL);
421aa835160SAndriy Gapon 
422b6426963SNate Lawson /*
4233331373cSNate Lawson  * Disable any entry to the idle function during suspend and re-enable it
4243331373cSNate Lawson  * during resume.
4253331373cSNate Lawson  */
4263331373cSNate Lawson static int
4273331373cSNate Lawson acpi_cpu_suspend(device_t dev)
4283331373cSNate Lawson {
4293331373cSNate Lawson     int error;
4303331373cSNate Lawson 
4313331373cSNate Lawson     error = bus_generic_suspend(dev);
4323331373cSNate Lawson     if (error)
4333331373cSNate Lawson 	return (error);
4343331373cSNate Lawson     cpu_disable_idle = TRUE;
4353331373cSNate Lawson     return (0);
4363331373cSNate Lawson }
4373331373cSNate Lawson 
4383331373cSNate Lawson static int
4393331373cSNate Lawson acpi_cpu_resume(device_t dev)
4403331373cSNate Lawson {
4413331373cSNate Lawson 
4423331373cSNate Lawson     cpu_disable_idle = FALSE;
4433331373cSNate Lawson     return (bus_generic_resume(dev));
4443331373cSNate Lawson }
4453331373cSNate Lawson 
4463331373cSNate Lawson /*
447e4cd9dcfSJohn Baldwin  * Find the processor associated with a given ACPI ID.  By default,
448e4cd9dcfSJohn Baldwin  * use the MADT to map ACPI IDs to APIC IDs and use that to locate a
449e4cd9dcfSJohn Baldwin  * processor.  Some systems have inconsistent ASL and MADT however.
450e4cd9dcfSJohn Baldwin  * For these systems the cpu_unordered tunable can be set in which
451e4cd9dcfSJohn Baldwin  * case we assume that Processor objects are listed in the same order
452e4cd9dcfSJohn Baldwin  * in both the MADT and ASL.
453b6426963SNate Lawson  */
454b6426963SNate Lawson static int
455e4cd9dcfSJohn Baldwin acpi_pcpu_get_id(device_t dev, uint32_t *acpi_id, uint32_t *cpu_id)
456b6426963SNate Lawson {
457e4cd9dcfSJohn Baldwin     struct pcpu	*pc;
458e4cd9dcfSJohn Baldwin     uint32_t	 i, idx;
459b6426963SNate Lawson 
460b6426963SNate Lawson     KASSERT(acpi_id != NULL, ("Null acpi_id"));
461b6426963SNate Lawson     KASSERT(cpu_id != NULL, ("Null cpu_id"));
462e4cd9dcfSJohn Baldwin     idx = device_get_unit(dev);
463e4cd9dcfSJohn Baldwin 
464e4cd9dcfSJohn Baldwin     /*
465e4cd9dcfSJohn Baldwin      * If pc_acpi_id for CPU 0 is not initialized (e.g. a non-APIC
466e4cd9dcfSJohn Baldwin      * UP box) use the ACPI ID from the first processor we find.
467e4cd9dcfSJohn Baldwin      */
468e4cd9dcfSJohn Baldwin     if (idx == 0 && mp_ncpus == 1) {
469e4cd9dcfSJohn Baldwin 	pc = pcpu_find(0);
470e4cd9dcfSJohn Baldwin 	if (pc->pc_acpi_id == 0xffffffff)
471e4cd9dcfSJohn Baldwin 	    pc->pc_acpi_id = *acpi_id;
472e4cd9dcfSJohn Baldwin 	*cpu_id = 0;
473e4cd9dcfSJohn Baldwin 	return (0);
474e4cd9dcfSJohn Baldwin     }
475e4cd9dcfSJohn Baldwin 
4763aa6d94eSJohn Baldwin     CPU_FOREACH(i) {
477e4cd9dcfSJohn Baldwin 	pc = pcpu_find(i);
478e4cd9dcfSJohn Baldwin 	KASSERT(pc != NULL, ("no pcpu data for %d", i));
479e4cd9dcfSJohn Baldwin 	if (cpu_unordered) {
480b6426963SNate Lawson 	    if (idx-- == 0) {
481b6426963SNate Lawson 		/*
482e4cd9dcfSJohn Baldwin 		 * If pc_acpi_id doesn't match the ACPI ID from the
483e4cd9dcfSJohn Baldwin 		 * ASL, prefer the MADT-derived value.
484b6426963SNate Lawson 		 */
485e4cd9dcfSJohn Baldwin 		if (pc->pc_acpi_id != *acpi_id)
486e4cd9dcfSJohn Baldwin 		    *acpi_id = pc->pc_acpi_id;
487e4cd9dcfSJohn Baldwin 		*cpu_id = pc->pc_cpuid;
488e4cd9dcfSJohn Baldwin 		return (0);
489e4cd9dcfSJohn Baldwin 	    }
490e4cd9dcfSJohn Baldwin 	} else {
491e4cd9dcfSJohn Baldwin 	    if (pc->pc_acpi_id == *acpi_id) {
492e4cd9dcfSJohn Baldwin 		if (bootverbose)
4932aa7a9e6SJung-uk Kim 		    device_printf(dev,
4942aa7a9e6SJung-uk Kim 			"Processor %s (ACPI ID %u) -> APIC ID %d\n",
4952aa7a9e6SJung-uk Kim 			acpi_name(acpi_get_handle(dev)), *acpi_id,
4962aa7a9e6SJung-uk Kim 			pc->pc_cpuid);
497e4cd9dcfSJohn Baldwin 		*cpu_id = pc->pc_cpuid;
498b6426963SNate Lawson 		return (0);
499b6426963SNate Lawson 	    }
500b6426963SNate Lawson 	}
501e4cd9dcfSJohn Baldwin     }
502e4cd9dcfSJohn Baldwin 
503e4cd9dcfSJohn Baldwin     if (bootverbose)
504e4cd9dcfSJohn Baldwin 	printf("ACPI: Processor %s (ACPI ID %u) ignored\n",
505e4cd9dcfSJohn Baldwin 	    acpi_name(acpi_get_handle(dev)), *acpi_id);
506b6426963SNate Lawson 
507b6426963SNate Lawson     return (ESRCH);
508b6426963SNate Lawson }
509b6426963SNate Lawson 
51098aa9cd0SNate Lawson static struct resource_list *
51198aa9cd0SNate Lawson acpi_cpu_get_rlist(device_t dev, device_t child)
51298aa9cd0SNate Lawson {
51398aa9cd0SNate Lawson     struct acpi_cpu_device *ad;
51498aa9cd0SNate Lawson 
51598aa9cd0SNate Lawson     ad = device_get_ivars(child);
51698aa9cd0SNate Lawson     if (ad == NULL)
51798aa9cd0SNate Lawson 	return (NULL);
51898aa9cd0SNate Lawson     return (&ad->ad_rl);
51998aa9cd0SNate Lawson }
52098aa9cd0SNate Lawson 
52198aa9cd0SNate Lawson static device_t
5223d844eddSAndriy Gapon acpi_cpu_add_child(device_t dev, u_int order, const char *name, int unit)
52398aa9cd0SNate Lawson {
52498aa9cd0SNate Lawson     struct acpi_cpu_device *ad;
52598aa9cd0SNate Lawson     device_t child;
52698aa9cd0SNate Lawson 
52798aa9cd0SNate Lawson     if ((ad = malloc(sizeof(*ad), M_TEMP, M_NOWAIT | M_ZERO)) == NULL)
52898aa9cd0SNate Lawson 	return (NULL);
52998aa9cd0SNate Lawson 
53098aa9cd0SNate Lawson     resource_list_init(&ad->ad_rl);
53198aa9cd0SNate Lawson 
53298aa9cd0SNate Lawson     child = device_add_child_ordered(dev, order, name, unit);
53398aa9cd0SNate Lawson     if (child != NULL)
53498aa9cd0SNate Lawson 	device_set_ivars(child, ad);
53543ce1c77SNate Lawson     else
53643ce1c77SNate Lawson 	free(ad, M_TEMP);
53798aa9cd0SNate Lawson     return (child);
53898aa9cd0SNate Lawson }
53998aa9cd0SNate Lawson 
54098aa9cd0SNate Lawson static int
54198aa9cd0SNate Lawson acpi_cpu_read_ivar(device_t dev, device_t child, int index, uintptr_t *result)
54298aa9cd0SNate Lawson {
54398aa9cd0SNate Lawson     struct acpi_cpu_softc *sc;
54498aa9cd0SNate Lawson 
54598aa9cd0SNate Lawson     sc = device_get_softc(dev);
54698aa9cd0SNate Lawson     switch (index) {
54798aa9cd0SNate Lawson     case ACPI_IVAR_HANDLE:
54898aa9cd0SNate Lawson 	*result = (uintptr_t)sc->cpu_handle;
54998aa9cd0SNate Lawson 	break;
55098aa9cd0SNate Lawson     case CPU_IVAR_PCPU:
55198aa9cd0SNate Lawson 	*result = (uintptr_t)sc->cpu_pcpu;
55298aa9cd0SNate Lawson 	break;
553e1c9d39eSJung-uk Kim #if defined(__amd64__) || defined(__i386__)
554e1c9d39eSJung-uk Kim     case CPU_IVAR_NOMINAL_MHZ:
555e1c9d39eSJung-uk Kim 	if (tsc_is_invariant) {
5563453537fSJung-uk Kim 	    *result = (uintptr_t)(atomic_load_acq_64(&tsc_freq) / 1000000);
557e1c9d39eSJung-uk Kim 	    break;
558e1c9d39eSJung-uk Kim 	}
559e1c9d39eSJung-uk Kim 	/* FALLTHROUGH */
560e1c9d39eSJung-uk Kim #endif
56198aa9cd0SNate Lawson     default:
56298aa9cd0SNate Lawson 	return (ENOENT);
56398aa9cd0SNate Lawson     }
56498aa9cd0SNate Lawson     return (0);
56598aa9cd0SNate Lawson }
56698aa9cd0SNate Lawson 
5676b74f9b7SNate Lawson static int
56856a70eadSNate Lawson acpi_cpu_shutdown(device_t dev)
56956a70eadSNate Lawson {
57056a70eadSNate Lawson     ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
57156a70eadSNate Lawson 
57298aa9cd0SNate Lawson     /* Allow children to shutdown first. */
57398aa9cd0SNate Lawson     bus_generic_shutdown(dev);
57498aa9cd0SNate Lawson 
575cc3c11f9SNate Lawson     /*
576cc3c11f9SNate Lawson      * Disable any entry to the idle function.  There is a small race where
577cc3c11f9SNate Lawson      * an idle thread have passed this check but not gone to sleep.  This
578cc3c11f9SNate Lawson      * is ok since device_shutdown() does not free the softc, otherwise
579cc3c11f9SNate Lawson      * we'd have to be sure all threads were evicted before returning.
580cc3c11f9SNate Lawson      */
581907b6777SNate Lawson     cpu_disable_idle = TRUE;
58256a70eadSNate Lawson 
58356a70eadSNate Lawson     return_VALUE (0);
58456a70eadSNate Lawson }
58556a70eadSNate Lawson 
586907b6777SNate Lawson static void
5876b74f9b7SNate Lawson acpi_cpu_cx_probe(struct acpi_cpu_softc *sc)
5886b74f9b7SNate Lawson {
589907b6777SNate Lawson     ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
590907b6777SNate Lawson 
591907b6777SNate Lawson     /* Use initial sleep value of 1 sec. to start with lowest idle state. */
592907b6777SNate Lawson     sc->cpu_prev_sleep = 1000000;
593907b6777SNate Lawson     sc->cpu_cx_lowest = 0;
594d30b88afSAndriy Gapon     sc->cpu_cx_lowest_lim = 0;
595907b6777SNate Lawson 
596907b6777SNate Lawson     /*
597907b6777SNate Lawson      * Check for the ACPI 2.0 _CST sleep states object. If we can't find
598907b6777SNate Lawson      * any, we'll revert to generic FADT/P_BLK Cx control method which will
599907b6777SNate Lawson      * be handled by acpi_cpu_startup. We need to defer to after having
600907b6777SNate Lawson      * probed all the cpus in the system before probing for generic Cx
601907b6777SNate Lawson      * states as we may already have found cpus with valid _CST packages
602907b6777SNate Lawson      */
603907b6777SNate Lawson     if (!cpu_cx_generic && acpi_cpu_cx_cst(sc) != 0) {
604907b6777SNate Lawson 	/*
605907b6777SNate Lawson 	 * We were unable to find a _CST package for this cpu or there
606907b6777SNate Lawson 	 * was an error parsing it. Switch back to generic mode.
607907b6777SNate Lawson 	 */
608907b6777SNate Lawson 	cpu_cx_generic = TRUE;
609bd826803SNate Lawson 	if (bootverbose)
610bd826803SNate Lawson 	    device_printf(sc->cpu_dev, "switching to generic Cx mode\n");
611907b6777SNate Lawson     }
612907b6777SNate Lawson 
613907b6777SNate Lawson     /*
614907b6777SNate Lawson      * TODO: _CSD Package should be checked here.
615907b6777SNate Lawson      */
616907b6777SNate Lawson }
617907b6777SNate Lawson 
618907b6777SNate Lawson static void
619907b6777SNate Lawson acpi_cpu_generic_cx_probe(struct acpi_cpu_softc *sc)
620907b6777SNate Lawson {
6216b74f9b7SNate Lawson     ACPI_GENERIC_ADDRESS	 gas;
6226b74f9b7SNate Lawson     struct acpi_cx		*cx_ptr;
62356a70eadSNate Lawson 
62456a70eadSNate Lawson     sc->cpu_cx_count = 0;
6256b74f9b7SNate Lawson     cx_ptr = sc->cpu_cx_states;
626fec754d4SMike Smith 
627907b6777SNate Lawson     /* Use initial sleep value of 1 sec. to start with lowest idle state. */
628907b6777SNate Lawson     sc->cpu_prev_sleep = 1000000;
629907b6777SNate Lawson 
6306b74f9b7SNate Lawson     /* C1 has been required since just after ACPI 1.0 */
6316b74f9b7SNate Lawson     cx_ptr->type = ACPI_STATE_C1;
6326b74f9b7SNate Lawson     cx_ptr->trans_lat = 0;
6336b74f9b7SNate Lawson     cx_ptr++;
634987e5277SAndriy Gapon     sc->cpu_non_c3 = sc->cpu_cx_count;
63556a70eadSNate Lawson     sc->cpu_cx_count++;
63656a70eadSNate Lawson 
637c181b89bSNate Lawson     /*
638c181b89bSNate Lawson      * The spec says P_BLK must be 6 bytes long.  However, some systems
639c181b89bSNate Lawson      * use it to indicate a fractional set of features present so we
640c181b89bSNate Lawson      * take 5 as C2.  Some may also have a value of 7 to indicate
641c181b89bSNate Lawson      * another C3 but most use _CST for this (as required) and having
642c181b89bSNate Lawson      * "only" C1-C3 is not a hardship.
643c181b89bSNate Lawson      */
644c181b89bSNate Lawson     if (sc->cpu_p_blk_len < 5)
645907b6777SNate Lawson 	return;
646fec754d4SMike Smith 
6476b74f9b7SNate Lawson     /* Validate and allocate resources for C2 (P_LVL2). */
6482be4e471SJung-uk Kim     gas.SpaceId = ACPI_ADR_SPACE_SYSTEM_IO;
6492be4e471SJung-uk Kim     gas.BitWidth = 8;
6502be4e471SJung-uk Kim     if (AcpiGbl_FADT.C2Latency <= 100) {
65156a70eadSNate Lawson 	gas.Address = sc->cpu_p_blk + 4;
652*f51d43feSAndriy Gapon 	cx_ptr->res_rid = 0;
653*f51d43feSAndriy Gapon 	acpi_bus_alloc_gas(sc->cpu_dev, &cx_ptr->res_type, &cx_ptr->res_rid,
654907b6777SNate Lawson 	    &gas, &cx_ptr->p_lvlx, RF_SHAREABLE);
6556b74f9b7SNate Lawson 	if (cx_ptr->p_lvlx != NULL) {
6566b74f9b7SNate Lawson 	    cx_ptr->type = ACPI_STATE_C2;
6572be4e471SJung-uk Kim 	    cx_ptr->trans_lat = AcpiGbl_FADT.C2Latency;
6586b74f9b7SNate Lawson 	    cx_ptr++;
659987e5277SAndriy Gapon 	    sc->cpu_non_c3 = sc->cpu_cx_count;
66056a70eadSNate Lawson 	    sc->cpu_cx_count++;
661fec754d4SMike Smith 	}
662fec754d4SMike Smith     }
663c181b89bSNate Lawson     if (sc->cpu_p_blk_len < 6)
664907b6777SNate Lawson 	return;
665be2b1797SNate Lawson 
6666b74f9b7SNate Lawson     /* Validate and allocate resources for C3 (P_LVL3). */
6676e1de64dSRui Paulo     if (AcpiGbl_FADT.C3Latency <= 1000 && !(cpu_quirks & CPU_QUIRK_NO_C3)) {
66856a70eadSNate Lawson 	gas.Address = sc->cpu_p_blk + 5;
669*f51d43feSAndriy Gapon 	cx_ptr->res_rid = 1;
670*f51d43feSAndriy Gapon 	acpi_bus_alloc_gas(sc->cpu_dev, &cx_ptr->res_type, &cx_ptr->res_rid,
671*f51d43feSAndriy Gapon 	    &gas, &cx_ptr->p_lvlx, RF_SHAREABLE);
6726b74f9b7SNate Lawson 	if (cx_ptr->p_lvlx != NULL) {
6736b74f9b7SNate Lawson 	    cx_ptr->type = ACPI_STATE_C3;
6742be4e471SJung-uk Kim 	    cx_ptr->trans_lat = AcpiGbl_FADT.C3Latency;
6756b74f9b7SNate Lawson 	    cx_ptr++;
67656a70eadSNate Lawson 	    sc->cpu_cx_count++;
677412ef220SAndriy Gapon 	    cpu_can_deep_sleep = 1;
6786b74f9b7SNate Lawson 	}
6796b74f9b7SNate Lawson     }
6806b74f9b7SNate Lawson }
6816b74f9b7SNate Lawson 
6826b74f9b7SNate Lawson /*
6836b74f9b7SNate Lawson  * Parse a _CST package and set up its Cx states.  Since the _CST object
6846b74f9b7SNate Lawson  * can change dynamically, our notify handler may call this function
6856b74f9b7SNate Lawson  * to clean up and probe the new _CST package.
6866b74f9b7SNate Lawson  */
6876b74f9b7SNate Lawson static int
6886b74f9b7SNate Lawson acpi_cpu_cx_cst(struct acpi_cpu_softc *sc)
6896b74f9b7SNate Lawson {
6906b74f9b7SNate Lawson     struct	 acpi_cx *cx_ptr;
6916b74f9b7SNate Lawson     ACPI_STATUS	 status;
6926b74f9b7SNate Lawson     ACPI_BUFFER	 buf;
6936b74f9b7SNate Lawson     ACPI_OBJECT	*top;
6946b74f9b7SNate Lawson     ACPI_OBJECT	*pkg;
6956b74f9b7SNate Lawson     uint32_t	 count;
6966b74f9b7SNate Lawson     int		 i;
6976b74f9b7SNate Lawson 
69856a70eadSNate Lawson     ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
69956a70eadSNate Lawson 
7006b74f9b7SNate Lawson     buf.Pointer = NULL;
7016b74f9b7SNate Lawson     buf.Length = ACPI_ALLOCATE_BUFFER;
7026b74f9b7SNate Lawson     status = AcpiEvaluateObject(sc->cpu_handle, "_CST", NULL, &buf);
703bd826803SNate Lawson     if (ACPI_FAILURE(status))
7046b74f9b7SNate Lawson 	return (ENXIO);
7056b74f9b7SNate Lawson 
7066b74f9b7SNate Lawson     /* _CST is a package with a count and at least one Cx package. */
7076b74f9b7SNate Lawson     top = (ACPI_OBJECT *)buf.Pointer;
70821cea91fSNate Lawson     if (!ACPI_PKG_VALID(top, 2) || acpi_PkgInt32(top, 0, &count) != 0) {
709bd826803SNate Lawson 	device_printf(sc->cpu_dev, "invalid _CST package\n");
7106b74f9b7SNate Lawson 	AcpiOsFree(buf.Pointer);
7116b74f9b7SNate Lawson 	return (ENXIO);
7126b74f9b7SNate Lawson     }
7136b74f9b7SNate Lawson     if (count != top->Package.Count - 1) {
714bd826803SNate Lawson 	device_printf(sc->cpu_dev, "invalid _CST state count (%d != %d)\n",
7156b74f9b7SNate Lawson 	       count, top->Package.Count - 1);
7166b74f9b7SNate Lawson 	count = top->Package.Count - 1;
7176b74f9b7SNate Lawson     }
7186b74f9b7SNate Lawson     if (count > MAX_CX_STATES) {
71956a70eadSNate Lawson 	device_printf(sc->cpu_dev, "_CST has too many states (%d)\n", count);
7206b74f9b7SNate Lawson 	count = MAX_CX_STATES;
7216b74f9b7SNate Lawson     }
7226b74f9b7SNate Lawson 
72368d5e11cSJung-uk Kim     sc->cpu_non_c3 = 0;
72456a70eadSNate Lawson     sc->cpu_cx_count = 0;
7256b74f9b7SNate Lawson     cx_ptr = sc->cpu_cx_states;
72668d5e11cSJung-uk Kim 
72768d5e11cSJung-uk Kim     /*
72868d5e11cSJung-uk Kim      * C1 has been required since just after ACPI 1.0.
72968d5e11cSJung-uk Kim      * Reserve the first slot for it.
73068d5e11cSJung-uk Kim      */
73168d5e11cSJung-uk Kim     cx_ptr->type = ACPI_STATE_C0;
73268d5e11cSJung-uk Kim     cx_ptr++;
73368d5e11cSJung-uk Kim     sc->cpu_cx_count++;
73468d5e11cSJung-uk Kim 
73568d5e11cSJung-uk Kim     /* Set up all valid states. */
7366b74f9b7SNate Lawson     for (i = 0; i < count; i++) {
7376b74f9b7SNate Lawson 	pkg = &top->Package.Elements[i + 1];
73821cea91fSNate Lawson 	if (!ACPI_PKG_VALID(pkg, 4) ||
73921cea91fSNate Lawson 	    acpi_PkgInt32(pkg, 1, &cx_ptr->type) != 0 ||
74021cea91fSNate Lawson 	    acpi_PkgInt32(pkg, 2, &cx_ptr->trans_lat) != 0 ||
74121cea91fSNate Lawson 	    acpi_PkgInt32(pkg, 3, &cx_ptr->power) != 0) {
74221cea91fSNate Lawson 
74380f006a1SNate Lawson 	    device_printf(sc->cpu_dev, "skipping invalid Cx state package\n");
7446b74f9b7SNate Lawson 	    continue;
7456b74f9b7SNate Lawson 	}
7466b74f9b7SNate Lawson 
7476b74f9b7SNate Lawson 	/* Validate the state to see if we should use it. */
7486b74f9b7SNate Lawson 	switch (cx_ptr->type) {
7496b74f9b7SNate Lawson 	case ACPI_STATE_C1:
75068d5e11cSJung-uk Kim 	    if (sc->cpu_cx_states[0].type == ACPI_STATE_C0) {
75168d5e11cSJung-uk Kim 		/* This is the first C1 state.  Use the reserved slot. */
75268d5e11cSJung-uk Kim 		sc->cpu_cx_states[0] = *cx_ptr;
75368d5e11cSJung-uk Kim 	    } else {
75456101001SAndriy Gapon 		sc->cpu_non_c3 = sc->cpu_cx_count;
7556b74f9b7SNate Lawson 		cx_ptr++;
75656a70eadSNate Lawson 		sc->cpu_cx_count++;
75768d5e11cSJung-uk Kim 	    }
7586b74f9b7SNate Lawson 	    continue;
7596b74f9b7SNate Lawson 	case ACPI_STATE_C2:
76056101001SAndriy Gapon 	    sc->cpu_non_c3 = sc->cpu_cx_count;
7616b74f9b7SNate Lawson 	    break;
7626b74f9b7SNate Lawson 	case ACPI_STATE_C3:
7636b74f9b7SNate Lawson 	default:
76409c22c66SAndriy Gapon 	    if ((cpu_quirks & CPU_QUIRK_NO_C3) != 0) {
76556a70eadSNate Lawson 		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
76656a70eadSNate Lawson 				 "acpi_cpu%d: C3[%d] not available.\n",
76756a70eadSNate Lawson 				 device_get_unit(sc->cpu_dev), i));
7686b74f9b7SNate Lawson 		continue;
769412ef220SAndriy Gapon 	    } else
770412ef220SAndriy Gapon 		cpu_can_deep_sleep = 1;
7716b74f9b7SNate Lawson 	    break;
7726b74f9b7SNate Lawson 	}
7736b74f9b7SNate Lawson 
7746b74f9b7SNate Lawson 	/* Free up any previous register. */
7756b74f9b7SNate Lawson 	if (cx_ptr->p_lvlx != NULL) {
776*f51d43feSAndriy Gapon 	    bus_release_resource(sc->cpu_dev, cx_ptr->res_type, cx_ptr->res_rid,
777*f51d43feSAndriy Gapon 	        cx_ptr->p_lvlx);
7786b74f9b7SNate Lawson 	    cx_ptr->p_lvlx = NULL;
7796b74f9b7SNate Lawson 	}
7806b74f9b7SNate Lawson 
7816b74f9b7SNate Lawson 	/* Allocate the control register for C2 or C3. */
782*f51d43feSAndriy Gapon 	cx_ptr->res_rid = sc->cpu_cx_count;
783*f51d43feSAndriy Gapon 	acpi_PkgGas(sc->cpu_dev, pkg, 0, &cx_ptr->res_type, &cx_ptr->res_rid,
784907b6777SNate Lawson 	    &cx_ptr->p_lvlx, RF_SHAREABLE);
785f4eb0418SNate Lawson 	if (cx_ptr->p_lvlx) {
78656a70eadSNate Lawson 	    ACPI_DEBUG_PRINT((ACPI_DB_INFO,
78756a70eadSNate Lawson 			     "acpi_cpu%d: Got C%d - %d latency\n",
78856a70eadSNate Lawson 			     device_get_unit(sc->cpu_dev), cx_ptr->type,
78956a70eadSNate Lawson 			     cx_ptr->trans_lat));
7906b74f9b7SNate Lawson 	    cx_ptr++;
79156a70eadSNate Lawson 	    sc->cpu_cx_count++;
7926b74f9b7SNate Lawson 	}
7936b74f9b7SNate Lawson     }
7946b74f9b7SNate Lawson     AcpiOsFree(buf.Pointer);
7956b74f9b7SNate Lawson 
79668d5e11cSJung-uk Kim     /* If C1 state was not found, we need one now. */
79768d5e11cSJung-uk Kim     cx_ptr = sc->cpu_cx_states;
79868d5e11cSJung-uk Kim     if (cx_ptr->type == ACPI_STATE_C0) {
79968d5e11cSJung-uk Kim 	cx_ptr->type = ACPI_STATE_C1;
80068d5e11cSJung-uk Kim 	cx_ptr->trans_lat = 0;
80168d5e11cSJung-uk Kim     }
80268d5e11cSJung-uk Kim 
8036b74f9b7SNate Lawson     return (0);
804fec754d4SMike Smith }
805fec754d4SMike Smith 
806fec754d4SMike Smith /*
807fec754d4SMike Smith  * Call this *after* all CPUs have been attached.
808fec754d4SMike Smith  */
809fec754d4SMike Smith static void
8106b74f9b7SNate Lawson acpi_cpu_startup(void *arg)
811fec754d4SMike Smith {
81256a70eadSNate Lawson     struct acpi_cpu_softc *sc;
813907b6777SNate Lawson     int i;
814fec754d4SMike Smith 
815be2b1797SNate Lawson     /* Get set of CPU devices */
8163045c8afSNate Lawson     devclass_get_devices(acpi_cpu_devclass, &cpu_devices, &cpu_ndevices);
817fec754d4SMike Smith 
81856a70eadSNate Lawson     /*
819907b6777SNate Lawson      * Setup any quirks that might necessary now that we have probed
820907b6777SNate Lawson      * all the CPUs
82156a70eadSNate Lawson      */
822907b6777SNate Lawson     acpi_cpu_quirks();
823907b6777SNate Lawson 
824907b6777SNate Lawson     if (cpu_cx_generic) {
825907b6777SNate Lawson 	/*
826907b6777SNate Lawson 	 * We are using generic Cx mode, probe for available Cx states
827907b6777SNate Lawson 	 * for all processors.
828907b6777SNate Lawson 	 */
82956a70eadSNate Lawson 	for (i = 0; i < cpu_ndevices; i++) {
83056a70eadSNate Lawson 	    sc = device_get_softc(cpu_devices[i]);
831907b6777SNate Lawson 	    acpi_cpu_generic_cx_probe(sc);
832907b6777SNate Lawson 	}
833907b6777SNate Lawson     } else {
834907b6777SNate Lawson 	/*
835907b6777SNate Lawson 	 * We are using _CST mode, remove C3 state if necessary.
836907b6777SNate Lawson 	 * As we now know for sure that we will be using _CST mode
837907b6777SNate Lawson 	 * install our notify handler.
838907b6777SNate Lawson 	 */
839907b6777SNate Lawson 	for (i = 0; i < cpu_ndevices; i++) {
840907b6777SNate Lawson 	    sc = device_get_softc(cpu_devices[i]);
8417a310721SJohn Baldwin 	    if (cpu_quirks & CPU_QUIRK_NO_C3) {
842907b6777SNate Lawson 		sc->cpu_cx_count = sc->cpu_non_c3 + 1;
843907b6777SNate Lawson 	    }
844907b6777SNate Lawson 	    AcpiInstallNotifyHandler(sc->cpu_handle, ACPI_DEVICE_NOTIFY,
845907b6777SNate Lawson 		acpi_cpu_notify, sc);
846907b6777SNate Lawson 	}
847907b6777SNate Lawson     }
84856a70eadSNate Lawson 
8498c5468e3SNate Lawson     /* Perform Cx final initialization. */
850907b6777SNate Lawson     for (i = 0; i < cpu_ndevices; i++) {
851907b6777SNate Lawson 	sc = device_get_softc(cpu_devices[i]);
852907b6777SNate Lawson 	acpi_cpu_startup_cx(sc);
853907b6777SNate Lawson     }
854907b6777SNate Lawson 
855907b6777SNate Lawson     /* Add a sysctl handler to handle global Cx lowest setting */
856907b6777SNate Lawson     SYSCTL_ADD_PROC(&cpu_sysctl_ctx, SYSCTL_CHILDREN(cpu_sysctl_tree),
857907b6777SNate Lawson 	OID_AUTO, "cx_lowest", CTLTYPE_STRING | CTLFLAG_RW,
858907b6777SNate Lawson 	NULL, 0, acpi_cpu_global_cx_lowest_sysctl, "A",
859907b6777SNate Lawson 	"Global lowest Cx sleep state to use");
860907b6777SNate Lawson 
861907b6777SNate Lawson     /* Take over idling from cpu_idle_default(). */
862d30b88afSAndriy Gapon     cpu_cx_lowest_lim = 0;
863907b6777SNate Lawson     cpu_disable_idle = FALSE;
864907b6777SNate Lawson     cpu_idle_hook = acpi_cpu_idle;
8656b74f9b7SNate Lawson }
8666b74f9b7SNate Lawson 
86756a70eadSNate Lawson static void
86889ab2a7aSRui Paulo acpi_cpu_cx_list(struct acpi_cpu_softc *sc)
86956a70eadSNate Lawson {
87056a70eadSNate Lawson     struct sbuf sb;
87156a70eadSNate Lawson     int i;
87256a70eadSNate Lawson 
873ae56b59fSNate Lawson     /*
874907b6777SNate Lawson      * Set up the list of Cx states
875ae56b59fSNate Lawson      */
876907b6777SNate Lawson     sbuf_new(&sb, sc->cpu_cx_supported, sizeof(sc->cpu_cx_supported),
877907b6777SNate Lawson 	SBUF_FIXEDLEN);
878412ef220SAndriy Gapon     for (i = 0; i < sc->cpu_cx_count; i++)
8793c5c5559SAlexander Motin 	sbuf_printf(&sb, "C%d/%d/%d ", i + 1, sc->cpu_cx_states[i].type,
8803c5c5559SAlexander Motin 	    sc->cpu_cx_states[i].trans_lat);
88156a70eadSNate Lawson     sbuf_trim(&sb);
88256a70eadSNate Lawson     sbuf_finish(&sb);
88389ab2a7aSRui Paulo }
88489ab2a7aSRui Paulo 
88589ab2a7aSRui Paulo static void
88689ab2a7aSRui Paulo acpi_cpu_startup_cx(struct acpi_cpu_softc *sc)
88789ab2a7aSRui Paulo {
88889ab2a7aSRui Paulo     acpi_cpu_cx_list(sc);
889907b6777SNate Lawson 
890907b6777SNate Lawson     SYSCTL_ADD_STRING(&sc->cpu_sysctl_ctx,
891907b6777SNate Lawson 		      SYSCTL_CHILDREN(device_get_sysctl_tree(sc->cpu_dev)),
892907b6777SNate Lawson 		      OID_AUTO, "cx_supported", CTLFLAG_RD,
893907b6777SNate Lawson 		      sc->cpu_cx_supported, 0,
894907b6777SNate Lawson 		      "Cx/microsecond values for supported Cx states");
895907b6777SNate Lawson     SYSCTL_ADD_PROC(&sc->cpu_sysctl_ctx,
896907b6777SNate Lawson 		    SYSCTL_CHILDREN(device_get_sysctl_tree(sc->cpu_dev)),
897ccc09458SNate Lawson 		    OID_AUTO, "cx_lowest", CTLTYPE_STRING | CTLFLAG_RW,
898907b6777SNate Lawson 		    (void *)sc, 0, acpi_cpu_cx_lowest_sysctl, "A",
89956a70eadSNate Lawson 		    "lowest Cx sleep state to use");
900907b6777SNate Lawson     SYSCTL_ADD_PROC(&sc->cpu_sysctl_ctx,
901907b6777SNate Lawson 		    SYSCTL_CHILDREN(device_get_sysctl_tree(sc->cpu_dev)),
902a2afe45aSNate Lawson 		    OID_AUTO, "cx_usage", CTLTYPE_STRING | CTLFLAG_RD,
903907b6777SNate Lawson 		    (void *)sc, 0, acpi_cpu_usage_sysctl, "A",
904a2afe45aSNate Lawson 		    "percent usage for each Cx state");
90556a70eadSNate Lawson 
90656a70eadSNate Lawson     /* Signal platform that we can handle _CST notification. */
907907b6777SNate Lawson     if (!cpu_cx_generic && cpu_cst_cnt != 0) {
908d92a2ebdSNate Lawson 	ACPI_LOCK(acpi);
90956a70eadSNate Lawson 	AcpiOsWritePort(cpu_smi_cmd, cpu_cst_cnt, 8);
910d92a2ebdSNate Lawson 	ACPI_UNLOCK(acpi);
91156a70eadSNate Lawson     }
91256a70eadSNate Lawson }
91356a70eadSNate Lawson 
914fec754d4SMike Smith /*
915a2afe45aSNate Lawson  * Idle the CPU in the lowest state possible.  This function is called with
916a2afe45aSNate Lawson  * interrupts disabled.  Note that once it re-enables interrupts, a task
917a2afe45aSNate Lawson  * switch can occur so do not access shared data (i.e. the softc) after
918a2afe45aSNate Lawson  * interrupts are re-enabled.
9196b74f9b7SNate Lawson  */
9206b74f9b7SNate Lawson static void
9216b74f9b7SNate Lawson acpi_cpu_idle()
9226b74f9b7SNate Lawson {
9236b74f9b7SNate Lawson     struct	acpi_cpu_softc *sc;
92456a70eadSNate Lawson     struct	acpi_cx *cx_next;
9253c5c5559SAlexander Motin     uint64_t	cputicks;
9266b74f9b7SNate Lawson     uint32_t	start_time, end_time;
927a2afe45aSNate Lawson     int		bm_active, cx_next_idx, i;
9286b74f9b7SNate Lawson 
9296b74f9b7SNate Lawson     /* If disabled, return immediately. */
930907b6777SNate Lawson     if (cpu_disable_idle) {
9316b74f9b7SNate Lawson 	ACPI_ENABLE_IRQS();
9326b74f9b7SNate Lawson 	return;
9336b74f9b7SNate Lawson     }
9346b74f9b7SNate Lawson 
935cd1f3db9SNate Lawson     /*
936cd1f3db9SNate Lawson      * Look up our CPU id to get our softc.  If it's NULL, we'll use C1
937cd1f3db9SNate Lawson      * since there is no ACPI processor object for this CPU.  This occurs
938cd1f3db9SNate Lawson      * for logical CPUs in the HTT case.
939cd1f3db9SNate Lawson      */
940cd1f3db9SNate Lawson     sc = cpu_softc[PCPU_GET(cpuid)];
941cd1f3db9SNate Lawson     if (sc == NULL) {
942cd1f3db9SNate Lawson 	acpi_cpu_c1();
943cd1f3db9SNate Lawson 	return;
944cd1f3db9SNate Lawson     }
945cd1f3db9SNate Lawson 
946bb1d6ad5SAlexander Motin     /* Find the lowest state that has small enough latency. */
947b0baaaaeSAlexander Motin     cx_next_idx = 0;
94855fb7f36SSean Bruno     if (cpu_disable_deep_sleep)
94948fe2e67SAlexander Motin 	i = min(sc->cpu_cx_lowest, sc->cpu_non_c3);
95055fb7f36SSean Bruno     else
951a157e425SAlexander Motin 	i = sc->cpu_cx_lowest;
952a157e425SAlexander Motin     for (; i >= 0; i--) {
953b0baaaaeSAlexander Motin 	if (sc->cpu_cx_states[i].trans_lat * 3 <= sc->cpu_prev_sleep) {
954a2afe45aSNate Lawson 	    cx_next_idx = i;
955a2afe45aSNate Lawson 	    break;
956a2afe45aSNate Lawson 	}
95780f006a1SNate Lawson     }
95856a70eadSNate Lawson 
9596b74f9b7SNate Lawson     /*
9606b74f9b7SNate Lawson      * Check for bus master activity.  If there was activity, clear
9616b74f9b7SNate Lawson      * the bit and use the lowest non-C3 state.  Note that the USB
9626b74f9b7SNate Lawson      * driver polling for new devices keeps this bit set all the
963f435261dSNate Lawson      * time if USB is loaded.
9646b74f9b7SNate Lawson      */
9653c5c5559SAlexander Motin     if ((cpu_quirks & CPU_QUIRK_NO_BM_CTRL) == 0 &&
9663c5c5559SAlexander Motin 	cx_next_idx > sc->cpu_non_c3) {
967129d3046SJung-uk Kim 	AcpiReadBitRegister(ACPI_BITREG_BUS_MASTER_STATUS, &bm_active);
9686b74f9b7SNate Lawson 	if (bm_active != 0) {
969129d3046SJung-uk Kim 	    AcpiWriteBitRegister(ACPI_BITREG_BUS_MASTER_STATUS, 1);
9703c5c5559SAlexander Motin 	    cx_next_idx = sc->cpu_non_c3;
9716b74f9b7SNate Lawson 	}
972f435261dSNate Lawson     }
9736b74f9b7SNate Lawson 
974a2afe45aSNate Lawson     /* Select the next state and update statistics. */
975a2afe45aSNate Lawson     cx_next = &sc->cpu_cx_states[cx_next_idx];
976907b6777SNate Lawson     sc->cpu_cx_stats[cx_next_idx]++;
977a2afe45aSNate Lawson     KASSERT(cx_next->type != ACPI_STATE_C0, ("acpi_cpu_idle: C0 sleep"));
9786b74f9b7SNate Lawson 
9796b74f9b7SNate Lawson     /*
980a2afe45aSNate Lawson      * Execute HLT (or equivalent) and wait for an interrupt.  We can't
9817150e671SAlexander Motin      * precisely calculate the time spent in C1 since the place we wake up
982a157e425SAlexander Motin      * is an ISR.  Assume we slept no more then half of quantum, unless
983a157e425SAlexander Motin      * we are called inside critical section, delaying context switch.
9846b74f9b7SNate Lawson      */
985a2afe45aSNate Lawson     if (cx_next->type == ACPI_STATE_C1) {
9863c5c5559SAlexander Motin 	cputicks = cpu_ticks();
987a2afe45aSNate Lawson 	acpi_cpu_c1();
9883c5c5559SAlexander Motin 	end_time = ((cpu_ticks() - cputicks) << 20) / cpu_tickrate();
989a157e425SAlexander Motin 	if (curthread->td_critnest == 0)
990a157e425SAlexander Motin 		end_time = min(end_time, 500000 / hz);
991a157e425SAlexander Motin 	sc->cpu_prev_sleep = (sc->cpu_prev_sleep * 3 + end_time) / 4;
992a2afe45aSNate Lawson 	return;
993a2afe45aSNate Lawson     }
994a2afe45aSNate Lawson 
995f435261dSNate Lawson     /*
996f435261dSNate Lawson      * For C3, disable bus master arbitration and enable bus master wake
997f435261dSNate Lawson      * if BM control is available, otherwise flush the CPU cache.
998f435261dSNate Lawson      */
999a2afe45aSNate Lawson     if (cx_next->type == ACPI_STATE_C3) {
1000f435261dSNate Lawson 	if ((cpu_quirks & CPU_QUIRK_NO_BM_CTRL) == 0) {
1001129d3046SJung-uk Kim 	    AcpiWriteBitRegister(ACPI_BITREG_ARB_DISABLE, 1);
1002129d3046SJung-uk Kim 	    AcpiWriteBitRegister(ACPI_BITREG_BUS_MASTER_RLD, 1);
1003f435261dSNate Lawson 	} else
1004f435261dSNate Lawson 	    ACPI_FLUSH_CPU_CACHE();
1005a2afe45aSNate Lawson     }
1006a2afe45aSNate Lawson 
10076b74f9b7SNate Lawson     /*
1008a2afe45aSNate Lawson      * Read from P_LVLx to enter C2(+), checking time spent asleep.
10096b74f9b7SNate Lawson      * Use the ACPI timer for measuring sleep time.  Since we need to
10106b74f9b7SNate Lawson      * get the time very close to the CPU start/stop clock logic, this
10116b74f9b7SNate Lawson      * is the only reliable time source.
10126b74f9b7SNate Lawson      */
10133c5c5559SAlexander Motin     if (cx_next->type == ACPI_STATE_C3) {
101492488a57SJung-uk Kim 	AcpiHwRead(&start_time, &AcpiGbl_FADT.XPmTimerBlock);
10153c5c5559SAlexander Motin 	cputicks = 0;
10163c5c5559SAlexander Motin     } else {
10173c5c5559SAlexander Motin 	start_time = 0;
10183c5c5559SAlexander Motin 	cputicks = cpu_ticks();
10193c5c5559SAlexander Motin     }
10206b74f9b7SNate Lawson     CPU_GET_REG(cx_next->p_lvlx, 1);
10216b74f9b7SNate Lawson 
10226b74f9b7SNate Lawson     /*
10236b74f9b7SNate Lawson      * Read the end time twice.  Since it may take an arbitrary time
10246b74f9b7SNate Lawson      * to enter the idle state, the first read may be executed before
10256b74f9b7SNate Lawson      * the processor has stopped.  Doing it again provides enough
10266b74f9b7SNate Lawson      * margin that we are certain to have a correct value.
10276b74f9b7SNate Lawson      */
102892488a57SJung-uk Kim     AcpiHwRead(&end_time, &AcpiGbl_FADT.XPmTimerBlock);
10293c5c5559SAlexander Motin     if (cx_next->type == ACPI_STATE_C3) {
103092488a57SJung-uk Kim 	AcpiHwRead(&end_time, &AcpiGbl_FADT.XPmTimerBlock);
10313c5c5559SAlexander Motin 	end_time = acpi_TimerDelta(end_time, start_time);
10323c5c5559SAlexander Motin     } else
10333c5c5559SAlexander Motin 	end_time = ((cpu_ticks() - cputicks) << 20) / cpu_tickrate();
10346b74f9b7SNate Lawson 
10356b74f9b7SNate Lawson     /* Enable bus master arbitration and disable bus master wakeup. */
103618ececa0SNate Lawson     if (cx_next->type == ACPI_STATE_C3 &&
103718ececa0SNate Lawson 	(cpu_quirks & CPU_QUIRK_NO_BM_CTRL) == 0) {
1038129d3046SJung-uk Kim 	AcpiWriteBitRegister(ACPI_BITREG_ARB_DISABLE, 0);
1039129d3046SJung-uk Kim 	AcpiWriteBitRegister(ACPI_BITREG_BUS_MASTER_RLD, 0);
10406b74f9b7SNate Lawson     }
104180f006a1SNate Lawson     ACPI_ENABLE_IRQS();
10426b74f9b7SNate Lawson 
1043b0baaaaeSAlexander Motin     sc->cpu_prev_sleep = (sc->cpu_prev_sleep * 3 + PM_USEC(end_time)) / 4;
10446b74f9b7SNate Lawson }
10456b74f9b7SNate Lawson 
10466b74f9b7SNate Lawson /*
10478b888c66SNate Lawson  * Re-evaluate the _CST object when we are notified that it 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 
10568b888c66SNate Lawson     if (notify != ACPI_NOTIFY_CX_STATES)
10578b888c66SNate Lawson 	return;
10588b888c66SNate Lawson 
105989ab2a7aSRui Paulo     /* Update the list of Cx states. */
106089ab2a7aSRui Paulo     acpi_cpu_cx_cst(sc);
106189ab2a7aSRui Paulo     acpi_cpu_cx_list(sc);
106289ab2a7aSRui Paulo 
106389ab2a7aSRui Paulo     ACPI_SERIAL_BEGIN(cpu);
1064d30b88afSAndriy Gapon     acpi_cpu_set_cx_lowest(sc);
106589ab2a7aSRui Paulo     ACPI_SERIAL_END(cpu);
1066154fc7b6SAndriy Gapon 
1067154fc7b6SAndriy Gapon     acpi_UserNotify("PROCESSOR", sc->cpu_handle, notify);
10686b74f9b7SNate Lawson }
10696b74f9b7SNate Lawson 
10706b74f9b7SNate Lawson static int
1071907b6777SNate Lawson acpi_cpu_quirks(void)
10726b74f9b7SNate Lawson {
1073ae56b59fSNate Lawson     device_t acpi_dev;
10748a000acaSRui Paulo     uint32_t val;
10756b74f9b7SNate Lawson 
10767826bf98SNate Lawson     ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
10777826bf98SNate Lawson 
10786b74f9b7SNate Lawson     /*
1079907b6777SNate Lawson      * Bus mastering arbitration control is needed to keep caches coherent
1080907b6777SNate Lawson      * while sleeping in C3.  If it's not present but a working flush cache
1081907b6777SNate Lawson      * instruction is present, flush the caches before entering C3 instead.
1082907b6777SNate Lawson      * Otherwise, just disable C3 completely.
10836b74f9b7SNate Lawson      */
10842be4e471SJung-uk Kim     if (AcpiGbl_FADT.Pm2ControlBlock == 0 ||
10852be4e471SJung-uk Kim 	AcpiGbl_FADT.Pm2ControlLength == 0) {
10862be4e471SJung-uk Kim 	if ((AcpiGbl_FADT.Flags & ACPI_FADT_WBINVD) &&
10872be4e471SJung-uk Kim 	    (AcpiGbl_FADT.Flags & ACPI_FADT_WBINVD_FLUSH) == 0) {
1088907b6777SNate Lawson 	    cpu_quirks |= CPU_QUIRK_NO_BM_CTRL;
1089907b6777SNate Lawson 	    ACPI_DEBUG_PRINT((ACPI_DB_INFO,
109030dd6af3SNate Lawson 		"acpi_cpu: no BM control, using flush cache method\n"));
1091907b6777SNate Lawson 	} else {
1092907b6777SNate Lawson 	    cpu_quirks |= CPU_QUIRK_NO_C3;
1093907b6777SNate Lawson 	    ACPI_DEBUG_PRINT((ACPI_DB_INFO,
109430dd6af3SNate Lawson 		"acpi_cpu: no BM control, C3 not available\n"));
1095907b6777SNate Lawson 	}
1096907b6777SNate Lawson     }
1097907b6777SNate Lawson 
1098907b6777SNate Lawson     /*
1099907b6777SNate Lawson      * If we are using generic Cx mode, C3 on multiple CPUs requires using
1100907b6777SNate Lawson      * the expensive flush cache instruction.
1101907b6777SNate Lawson      */
110230dd6af3SNate Lawson     if (cpu_cx_generic && mp_ncpus > 1) {
110318ececa0SNate Lawson 	cpu_quirks |= CPU_QUIRK_NO_BM_CTRL;
110430dd6af3SNate Lawson 	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
110530dd6af3SNate Lawson 	    "acpi_cpu: SMP, using flush cache mode for C3\n"));
110630dd6af3SNate Lawson     }
11076b74f9b7SNate Lawson 
11086b74f9b7SNate Lawson     /* Look for various quirks of the PIIX4 part. */
11096b74f9b7SNate Lawson     acpi_dev = pci_find_device(PCI_VENDOR_INTEL, PCI_DEVICE_82371AB_3);
11106b74f9b7SNate Lawson     if (acpi_dev != NULL) {
11116b74f9b7SNate Lawson 	switch (pci_get_revid(acpi_dev)) {
11126b74f9b7SNate Lawson 	/*
11136b74f9b7SNate Lawson 	 * Disable C3 support for all PIIX4 chipsets.  Some of these parts
11146b74f9b7SNate Lawson 	 * do not report the BMIDE status to the BM status register and
11156b74f9b7SNate Lawson 	 * others have a livelock bug if Type-F DMA is enabled.  Linux
11166b74f9b7SNate Lawson 	 * works around the BMIDE bug by reading the BM status directly
11176b74f9b7SNate Lawson 	 * but we take the simpler approach of disabling C3 for these
11186b74f9b7SNate Lawson 	 * parts.
11196b74f9b7SNate Lawson 	 *
11206b74f9b7SNate Lawson 	 * See erratum #18 ("C3 Power State/BMIDE and Type-F DMA
11216b74f9b7SNate Lawson 	 * Livelock") from the January 2002 PIIX4 specification update.
11226b74f9b7SNate Lawson 	 * Applies to all PIIX4 models.
11238a000acaSRui Paulo 	 *
11248a000acaSRui Paulo 	 * Also, make sure that all interrupts cause a "Stop Break"
11258a000acaSRui Paulo 	 * event to exit from C2 state.
1126f1e1ddc3SAndriy Gapon 	 * Also, BRLD_EN_BM (ACPI_BITREG_BUS_MASTER_RLD in ACPI-speak)
1127f1e1ddc3SAndriy Gapon 	 * should be set to zero, otherwise it causes C2 to short-sleep.
1128f1e1ddc3SAndriy Gapon 	 * PIIX4 doesn't properly support C3 and bus master activity
1129f1e1ddc3SAndriy Gapon 	 * need not break out of C2.
11306b74f9b7SNate Lawson 	 */
11318a000acaSRui Paulo 	case PCI_REVISION_A_STEP:
11328a000acaSRui Paulo 	case PCI_REVISION_B_STEP:
11336b74f9b7SNate Lawson 	case PCI_REVISION_4E:
11346b74f9b7SNate Lawson 	case PCI_REVISION_4M:
11356b74f9b7SNate Lawson 	    cpu_quirks |= CPU_QUIRK_NO_C3;
113630dd6af3SNate Lawson 	    ACPI_DEBUG_PRINT((ACPI_DB_INFO,
113730dd6af3SNate Lawson 		"acpi_cpu: working around PIIX4 bug, disabling C3\n"));
11388a000acaSRui Paulo 
11398a000acaSRui Paulo 	    val = pci_read_config(acpi_dev, PIIX4_DEVACTB_REG, 4);
11408a000acaSRui Paulo 	    if ((val & PIIX4_STOP_BREAK_MASK) != PIIX4_STOP_BREAK_MASK) {
11418a000acaSRui Paulo 		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1142f1e1ddc3SAndriy Gapon 		    "acpi_cpu: PIIX4: enabling IRQs to generate Stop Break\n"));
11438a000acaSRui Paulo 	    	val |= PIIX4_STOP_BREAK_MASK;
11448a000acaSRui Paulo 		pci_write_config(acpi_dev, PIIX4_DEVACTB_REG, val, 4);
11458a000acaSRui Paulo 	    }
1146129d3046SJung-uk Kim 	    AcpiReadBitRegister(ACPI_BITREG_BUS_MASTER_RLD, &val);
1147f1e1ddc3SAndriy Gapon 	    if (val) {
1148f1e1ddc3SAndriy Gapon 		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1149f1e1ddc3SAndriy Gapon 		    "acpi_cpu: PIIX4: reset BRLD_EN_BM\n"));
1150129d3046SJung-uk Kim 		AcpiWriteBitRegister(ACPI_BITREG_BUS_MASTER_RLD, 0);
1151f1e1ddc3SAndriy Gapon 	    }
11526b74f9b7SNate Lawson 	    break;
11536b74f9b7SNate Lawson 	default:
11546b74f9b7SNate Lawson 	    break;
11556b74f9b7SNate Lawson 	}
11566b74f9b7SNate Lawson     }
11576b74f9b7SNate Lawson 
11586b74f9b7SNate Lawson     return (0);
11596b74f9b7SNate Lawson }
11606b74f9b7SNate Lawson 
11616b74f9b7SNate Lawson static int
1162a2afe45aSNate Lawson acpi_cpu_usage_sysctl(SYSCTL_HANDLER_ARGS)
11636b74f9b7SNate Lawson {
1164907b6777SNate Lawson     struct acpi_cpu_softc *sc;
11656b74f9b7SNate Lawson     struct sbuf	 sb;
11666b74f9b7SNate Lawson     char	 buf[128];
11676b74f9b7SNate Lawson     int		 i;
11684a03551dSNate Lawson     uintmax_t	 fract, sum, whole;
11696b74f9b7SNate Lawson 
1170907b6777SNate Lawson     sc = (struct acpi_cpu_softc *) arg1;
11713e7fa136SNate Lawson     sum = 0;
1172907b6777SNate Lawson     for (i = 0; i < sc->cpu_cx_count; i++)
1173907b6777SNate Lawson 	sum += sc->cpu_cx_stats[i];
11746b74f9b7SNate Lawson     sbuf_new(&sb, buf, sizeof(buf), SBUF_FIXEDLEN);
1175907b6777SNate Lawson     for (i = 0; i < sc->cpu_cx_count; i++) {
11763e7fa136SNate Lawson 	if (sum > 0) {
1177907b6777SNate Lawson 	    whole = (uintmax_t)sc->cpu_cx_stats[i] * 100;
11783e7fa136SNate Lawson 	    fract = (whole % sum) * 100;
11793e7fa136SNate Lawson 	    sbuf_printf(&sb, "%u.%02u%% ", (u_int)(whole / sum),
11803e7fa136SNate Lawson 		(u_int)(fract / sum));
11813e7fa136SNate Lawson 	} else
11822500b6d9SAlexander Motin 	    sbuf_printf(&sb, "0.00%% ");
11833e7fa136SNate Lawson     }
11842500b6d9SAlexander Motin     sbuf_printf(&sb, "last %dus", sc->cpu_prev_sleep);
11856b74f9b7SNate Lawson     sbuf_trim(&sb);
11866b74f9b7SNate Lawson     sbuf_finish(&sb);
1187ccc09458SNate Lawson     sysctl_handle_string(oidp, sbuf_data(&sb), sbuf_len(&sb), req);
1188ccc09458SNate Lawson     sbuf_delete(&sb);
11896b74f9b7SNate Lawson 
11906b74f9b7SNate Lawson     return (0);
11916b74f9b7SNate Lawson }
11926b74f9b7SNate Lawson 
11936b74f9b7SNate Lawson static int
1194d30b88afSAndriy Gapon acpi_cpu_set_cx_lowest(struct acpi_cpu_softc *sc)
11956b74f9b7SNate Lawson {
1196b13cf774SNate Lawson     int i;
11976b74f9b7SNate Lawson 
1198b13cf774SNate Lawson     ACPI_SERIAL_ASSERT(cpu);
1199d30b88afSAndriy Gapon     sc->cpu_cx_lowest = min(sc->cpu_cx_lowest_lim, sc->cpu_cx_count - 1);
1200907b6777SNate Lawson 
1201907b6777SNate Lawson     /* If not disabling, cache the new lowest non-C3 state. */
1202907b6777SNate Lawson     sc->cpu_non_c3 = 0;
1203907b6777SNate Lawson     for (i = sc->cpu_cx_lowest; i >= 0; i--) {
1204907b6777SNate Lawson 	if (sc->cpu_cx_states[i].type < ACPI_STATE_C3) {
1205907b6777SNate Lawson 	    sc->cpu_non_c3 = i;
1206907b6777SNate Lawson 	    break;
1207907b6777SNate Lawson 	}
1208907b6777SNate Lawson     }
1209907b6777SNate Lawson 
1210907b6777SNate Lawson     /* Reset the statistics counters. */
1211907b6777SNate Lawson     bzero(sc->cpu_cx_stats, sizeof(sc->cpu_cx_stats));
1212b13cf774SNate Lawson     return (0);
1213b13cf774SNate Lawson }
1214b13cf774SNate Lawson 
1215b13cf774SNate Lawson static int
1216b13cf774SNate Lawson acpi_cpu_cx_lowest_sysctl(SYSCTL_HANDLER_ARGS)
1217b13cf774SNate Lawson {
1218b13cf774SNate Lawson     struct	 acpi_cpu_softc *sc;
1219b13cf774SNate Lawson     char	 state[8];
1220b13cf774SNate Lawson     int		 val, error;
1221b13cf774SNate Lawson 
1222b13cf774SNate Lawson     sc = (struct acpi_cpu_softc *) arg1;
1223d30b88afSAndriy Gapon     snprintf(state, sizeof(state), "C%d", sc->cpu_cx_lowest_lim + 1);
1224b13cf774SNate Lawson     error = sysctl_handle_string(oidp, state, sizeof(state), req);
1225b13cf774SNate Lawson     if (error != 0 || req->newptr == NULL)
1226b13cf774SNate Lawson 	return (error);
1227b13cf774SNate Lawson     if (strlen(state) < 2 || toupper(state[0]) != 'C')
1228b13cf774SNate Lawson 	return (EINVAL);
1229d30b88afSAndriy Gapon     if (strcasecmp(state, "Cmax") == 0)
1230d30b88afSAndriy Gapon 	val = MAX_CX_STATES;
1231d30b88afSAndriy Gapon     else {
1232d30b88afSAndriy Gapon 	val = (int) strtol(state + 1, NULL, 10);
1233d30b88afSAndriy Gapon 	if (val < 1 || val > MAX_CX_STATES)
1234b13cf774SNate Lawson 	    return (EINVAL);
1235d30b88afSAndriy Gapon     }
1236b13cf774SNate Lawson 
1237b13cf774SNate Lawson     ACPI_SERIAL_BEGIN(cpu);
1238d30b88afSAndriy Gapon     sc->cpu_cx_lowest_lim = val - 1;
1239d30b88afSAndriy Gapon     acpi_cpu_set_cx_lowest(sc);
1240907b6777SNate Lawson     ACPI_SERIAL_END(cpu);
1241907b6777SNate Lawson 
124255fb7f36SSean Bruno     return (0);
1243907b6777SNate Lawson }
1244907b6777SNate Lawson 
1245907b6777SNate Lawson static int
1246907b6777SNate Lawson acpi_cpu_global_cx_lowest_sysctl(SYSCTL_HANDLER_ARGS)
1247907b6777SNate Lawson {
1248907b6777SNate Lawson     struct	acpi_cpu_softc *sc;
1249907b6777SNate Lawson     char	state[8];
1250b13cf774SNate Lawson     int		val, error, i;
1251907b6777SNate Lawson 
1252d30b88afSAndriy Gapon     snprintf(state, sizeof(state), "C%d", cpu_cx_lowest_lim + 1);
1253ccc09458SNate Lawson     error = sysctl_handle_string(oidp, state, sizeof(state), req);
12546b74f9b7SNate Lawson     if (error != 0 || req->newptr == NULL)
12556b74f9b7SNate Lawson 	return (error);
1256ccc09458SNate Lawson     if (strlen(state) < 2 || toupper(state[0]) != 'C')
1257ccc09458SNate Lawson 	return (EINVAL);
1258d30b88afSAndriy Gapon     if (strcasecmp(state, "Cmax") == 0)
1259d30b88afSAndriy Gapon 	val = MAX_CX_STATES;
1260d30b88afSAndriy Gapon     else {
1261d30b88afSAndriy Gapon 	val = (int) strtol(state + 1, NULL, 10);
1262d30b88afSAndriy Gapon 	if (val < 1 || val > MAX_CX_STATES)
12636b74f9b7SNate Lawson 	    return (EINVAL);
1264d30b88afSAndriy Gapon     }
12656b74f9b7SNate Lawson 
1266b13cf774SNate Lawson     /* Update the new lowest useable Cx state for all CPUs. */
1267907b6777SNate Lawson     ACPI_SERIAL_BEGIN(cpu);
1268d30b88afSAndriy Gapon     cpu_cx_lowest_lim = val - 1;
1269907b6777SNate Lawson     for (i = 0; i < cpu_ndevices; i++) {
1270907b6777SNate Lawson 	sc = device_get_softc(cpu_devices[i]);
1271d30b88afSAndriy Gapon 	sc->cpu_cx_lowest_lim = cpu_cx_lowest_lim;
1272d30b88afSAndriy Gapon 	acpi_cpu_set_cx_lowest(sc);
1273907b6777SNate Lawson     }
1274d92a2ebdSNate Lawson     ACPI_SERIAL_END(cpu);
12756b74f9b7SNate Lawson 
12766b74f9b7SNate Lawson     return (0);
12776b74f9b7SNate Lawson }
1278