acpi_cpu.c revision 1.18.2.3
1 1.18.2.2 uebayasi /* $NetBSD: acpi_cpu.c,v 1.18.2.3 2010/10/22 07:21:51 uebayasi Exp $ */ 2 1.18.2.2 uebayasi 3 1.18.2.2 uebayasi /*- 4 1.18.2.2 uebayasi * Copyright (c) 2010 Jukka Ruohonen <jruohonen (at) iki.fi> 5 1.18.2.2 uebayasi * All rights reserved. 6 1.18.2.2 uebayasi * 7 1.18.2.2 uebayasi * Redistribution and use in source and binary forms, with or without 8 1.18.2.2 uebayasi * modification, are permitted provided that the following conditions 9 1.18.2.2 uebayasi * are met: 10 1.18.2.2 uebayasi * 11 1.18.2.2 uebayasi * 1. Redistributions of source code must retain the above copyright 12 1.18.2.2 uebayasi * notice, this list of conditions and the following disclaimer. 13 1.18.2.2 uebayasi * 2. Redistributions in binary form must reproduce the above copyright 14 1.18.2.2 uebayasi * notice, this list of conditions and the following disclaimer in the 15 1.18.2.2 uebayasi * documentation and/or other materials provided with the distribution. 16 1.18.2.2 uebayasi * 17 1.18.2.2 uebayasi * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18 1.18.2.2 uebayasi * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 1.18.2.2 uebayasi * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 1.18.2.2 uebayasi * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 1.18.2.2 uebayasi * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 1.18.2.2 uebayasi * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 1.18.2.2 uebayasi * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 1.18.2.2 uebayasi * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 1.18.2.2 uebayasi * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 1.18.2.2 uebayasi * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 1.18.2.2 uebayasi * SUCH DAMAGE. 28 1.18.2.2 uebayasi */ 29 1.18.2.2 uebayasi #include <sys/cdefs.h> 30 1.18.2.2 uebayasi __KERNEL_RCSID(0, "$NetBSD: acpi_cpu.c,v 1.18.2.3 2010/10/22 07:21:51 uebayasi Exp $"); 31 1.18.2.2 uebayasi 32 1.18.2.2 uebayasi #include <sys/param.h> 33 1.18.2.2 uebayasi #include <sys/cpu.h> 34 1.18.2.2 uebayasi #include <sys/kernel.h> 35 1.18.2.2 uebayasi #include <sys/kmem.h> 36 1.18.2.2 uebayasi #include <sys/module.h> 37 1.18.2.2 uebayasi #include <sys/mutex.h> 38 1.18.2.2 uebayasi #include <sys/once.h> 39 1.18.2.2 uebayasi 40 1.18.2.2 uebayasi #include <dev/acpi/acpireg.h> 41 1.18.2.2 uebayasi #include <dev/acpi/acpivar.h> 42 1.18.2.2 uebayasi #include <dev/acpi/acpi_cpu.h> 43 1.18.2.2 uebayasi 44 1.18.2.2 uebayasi #include <machine/acpi_machdep.h> 45 1.18.2.2 uebayasi 46 1.18.2.2 uebayasi #define _COMPONENT ACPI_BUS_COMPONENT 47 1.18.2.2 uebayasi ACPI_MODULE_NAME ("acpi_cpu") 48 1.18.2.2 uebayasi 49 1.18.2.2 uebayasi static int acpicpu_match(device_t, cfdata_t, void *); 50 1.18.2.2 uebayasi static void acpicpu_attach(device_t, device_t, void *); 51 1.18.2.2 uebayasi static int acpicpu_detach(device_t, int); 52 1.18.2.2 uebayasi static int acpicpu_once_attach(void); 53 1.18.2.2 uebayasi static int acpicpu_once_detach(void); 54 1.18.2.3 uebayasi static void acpicpu_prestart(device_t); 55 1.18.2.3 uebayasi static void acpicpu_start(device_t); 56 1.18.2.2 uebayasi 57 1.18.2.2 uebayasi static int acpicpu_object(ACPI_HANDLE, struct acpicpu_object *); 58 1.18.2.2 uebayasi static cpuid_t acpicpu_id(uint32_t); 59 1.18.2.2 uebayasi static uint32_t acpicpu_cap(struct acpicpu_softc *); 60 1.18.2.3 uebayasi static ACPI_STATUS acpicpu_cap_pdc(struct acpicpu_softc *, uint32_t); 61 1.18.2.3 uebayasi static ACPI_STATUS acpicpu_cap_osc(struct acpicpu_softc *, 62 1.18.2.3 uebayasi uint32_t, uint32_t *); 63 1.18.2.2 uebayasi static void acpicpu_notify(ACPI_HANDLE, uint32_t, void *); 64 1.18.2.2 uebayasi static bool acpicpu_suspend(device_t, const pmf_qual_t *); 65 1.18.2.2 uebayasi static bool acpicpu_resume(device_t, const pmf_qual_t *); 66 1.18.2.2 uebayasi 67 1.18.2.2 uebayasi struct acpicpu_softc **acpicpu_sc = NULL; 68 1.18.2.2 uebayasi 69 1.18.2.2 uebayasi static const char * const acpicpu_hid[] = { 70 1.18.2.2 uebayasi "ACPI0007", 71 1.18.2.2 uebayasi NULL 72 1.18.2.2 uebayasi }; 73 1.18.2.2 uebayasi 74 1.18.2.2 uebayasi CFATTACH_DECL_NEW(acpicpu, sizeof(struct acpicpu_softc), 75 1.18.2.2 uebayasi acpicpu_match, acpicpu_attach, acpicpu_detach, NULL); 76 1.18.2.2 uebayasi 77 1.18.2.2 uebayasi static int 78 1.18.2.2 uebayasi acpicpu_match(device_t parent, cfdata_t match, void *aux) 79 1.18.2.2 uebayasi { 80 1.18.2.2 uebayasi struct acpi_attach_args *aa = aux; 81 1.18.2.2 uebayasi struct acpicpu_object ao; 82 1.18.2.2 uebayasi int rv; 83 1.18.2.2 uebayasi 84 1.18.2.2 uebayasi if (aa->aa_node->ad_type != ACPI_TYPE_PROCESSOR) 85 1.18.2.2 uebayasi return 0; 86 1.18.2.2 uebayasi 87 1.18.2.2 uebayasi if (acpi_match_hid(aa->aa_node->ad_devinfo, acpicpu_hid) != 0) 88 1.18.2.2 uebayasi return 1; 89 1.18.2.2 uebayasi 90 1.18.2.2 uebayasi rv = acpicpu_object(aa->aa_node->ad_handle, &ao); 91 1.18.2.2 uebayasi 92 1.18.2.2 uebayasi if (rv != 0 || acpicpu_id(ao.ao_procid) == 0xFFFFFF) 93 1.18.2.2 uebayasi return 0; 94 1.18.2.2 uebayasi 95 1.18.2.2 uebayasi return 1; 96 1.18.2.2 uebayasi } 97 1.18.2.2 uebayasi 98 1.18.2.2 uebayasi static void 99 1.18.2.2 uebayasi acpicpu_attach(device_t parent, device_t self, void *aux) 100 1.18.2.2 uebayasi { 101 1.18.2.2 uebayasi struct acpicpu_softc *sc = device_private(self); 102 1.18.2.2 uebayasi struct acpi_attach_args *aa = aux; 103 1.18.2.2 uebayasi static ONCE_DECL(once_attach); 104 1.18.2.2 uebayasi int rv; 105 1.18.2.2 uebayasi 106 1.18.2.2 uebayasi rv = acpicpu_object(aa->aa_node->ad_handle, &sc->sc_object); 107 1.18.2.2 uebayasi 108 1.18.2.2 uebayasi if (rv != 0) 109 1.18.2.2 uebayasi return; 110 1.18.2.2 uebayasi 111 1.18.2.2 uebayasi rv = RUN_ONCE(&once_attach, acpicpu_once_attach); 112 1.18.2.2 uebayasi 113 1.18.2.2 uebayasi if (rv != 0) 114 1.18.2.2 uebayasi return; 115 1.18.2.2 uebayasi 116 1.18.2.2 uebayasi sc->sc_dev = self; 117 1.18.2.3 uebayasi sc->sc_cold = true; 118 1.18.2.3 uebayasi sc->sc_passive = false; 119 1.18.2.2 uebayasi sc->sc_node = aa->aa_node; 120 1.18.2.2 uebayasi sc->sc_cpuid = acpicpu_id(sc->sc_object.ao_procid); 121 1.18.2.2 uebayasi 122 1.18.2.2 uebayasi if (sc->sc_cpuid == 0xFFFFFF) { 123 1.18.2.2 uebayasi aprint_error(": invalid CPU ID\n"); 124 1.18.2.2 uebayasi return; 125 1.18.2.2 uebayasi } 126 1.18.2.2 uebayasi 127 1.18.2.2 uebayasi if (acpicpu_sc[sc->sc_cpuid] != NULL) { 128 1.18.2.2 uebayasi aprint_error(": already attached\n"); 129 1.18.2.2 uebayasi return; 130 1.18.2.2 uebayasi } 131 1.18.2.2 uebayasi 132 1.18.2.3 uebayasi aprint_naive("\n"); 133 1.18.2.3 uebayasi aprint_normal(": ACPI CPU\n"); 134 1.18.2.3 uebayasi 135 1.18.2.2 uebayasi acpicpu_sc[sc->sc_cpuid] = sc; 136 1.18.2.2 uebayasi 137 1.18.2.2 uebayasi sc->sc_cap = acpicpu_cap(sc); 138 1.18.2.2 uebayasi sc->sc_flags |= acpicpu_md_quirks(); 139 1.18.2.2 uebayasi 140 1.18.2.2 uebayasi mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_NONE); 141 1.18.2.2 uebayasi 142 1.18.2.2 uebayasi acpicpu_cstate_attach(self); 143 1.18.2.2 uebayasi acpicpu_pstate_attach(self); 144 1.18.2.2 uebayasi acpicpu_tstate_attach(self); 145 1.18.2.2 uebayasi 146 1.18.2.3 uebayasi (void)config_defer(self, acpicpu_prestart); 147 1.18.2.2 uebayasi (void)acpi_register_notify(sc->sc_node, acpicpu_notify); 148 1.18.2.2 uebayasi (void)pmf_device_register(self, acpicpu_suspend, acpicpu_resume); 149 1.18.2.2 uebayasi } 150 1.18.2.2 uebayasi 151 1.18.2.2 uebayasi static int 152 1.18.2.2 uebayasi acpicpu_detach(device_t self, int flags) 153 1.18.2.2 uebayasi { 154 1.18.2.2 uebayasi struct acpicpu_softc *sc = device_private(self); 155 1.18.2.2 uebayasi static ONCE_DECL(once_detach); 156 1.18.2.2 uebayasi int rv = 0; 157 1.18.2.2 uebayasi 158 1.18.2.2 uebayasi sc->sc_cold = true; 159 1.18.2.2 uebayasi acpi_deregister_notify(sc->sc_node); 160 1.18.2.2 uebayasi 161 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_C) != 0) 162 1.18.2.2 uebayasi rv = acpicpu_cstate_detach(self); 163 1.18.2.2 uebayasi 164 1.18.2.2 uebayasi if (rv != 0) 165 1.18.2.2 uebayasi return rv; 166 1.18.2.2 uebayasi 167 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_P) != 0) 168 1.18.2.2 uebayasi rv = acpicpu_pstate_detach(self); 169 1.18.2.2 uebayasi 170 1.18.2.2 uebayasi if (rv != 0) 171 1.18.2.2 uebayasi return rv; 172 1.18.2.2 uebayasi 173 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_T) != 0) 174 1.18.2.2 uebayasi rv = acpicpu_tstate_detach(self); 175 1.18.2.2 uebayasi 176 1.18.2.2 uebayasi if (rv != 0) 177 1.18.2.2 uebayasi return rv; 178 1.18.2.2 uebayasi 179 1.18.2.2 uebayasi rv = RUN_ONCE(&once_detach, acpicpu_once_detach); 180 1.18.2.2 uebayasi 181 1.18.2.2 uebayasi if (rv != 0) 182 1.18.2.2 uebayasi return rv; 183 1.18.2.2 uebayasi 184 1.18.2.2 uebayasi mutex_destroy(&sc->sc_mtx); 185 1.18.2.2 uebayasi 186 1.18.2.2 uebayasi return 0; 187 1.18.2.2 uebayasi } 188 1.18.2.2 uebayasi 189 1.18.2.2 uebayasi static int 190 1.18.2.2 uebayasi acpicpu_once_attach(void) 191 1.18.2.2 uebayasi { 192 1.18.2.2 uebayasi struct acpicpu_softc *sc; 193 1.18.2.2 uebayasi unsigned int i; 194 1.18.2.2 uebayasi 195 1.18.2.2 uebayasi acpicpu_sc = kmem_zalloc(maxcpus * sizeof(*sc), KM_SLEEP); 196 1.18.2.2 uebayasi 197 1.18.2.2 uebayasi if (acpicpu_sc == NULL) 198 1.18.2.2 uebayasi return ENOMEM; 199 1.18.2.2 uebayasi 200 1.18.2.2 uebayasi for (i = 0; i < maxcpus; i++) 201 1.18.2.2 uebayasi acpicpu_sc[i] = NULL; 202 1.18.2.2 uebayasi 203 1.18.2.2 uebayasi return 0; 204 1.18.2.2 uebayasi } 205 1.18.2.2 uebayasi 206 1.18.2.2 uebayasi static int 207 1.18.2.2 uebayasi acpicpu_once_detach(void) 208 1.18.2.2 uebayasi { 209 1.18.2.2 uebayasi struct acpicpu_softc *sc; 210 1.18.2.2 uebayasi 211 1.18.2.3 uebayasi if (acpicpu_sc != NULL) 212 1.18.2.3 uebayasi kmem_free(acpicpu_sc, maxcpus * sizeof(*sc)); 213 1.18.2.2 uebayasi 214 1.18.2.2 uebayasi return 0; 215 1.18.2.2 uebayasi } 216 1.18.2.2 uebayasi 217 1.18.2.3 uebayasi static void 218 1.18.2.3 uebayasi acpicpu_prestart(device_t self) 219 1.18.2.3 uebayasi { 220 1.18.2.3 uebayasi struct acpicpu_softc *sc = device_private(self); 221 1.18.2.3 uebayasi static bool once = false; 222 1.18.2.3 uebayasi 223 1.18.2.3 uebayasi if (once != false) { 224 1.18.2.3 uebayasi sc->sc_cold = false; 225 1.18.2.3 uebayasi return; 226 1.18.2.3 uebayasi } 227 1.18.2.3 uebayasi 228 1.18.2.3 uebayasi once = true; 229 1.18.2.3 uebayasi 230 1.18.2.3 uebayasi (void)config_interrupts(self, acpicpu_start); 231 1.18.2.3 uebayasi } 232 1.18.2.3 uebayasi 233 1.18.2.3 uebayasi static void 234 1.18.2.3 uebayasi acpicpu_start(device_t self) 235 1.18.2.3 uebayasi { 236 1.18.2.3 uebayasi struct acpicpu_softc *sc = device_private(self); 237 1.18.2.3 uebayasi 238 1.18.2.3 uebayasi /* 239 1.18.2.3 uebayasi * Run the state-specific initialization 240 1.18.2.3 uebayasi * routines. These should be called only 241 1.18.2.3 uebayasi * once, after interrupts are enabled and 242 1.18.2.3 uebayasi * all ACPI CPUs have attached. 243 1.18.2.3 uebayasi */ 244 1.18.2.3 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_C) != 0) 245 1.18.2.3 uebayasi acpicpu_cstate_start(self); 246 1.18.2.3 uebayasi 247 1.18.2.3 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_P) != 0) 248 1.18.2.3 uebayasi acpicpu_pstate_start(self); 249 1.18.2.3 uebayasi 250 1.18.2.3 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_T) != 0) 251 1.18.2.3 uebayasi acpicpu_tstate_start(self); 252 1.18.2.3 uebayasi 253 1.18.2.3 uebayasi aprint_debug_dev(sc->sc_dev, "ACPI CPUs started (cap " 254 1.18.2.3 uebayasi "0x%02x, flags 0x%06x)\n", sc->sc_cap, sc->sc_flags); 255 1.18.2.3 uebayasi 256 1.18.2.3 uebayasi sc->sc_cold = false; 257 1.18.2.3 uebayasi } 258 1.18.2.3 uebayasi 259 1.18.2.2 uebayasi static int 260 1.18.2.2 uebayasi acpicpu_object(ACPI_HANDLE hdl, struct acpicpu_object *ao) 261 1.18.2.2 uebayasi { 262 1.18.2.2 uebayasi ACPI_OBJECT *obj; 263 1.18.2.2 uebayasi ACPI_BUFFER buf; 264 1.18.2.2 uebayasi ACPI_STATUS rv; 265 1.18.2.2 uebayasi 266 1.18.2.2 uebayasi rv = acpi_eval_struct(hdl, NULL, &buf); 267 1.18.2.2 uebayasi 268 1.18.2.2 uebayasi if (ACPI_FAILURE(rv)) 269 1.18.2.2 uebayasi return 1; 270 1.18.2.2 uebayasi 271 1.18.2.2 uebayasi obj = buf.Pointer; 272 1.18.2.2 uebayasi 273 1.18.2.2 uebayasi if (obj->Type != ACPI_TYPE_PROCESSOR) { 274 1.18.2.2 uebayasi rv = AE_TYPE; 275 1.18.2.2 uebayasi goto out; 276 1.18.2.2 uebayasi } 277 1.18.2.2 uebayasi 278 1.18.2.2 uebayasi if (obj->Processor.ProcId > (uint32_t)maxcpus) { 279 1.18.2.2 uebayasi rv = AE_LIMIT; 280 1.18.2.2 uebayasi goto out; 281 1.18.2.2 uebayasi } 282 1.18.2.2 uebayasi 283 1.18.2.2 uebayasi KDASSERT((uint64_t)obj->Processor.PblkAddress < UINT32_MAX); 284 1.18.2.2 uebayasi 285 1.18.2.2 uebayasi if (ao != NULL) { 286 1.18.2.2 uebayasi ao->ao_procid = obj->Processor.ProcId; 287 1.18.2.2 uebayasi ao->ao_pblklen = obj->Processor.PblkLength; 288 1.18.2.2 uebayasi ao->ao_pblkaddr = obj->Processor.PblkAddress; 289 1.18.2.2 uebayasi } 290 1.18.2.2 uebayasi 291 1.18.2.2 uebayasi out: 292 1.18.2.2 uebayasi if (buf.Pointer != NULL) 293 1.18.2.2 uebayasi ACPI_FREE(buf.Pointer); 294 1.18.2.2 uebayasi 295 1.18.2.2 uebayasi return ACPI_FAILURE(rv) ? 1 : 0; 296 1.18.2.2 uebayasi } 297 1.18.2.2 uebayasi 298 1.18.2.2 uebayasi static cpuid_t 299 1.18.2.2 uebayasi acpicpu_id(uint32_t id) 300 1.18.2.2 uebayasi { 301 1.18.2.2 uebayasi CPU_INFO_ITERATOR cii; 302 1.18.2.2 uebayasi struct cpu_info *ci; 303 1.18.2.2 uebayasi 304 1.18.2.2 uebayasi for (CPU_INFO_FOREACH(cii, ci)) { 305 1.18.2.2 uebayasi 306 1.18.2.2 uebayasi if (id == ci->ci_acpiid) 307 1.18.2.2 uebayasi return id; 308 1.18.2.2 uebayasi } 309 1.18.2.2 uebayasi 310 1.18.2.2 uebayasi return 0xFFFFFF; 311 1.18.2.2 uebayasi } 312 1.18.2.2 uebayasi 313 1.18.2.2 uebayasi static uint32_t 314 1.18.2.2 uebayasi acpicpu_cap(struct acpicpu_softc *sc) 315 1.18.2.2 uebayasi { 316 1.18.2.3 uebayasi uint32_t flags, cap = 0; 317 1.18.2.3 uebayasi const char *str; 318 1.18.2.2 uebayasi ACPI_STATUS rv; 319 1.18.2.2 uebayasi 320 1.18.2.2 uebayasi /* 321 1.18.2.3 uebayasi * Query and set machine-dependent capabilities. 322 1.18.2.3 uebayasi * Note that the Intel-specific _PDC method was 323 1.18.2.3 uebayasi * deprecated in the ACPI 3.0 in favor of _OSC. 324 1.18.2.2 uebayasi */ 325 1.18.2.3 uebayasi flags = acpicpu_md_cap(); 326 1.18.2.3 uebayasi rv = acpicpu_cap_osc(sc, flags, &cap); 327 1.18.2.2 uebayasi 328 1.18.2.3 uebayasi if (ACPI_FAILURE(rv) && rv != AE_NOT_FOUND) { 329 1.18.2.3 uebayasi str = "_OSC"; 330 1.18.2.3 uebayasi goto fail; 331 1.18.2.3 uebayasi } 332 1.18.2.2 uebayasi 333 1.18.2.3 uebayasi rv = acpicpu_cap_pdc(sc, flags); 334 1.18.2.2 uebayasi 335 1.18.2.3 uebayasi if (ACPI_FAILURE(rv) && rv != AE_NOT_FOUND) { 336 1.18.2.3 uebayasi str = "_PDC"; 337 1.18.2.3 uebayasi goto fail; 338 1.18.2.3 uebayasi } 339 1.18.2.2 uebayasi 340 1.18.2.3 uebayasi if (cap == 0) 341 1.18.2.3 uebayasi cap = flags; 342 1.18.2.2 uebayasi 343 1.18.2.3 uebayasi return cap; 344 1.18.2.2 uebayasi 345 1.18.2.3 uebayasi fail: 346 1.18.2.3 uebayasi aprint_error_dev(sc->sc_dev, "failed to evaluate " 347 1.18.2.3 uebayasi "%s: %s\n", str, AcpiFormatException(rv)); 348 1.18.2.2 uebayasi 349 1.18.2.3 uebayasi return 0; 350 1.18.2.2 uebayasi } 351 1.18.2.2 uebayasi 352 1.18.2.3 uebayasi static ACPI_STATUS 353 1.18.2.3 uebayasi acpicpu_cap_pdc(struct acpicpu_softc *sc, uint32_t flags) 354 1.18.2.2 uebayasi { 355 1.18.2.3 uebayasi ACPI_OBJECT_LIST arg; 356 1.18.2.3 uebayasi ACPI_OBJECT obj; 357 1.18.2.3 uebayasi uint32_t cap[3]; 358 1.18.2.3 uebayasi 359 1.18.2.3 uebayasi arg.Count = 1; 360 1.18.2.3 uebayasi arg.Pointer = &obj; 361 1.18.2.2 uebayasi 362 1.18.2.2 uebayasi cap[0] = ACPICPU_PDC_REVID; 363 1.18.2.2 uebayasi cap[1] = 1; 364 1.18.2.3 uebayasi cap[2] = flags; 365 1.18.2.2 uebayasi 366 1.18.2.2 uebayasi obj.Type = ACPI_TYPE_BUFFER; 367 1.18.2.2 uebayasi obj.Buffer.Length = sizeof(cap); 368 1.18.2.3 uebayasi obj.Buffer.Pointer = (void *)cap; 369 1.18.2.2 uebayasi 370 1.18.2.3 uebayasi return AcpiEvaluateObject(sc->sc_node->ad_handle, "_PDC", &arg, NULL); 371 1.18.2.2 uebayasi } 372 1.18.2.2 uebayasi 373 1.18.2.2 uebayasi static ACPI_STATUS 374 1.18.2.3 uebayasi acpicpu_cap_osc(struct acpicpu_softc *sc, uint32_t flags, uint32_t *val) 375 1.18.2.2 uebayasi { 376 1.18.2.3 uebayasi ACPI_OBJECT_LIST arg; 377 1.18.2.3 uebayasi ACPI_OBJECT obj[4]; 378 1.18.2.3 uebayasi ACPI_OBJECT *osc; 379 1.18.2.2 uebayasi ACPI_BUFFER buf; 380 1.18.2.2 uebayasi ACPI_STATUS rv; 381 1.18.2.3 uebayasi uint32_t cap[2]; 382 1.18.2.3 uebayasi uint32_t *ptr; 383 1.18.2.3 uebayasi int i = 5; 384 1.18.2.2 uebayasi 385 1.18.2.3 uebayasi static uint8_t intel_uuid[16] = { 386 1.18.2.2 uebayasi 0x16, 0xA6, 0x77, 0x40, 0x0C, 0x29, 0xBE, 0x47, 387 1.18.2.2 uebayasi 0x9E, 0xBD, 0xD8, 0x70, 0x58, 0x71, 0x39, 0x53 388 1.18.2.2 uebayasi }; 389 1.18.2.2 uebayasi 390 1.18.2.3 uebayasi cap[0] = ACPI_OSC_QUERY; 391 1.18.2.3 uebayasi cap[1] = flags; 392 1.18.2.2 uebayasi 393 1.18.2.3 uebayasi again: 394 1.18.2.3 uebayasi arg.Count = 4; 395 1.18.2.3 uebayasi arg.Pointer = obj; 396 1.18.2.3 uebayasi 397 1.18.2.3 uebayasi obj[0].Type = ACPI_TYPE_BUFFER; 398 1.18.2.3 uebayasi obj[0].Buffer.Length = sizeof(intel_uuid); 399 1.18.2.3 uebayasi obj[0].Buffer.Pointer = intel_uuid; 400 1.18.2.3 uebayasi 401 1.18.2.3 uebayasi obj[1].Type = ACPI_TYPE_INTEGER; 402 1.18.2.3 uebayasi obj[1].Integer.Value = ACPICPU_PDC_REVID; 403 1.18.2.3 uebayasi 404 1.18.2.3 uebayasi obj[2].Type = ACPI_TYPE_INTEGER; 405 1.18.2.3 uebayasi obj[2].Integer.Value = __arraycount(cap); 406 1.18.2.3 uebayasi 407 1.18.2.3 uebayasi obj[3].Type = ACPI_TYPE_BUFFER; 408 1.18.2.3 uebayasi obj[3].Buffer.Length = sizeof(cap); 409 1.18.2.3 uebayasi obj[3].Buffer.Pointer = (void *)cap; 410 1.18.2.2 uebayasi 411 1.18.2.2 uebayasi buf.Pointer = NULL; 412 1.18.2.2 uebayasi buf.Length = ACPI_ALLOCATE_LOCAL_BUFFER; 413 1.18.2.2 uebayasi 414 1.18.2.3 uebayasi rv = AcpiEvaluateObject(sc->sc_node->ad_handle, "_OSC", &arg, &buf); 415 1.18.2.2 uebayasi 416 1.18.2.2 uebayasi if (ACPI_FAILURE(rv)) 417 1.18.2.3 uebayasi goto out; 418 1.18.2.2 uebayasi 419 1.18.2.3 uebayasi osc = buf.Pointer; 420 1.18.2.2 uebayasi 421 1.18.2.3 uebayasi if (osc->Type != ACPI_TYPE_BUFFER) { 422 1.18.2.2 uebayasi rv = AE_TYPE; 423 1.18.2.2 uebayasi goto out; 424 1.18.2.2 uebayasi } 425 1.18.2.2 uebayasi 426 1.18.2.3 uebayasi if (osc->Buffer.Length != sizeof(cap)) { 427 1.18.2.2 uebayasi rv = AE_BUFFER_OVERFLOW; 428 1.18.2.2 uebayasi goto out; 429 1.18.2.2 uebayasi } 430 1.18.2.2 uebayasi 431 1.18.2.3 uebayasi ptr = (uint32_t *)osc->Buffer.Pointer; 432 1.18.2.2 uebayasi 433 1.18.2.3 uebayasi if ((ptr[0] & ACPI_OSC_ERROR) != 0) { 434 1.18.2.3 uebayasi rv = AE_ERROR; 435 1.18.2.3 uebayasi goto out; 436 1.18.2.3 uebayasi } 437 1.18.2.2 uebayasi 438 1.18.2.3 uebayasi if ((ptr[0] & (ACPI_OSC_ERROR_REV | ACPI_OSC_ERROR_UUID)) != 0) { 439 1.18.2.3 uebayasi rv = AE_BAD_PARAMETER; 440 1.18.2.3 uebayasi goto out; 441 1.18.2.3 uebayasi } 442 1.18.2.2 uebayasi 443 1.18.2.3 uebayasi /* 444 1.18.2.3 uebayasi * "It is strongly recommended that the OS evaluate 445 1.18.2.3 uebayasi * _OSC with the Query Support Flag set until _OSC 446 1.18.2.3 uebayasi * returns the Capabilities Masked bit clear, to 447 1.18.2.3 uebayasi * negotiate the set of features to be granted to 448 1.18.2.3 uebayasi * the OS for native support (ACPI 4.0, 6.2.10)." 449 1.18.2.3 uebayasi */ 450 1.18.2.3 uebayasi if ((ptr[0] & ACPI_OSC_ERROR_MASKED) != 0 && i >= 0) { 451 1.18.2.3 uebayasi 452 1.18.2.3 uebayasi ACPI_FREE(buf.Pointer); 453 1.18.2.3 uebayasi i--; 454 1.18.2.2 uebayasi 455 1.18.2.3 uebayasi goto again; 456 1.18.2.3 uebayasi } 457 1.18.2.3 uebayasi 458 1.18.2.3 uebayasi if ((cap[0] & ACPI_OSC_QUERY) != 0) { 459 1.18.2.2 uebayasi 460 1.18.2.3 uebayasi ACPI_FREE(buf.Pointer); 461 1.18.2.3 uebayasi cap[0] &= ~ACPI_OSC_QUERY; 462 1.18.2.2 uebayasi 463 1.18.2.3 uebayasi goto again; 464 1.18.2.3 uebayasi } 465 1.18.2.2 uebayasi 466 1.18.2.3 uebayasi /* 467 1.18.2.3 uebayasi * It is permitted for _OSC to return all 468 1.18.2.3 uebayasi * bits cleared, but this is specified to 469 1.18.2.3 uebayasi * vary on per-device basis. Assume that 470 1.18.2.3 uebayasi * everything rather than nothing will be 471 1.18.2.3 uebayasi * supported in thise case; we do not need 472 1.18.2.3 uebayasi * the firmware to know the CPU features. 473 1.18.2.3 uebayasi */ 474 1.18.2.3 uebayasi *val = (ptr[1] != 0) ? ptr[1] : cap[1]; 475 1.18.2.2 uebayasi 476 1.18.2.3 uebayasi out: 477 1.18.2.3 uebayasi if (buf.Pointer != NULL) 478 1.18.2.3 uebayasi ACPI_FREE(buf.Pointer); 479 1.18.2.2 uebayasi 480 1.18.2.3 uebayasi return rv; 481 1.18.2.2 uebayasi } 482 1.18.2.2 uebayasi 483 1.18.2.2 uebayasi static void 484 1.18.2.2 uebayasi acpicpu_notify(ACPI_HANDLE hdl, uint32_t evt, void *aux) 485 1.18.2.2 uebayasi { 486 1.18.2.2 uebayasi ACPI_OSD_EXEC_CALLBACK func; 487 1.18.2.2 uebayasi struct acpicpu_softc *sc; 488 1.18.2.2 uebayasi device_t self = aux; 489 1.18.2.2 uebayasi 490 1.18.2.2 uebayasi sc = device_private(self); 491 1.18.2.2 uebayasi 492 1.18.2.2 uebayasi if (sc->sc_cold != false) 493 1.18.2.2 uebayasi return; 494 1.18.2.2 uebayasi 495 1.18.2.2 uebayasi switch (evt) { 496 1.18.2.2 uebayasi 497 1.18.2.2 uebayasi case ACPICPU_C_NOTIFY: 498 1.18.2.2 uebayasi 499 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_C) == 0) 500 1.18.2.2 uebayasi return; 501 1.18.2.2 uebayasi 502 1.18.2.2 uebayasi func = acpicpu_cstate_callback; 503 1.18.2.2 uebayasi break; 504 1.18.2.2 uebayasi 505 1.18.2.2 uebayasi case ACPICPU_P_NOTIFY: 506 1.18.2.2 uebayasi 507 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_P) == 0) 508 1.18.2.2 uebayasi return; 509 1.18.2.2 uebayasi 510 1.18.2.2 uebayasi func = acpicpu_pstate_callback; 511 1.18.2.2 uebayasi break; 512 1.18.2.2 uebayasi 513 1.18.2.2 uebayasi case ACPICPU_T_NOTIFY: 514 1.18.2.2 uebayasi 515 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_T) == 0) 516 1.18.2.2 uebayasi return; 517 1.18.2.2 uebayasi 518 1.18.2.2 uebayasi func = acpicpu_tstate_callback; 519 1.18.2.2 uebayasi break; 520 1.18.2.2 uebayasi 521 1.18.2.2 uebayasi default: 522 1.18.2.2 uebayasi aprint_error_dev(sc->sc_dev, "unknown notify: 0x%02X\n", evt); 523 1.18.2.2 uebayasi return; 524 1.18.2.2 uebayasi } 525 1.18.2.2 uebayasi 526 1.18.2.2 uebayasi (void)AcpiOsExecute(OSL_NOTIFY_HANDLER, func, sc->sc_dev); 527 1.18.2.2 uebayasi } 528 1.18.2.2 uebayasi 529 1.18.2.2 uebayasi static bool 530 1.18.2.2 uebayasi acpicpu_suspend(device_t self, const pmf_qual_t *qual) 531 1.18.2.2 uebayasi { 532 1.18.2.2 uebayasi struct acpicpu_softc *sc = device_private(self); 533 1.18.2.2 uebayasi 534 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_C) != 0) 535 1.18.2.2 uebayasi (void)acpicpu_cstate_suspend(self); 536 1.18.2.2 uebayasi 537 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_P) != 0) 538 1.18.2.2 uebayasi (void)acpicpu_pstate_suspend(self); 539 1.18.2.2 uebayasi 540 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_T) != 0) 541 1.18.2.2 uebayasi (void)acpicpu_tstate_suspend(self); 542 1.18.2.2 uebayasi 543 1.18.2.3 uebayasi sc->sc_cold = true; 544 1.18.2.3 uebayasi 545 1.18.2.2 uebayasi return true; 546 1.18.2.2 uebayasi } 547 1.18.2.2 uebayasi 548 1.18.2.2 uebayasi static bool 549 1.18.2.2 uebayasi acpicpu_resume(device_t self, const pmf_qual_t *qual) 550 1.18.2.2 uebayasi { 551 1.18.2.2 uebayasi struct acpicpu_softc *sc = device_private(self); 552 1.18.2.2 uebayasi 553 1.18.2.3 uebayasi sc->sc_cold = false; 554 1.18.2.3 uebayasi 555 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_C) != 0) 556 1.18.2.2 uebayasi (void)acpicpu_cstate_resume(self); 557 1.18.2.2 uebayasi 558 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_P) != 0) 559 1.18.2.2 uebayasi (void)acpicpu_pstate_resume(self); 560 1.18.2.2 uebayasi 561 1.18.2.2 uebayasi if ((sc->sc_flags & ACPICPU_FLAG_T) != 0) 562 1.18.2.2 uebayasi (void)acpicpu_tstate_resume(self); 563 1.18.2.2 uebayasi 564 1.18.2.2 uebayasi return true; 565 1.18.2.2 uebayasi } 566 1.18.2.2 uebayasi 567 1.18.2.2 uebayasi #ifdef _MODULE 568 1.18.2.2 uebayasi 569 1.18.2.2 uebayasi MODULE(MODULE_CLASS_DRIVER, acpicpu, NULL); 570 1.18.2.2 uebayasi CFDRIVER_DECL(acpicpu, DV_DULL, NULL); 571 1.18.2.2 uebayasi 572 1.18.2.2 uebayasi static int acpicpuloc[] = { -1 }; 573 1.18.2.2 uebayasi extern struct cfattach acpicpu_ca; 574 1.18.2.2 uebayasi 575 1.18.2.2 uebayasi static struct cfparent acpiparent = { 576 1.18.2.2 uebayasi "acpinodebus", NULL, DVUNIT_ANY 577 1.18.2.2 uebayasi }; 578 1.18.2.2 uebayasi 579 1.18.2.2 uebayasi static struct cfdata acpicpu_cfdata[] = { 580 1.18.2.2 uebayasi { 581 1.18.2.2 uebayasi .cf_name = "acpicpu", 582 1.18.2.2 uebayasi .cf_atname = "acpicpu", 583 1.18.2.2 uebayasi .cf_unit = 0, 584 1.18.2.2 uebayasi .cf_fstate = FSTATE_STAR, 585 1.18.2.2 uebayasi .cf_loc = acpicpuloc, 586 1.18.2.2 uebayasi .cf_flags = 0, 587 1.18.2.2 uebayasi .cf_pspec = &acpiparent, 588 1.18.2.2 uebayasi }, 589 1.18.2.2 uebayasi 590 1.18.2.2 uebayasi { NULL, NULL, 0, 0, NULL, 0, NULL } 591 1.18.2.2 uebayasi }; 592 1.18.2.2 uebayasi 593 1.18.2.2 uebayasi static int 594 1.18.2.2 uebayasi acpicpu_modcmd(modcmd_t cmd, void *context) 595 1.18.2.2 uebayasi { 596 1.18.2.2 uebayasi int err; 597 1.18.2.2 uebayasi 598 1.18.2.2 uebayasi switch (cmd) { 599 1.18.2.2 uebayasi 600 1.18.2.2 uebayasi case MODULE_CMD_INIT: 601 1.18.2.2 uebayasi 602 1.18.2.2 uebayasi err = config_cfdriver_attach(&acpicpu_cd); 603 1.18.2.2 uebayasi 604 1.18.2.2 uebayasi if (err != 0) 605 1.18.2.2 uebayasi return err; 606 1.18.2.2 uebayasi 607 1.18.2.2 uebayasi err = config_cfattach_attach("acpicpu", &acpicpu_ca); 608 1.18.2.2 uebayasi 609 1.18.2.2 uebayasi if (err != 0) { 610 1.18.2.2 uebayasi config_cfdriver_detach(&acpicpu_cd); 611 1.18.2.2 uebayasi return err; 612 1.18.2.2 uebayasi } 613 1.18.2.2 uebayasi 614 1.18.2.2 uebayasi err = config_cfdata_attach(acpicpu_cfdata, 1); 615 1.18.2.2 uebayasi 616 1.18.2.2 uebayasi if (err != 0) { 617 1.18.2.2 uebayasi config_cfattach_detach("acpicpu", &acpicpu_ca); 618 1.18.2.2 uebayasi config_cfdriver_detach(&acpicpu_cd); 619 1.18.2.2 uebayasi return err; 620 1.18.2.2 uebayasi } 621 1.18.2.2 uebayasi 622 1.18.2.2 uebayasi return 0; 623 1.18.2.2 uebayasi 624 1.18.2.2 uebayasi case MODULE_CMD_FINI: 625 1.18.2.2 uebayasi 626 1.18.2.2 uebayasi err = config_cfdata_detach(acpicpu_cfdata); 627 1.18.2.2 uebayasi 628 1.18.2.2 uebayasi if (err != 0) 629 1.18.2.2 uebayasi return err; 630 1.18.2.2 uebayasi 631 1.18.2.2 uebayasi config_cfattach_detach("acpicpu", &acpicpu_ca); 632 1.18.2.2 uebayasi config_cfdriver_detach(&acpicpu_cd); 633 1.18.2.2 uebayasi 634 1.18.2.2 uebayasi return 0; 635 1.18.2.2 uebayasi 636 1.18.2.2 uebayasi default: 637 1.18.2.2 uebayasi return ENOTTY; 638 1.18.2.2 uebayasi } 639 1.18.2.2 uebayasi } 640 1.18.2.2 uebayasi 641 1.18.2.2 uebayasi #endif /* _MODULE */ 642
Indexes created Wed Oct 01 19:09:53 GMT 2025