acpi_pmtr.c revision 1.3.2.2
1 1.3.2.2 rmind /* $NetBSD: acpi_pmtr.c,v 1.3.2.2 2011/03/05 20:53:03 rmind Exp $ */ 2 1.3.2.2 rmind 3 1.3.2.2 rmind /*- 4 1.3.2.2 rmind * Copyright (c) 2011 Jukka Ruohonen <jruohonen (at) iki.fi> 5 1.3.2.2 rmind * All rights reserved. 6 1.3.2.2 rmind * 7 1.3.2.2 rmind * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 rmind * modification, are permitted provided that the following conditions 9 1.3.2.2 rmind * are met: 10 1.3.2.2 rmind * 11 1.3.2.2 rmind * 1. Redistributions of source code must retain the above copyright 12 1.3.2.2 rmind * notice, this list of conditions and the following disclaimer. 13 1.3.2.2 rmind * 2. Redistributions in binary form must reproduce the above copyright 14 1.3.2.2 rmind * notice, this list of conditions and the following disclaimer in the 15 1.3.2.2 rmind * documentation and/or other materials provided with the distribution. 16 1.3.2.2 rmind * 17 1.3.2.2 rmind * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18 1.3.2.2 rmind * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 1.3.2.2 rmind * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 1.3.2.2 rmind * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 1.3.2.2 rmind * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 1.3.2.2 rmind * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 1.3.2.2 rmind * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 1.3.2.2 rmind * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 1.3.2.2 rmind * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 1.3.2.2 rmind * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 1.3.2.2 rmind * SUCH DAMAGE. 28 1.3.2.2 rmind */ 29 1.3.2.2 rmind #include <sys/cdefs.h> 30 1.3.2.2 rmind __KERNEL_RCSID(0, "$NetBSD: acpi_pmtr.c,v 1.3.2.2 2011/03/05 20:53:03 rmind Exp $"); 31 1.3.2.2 rmind 32 1.3.2.2 rmind #include <sys/param.h> 33 1.3.2.2 rmind #include <sys/module.h> 34 1.3.2.2 rmind 35 1.3.2.2 rmind #include <dev/acpi/acpireg.h> 36 1.3.2.2 rmind #include <dev/acpi/acpivar.h> 37 1.3.2.2 rmind 38 1.3.2.2 rmind #include <dev/sysmon/sysmonvar.h> 39 1.3.2.2 rmind 40 1.3.2.2 rmind #define _COMPONENT ACPI_RESOURCE_COMPONENT 41 1.3.2.2 rmind ACPI_MODULE_NAME ("acpi_pmtr") 42 1.3.2.2 rmind 43 1.3.2.2 rmind #define ACPIPMTR_CAP_FLAGS 0 44 1.3.2.2 rmind #define ACPIPMTR_CAP_UNIT 1 45 1.3.2.2 rmind #define ACPIPMTR_CAP_TYPE 2 46 1.3.2.2 rmind #define ACPIPMTR_CAP_ACCURACY 3 47 1.3.2.2 rmind #define ACPIPMTR_CAP_SAMPLING 4 48 1.3.2.2 rmind #define ACPIPMTR_CAP_IVAL_MIN 5 49 1.3.2.2 rmind #define ACPIPMTR_CAP_IVAL_MAX 6 50 1.3.2.2 rmind #define ACPIPMTR_CAP_HYSTERESIS 7 51 1.3.2.2 rmind #define ACPIPMTR_CAP_HWLIMIT 8 52 1.3.2.2 rmind #define ACPIPMTR_CAP_HWLIMIT_MIN 9 53 1.3.2.2 rmind #define ACPIPMTR_CAP_HWLIMIT_MAX 10 54 1.3.2.2 rmind #define ACPIPMTR_CAP_COUNT 11 55 1.3.2.2 rmind /* ACPIPMTR_CAP_MODEL 11 */ 56 1.3.2.2 rmind /* ACPIPMTR_CAP_SERIAL 12 */ 57 1.3.2.2 rmind /* ACPIPMTR_CAP_OEM 13 */ 58 1.3.2.2 rmind 59 1.3.2.2 rmind #define ACPIPMTR_FLAGS_MEASURE __BIT(0) 60 1.3.2.2 rmind #define ACPIPMTR_FLAGS_TRIP __BIT(1) 61 1.3.2.2 rmind #define ACPIPMTR_FLAGS_HWLIMIT __BIT(2) 62 1.3.2.2 rmind #define ACPIPMTR_FLAGS_NOTIFY __BIT(3) 63 1.3.2.2 rmind #define ACPIPMTR_FLAGS_DISCHARGE __BIT(8) 64 1.3.2.2 rmind 65 1.3.2.2 rmind #define ACPIPMTR_POWER_INPUT 0x00 66 1.3.2.2 rmind #define ACPIPMTR_POWER_OUTPUT 0x01 67 1.3.2.2 rmind 68 1.3.2.2 rmind #define ACPIPMTR_NOTIFY_CAP 0x80 69 1.3.2.2 rmind #define ACPIPMTR_NOTIFY_TRIP 0x81 70 1.3.2.2 rmind #define ACPIPMTR_NOTIFY_HWLIMIT1 0x82 71 1.3.2.2 rmind #define ACPIPMTR_NOTIFY_HWLIMIT2 0x83 72 1.3.2.2 rmind #define ACPIPMTR_NOTIFY_INTERVAL 0x84 73 1.3.2.2 rmind 74 1.3.2.2 rmind struct acpipmtr_softc { 75 1.3.2.2 rmind device_t sc_dev; 76 1.3.2.2 rmind struct acpi_devnode *sc_node; 77 1.3.2.2 rmind struct sysmon_envsys *sc_sme; 78 1.3.2.2 rmind envsys_data_t sc_sensor_i; 79 1.3.2.2 rmind envsys_data_t sc_sensor_o; 80 1.3.2.2 rmind uint32_t sc_cap[ACPIPMTR_CAP_COUNT]; 81 1.3.2.2 rmind int32_t sc_interval; 82 1.3.2.2 rmind }; 83 1.3.2.2 rmind 84 1.3.2.2 rmind const char * const acpi_pmtr_ids[] = { 85 1.3.2.2 rmind "ACPI000D", 86 1.3.2.2 rmind NULL 87 1.3.2.2 rmind }; 88 1.3.2.2 rmind 89 1.3.2.2 rmind static int acpipmtr_match(device_t, cfdata_t, void *); 90 1.3.2.2 rmind static void acpipmtr_attach(device_t, device_t, void *); 91 1.3.2.2 rmind static int acpipmtr_detach(device_t, int); 92 1.3.2.2 rmind static bool acpipmtr_cap_get(device_t, bool); 93 1.3.2.2 rmind static bool acpipmtr_dev_print(device_t); 94 1.3.2.2 rmind static bool acpipmtr_sensor_init(device_t); 95 1.3.2.2 rmind static void acpipmtr_sensor_type(device_t); 96 1.3.2.2 rmind static int32_t acpipmtr_sensor_get(device_t, const char *); 97 1.3.2.2 rmind static int32_t acpipmtr_sensor_get_reading(device_t); 98 1.3.2.2 rmind static int32_t acpipmtr_sensor_get_interval(device_t); 99 1.3.2.2 rmind static void acpipmtr_sensor_refresh(struct sysmon_envsys*,envsys_data_t *); 100 1.3.2.2 rmind static void acpipmtr_notify(ACPI_HANDLE, uint32_t, void *); 101 1.3.2.2 rmind 102 1.3.2.2 rmind CFATTACH_DECL_NEW(acpipmtr, sizeof(struct acpipmtr_softc), 103 1.3.2.2 rmind acpipmtr_match, acpipmtr_attach, acpipmtr_detach, NULL); 104 1.3.2.2 rmind 105 1.3.2.2 rmind static int 106 1.3.2.2 rmind acpipmtr_match(device_t parent, cfdata_t match, void *aux) 107 1.3.2.2 rmind { 108 1.3.2.2 rmind struct acpi_attach_args *aa = aux; 109 1.3.2.2 rmind 110 1.3.2.2 rmind if (aa->aa_node->ad_type != ACPI_TYPE_DEVICE) 111 1.3.2.2 rmind return 0; 112 1.3.2.2 rmind 113 1.3.2.2 rmind return acpi_match_hid(aa->aa_node->ad_devinfo, acpi_pmtr_ids); 114 1.3.2.2 rmind } 115 1.3.2.2 rmind 116 1.3.2.2 rmind static void 117 1.3.2.2 rmind acpipmtr_attach(device_t parent, device_t self, void *aux) 118 1.3.2.2 rmind { 119 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 120 1.3.2.2 rmind struct acpi_attach_args *aa = aux; 121 1.3.2.2 rmind uint32_t acc; 122 1.3.2.2 rmind 123 1.3.2.2 rmind sc->sc_sme = NULL; 124 1.3.2.2 rmind sc->sc_dev = self; 125 1.3.2.2 rmind sc->sc_node = aa->aa_node; 126 1.3.2.2 rmind 127 1.3.2.2 rmind aprint_naive("\n"); 128 1.3.2.2 rmind aprint_normal(": ACPI Power Meter\n"); 129 1.3.2.2 rmind 130 1.3.2.2 rmind (void)pmf_device_register(self, NULL, NULL); 131 1.3.2.2 rmind 132 1.3.2.2 rmind if (acpipmtr_cap_get(self, true) != true) 133 1.3.2.2 rmind return; 134 1.3.2.2 rmind 135 1.3.2.2 rmind if (acpipmtr_sensor_init(self) != true) 136 1.3.2.2 rmind return; 137 1.3.2.2 rmind 138 1.3.2.2 rmind (void)acpipmtr_dev_print(self); 139 1.3.2.2 rmind (void)acpi_register_notify(sc->sc_node, acpipmtr_notify); 140 1.3.2.2 rmind 141 1.3.2.2 rmind if ((acc = sc->sc_cap[ACPIPMTR_CAP_ACCURACY]) == 0) 142 1.3.2.2 rmind acc = 100000; 143 1.3.2.2 rmind 144 1.3.2.2 rmind aprint_verbose_dev(self, 145 1.3.2.2 rmind "measuring %s power at %u.%u %% accuracy, %u ms sampling\n", 146 1.3.2.2 rmind (sc->sc_cap[ACPIPMTR_CAP_TYPE] != 0) ? "output" : "input", 147 1.3.2.2 rmind acc / 1000, acc % 1000, sc->sc_cap[ACPIPMTR_CAP_SAMPLING]); 148 1.3.2.2 rmind 149 1.3.2.2 rmind aprint_debug_dev(self, "%s hw-limits, capabilities 0x%02x\n", 150 1.3.2.2 rmind (sc->sc_cap[ACPIPMTR_CAP_HWLIMIT] != 0) ? "rw" : "ro", 151 1.3.2.2 rmind sc->sc_cap[ACPIPMTR_CAP_FLAGS]); 152 1.3.2.2 rmind } 153 1.3.2.2 rmind 154 1.3.2.2 rmind static int 155 1.3.2.2 rmind acpipmtr_detach(device_t self, int flags) 156 1.3.2.2 rmind { 157 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 158 1.3.2.2 rmind 159 1.3.2.2 rmind pmf_device_deregister(self); 160 1.3.2.2 rmind acpi_deregister_notify(sc->sc_node); 161 1.3.2.2 rmind 162 1.3.2.2 rmind if (sc->sc_sme != NULL) 163 1.3.2.2 rmind sysmon_envsys_unregister(sc->sc_sme); 164 1.3.2.2 rmind 165 1.3.2.2 rmind return 0; 166 1.3.2.2 rmind } 167 1.3.2.2 rmind 168 1.3.2.2 rmind static bool 169 1.3.2.2 rmind acpipmtr_cap_get(device_t self, bool print) 170 1.3.2.2 rmind { 171 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 172 1.3.2.2 rmind ACPI_OBJECT *elm, *obj; 173 1.3.2.2 rmind ACPI_BUFFER buf; 174 1.3.2.2 rmind ACPI_STATUS rv; 175 1.3.2.2 rmind uint32_t i; 176 1.3.2.2 rmind 177 1.3.2.2 rmind for (i = 0; i < __arraycount(sc->sc_cap); i++) 178 1.3.2.2 rmind sc->sc_cap[i] = 0; 179 1.3.2.2 rmind 180 1.3.2.2 rmind rv = acpi_eval_struct(sc->sc_node->ad_handle, "_PMC", &buf); 181 1.3.2.2 rmind 182 1.3.2.2 rmind if (ACPI_FAILURE(rv)) 183 1.3.2.2 rmind goto out; 184 1.3.2.2 rmind 185 1.3.2.2 rmind obj = buf.Pointer; 186 1.3.2.2 rmind 187 1.3.2.2 rmind if (obj->Type != ACPI_TYPE_PACKAGE) { 188 1.3.2.2 rmind rv = AE_TYPE; 189 1.3.2.2 rmind goto out; 190 1.3.2.2 rmind } 191 1.3.2.2 rmind 192 1.3.2.2 rmind elm = obj->Package.Elements; 193 1.3.2.2 rmind 194 1.3.2.2 rmind if (obj->Package.Count != 14) { 195 1.3.2.2 rmind rv = AE_LIMIT; 196 1.3.2.2 rmind goto out; 197 1.3.2.2 rmind } 198 1.3.2.2 rmind 199 1.3.2.2 rmind CTASSERT(__arraycount(sc->sc_cap) == 11); 200 1.3.2.2 rmind 201 1.3.2.2 rmind for (i = 0; i < __arraycount(sc->sc_cap); i++) { 202 1.3.2.2 rmind 203 1.3.2.2 rmind if (elm[i].Type != ACPI_TYPE_INTEGER) { 204 1.3.2.2 rmind rv = AE_TYPE; 205 1.3.2.2 rmind goto out; 206 1.3.2.2 rmind } 207 1.3.2.2 rmind 208 1.3.2.2 rmind if (elm[i].Integer.Value > UINT32_MAX) { 209 1.3.2.2 rmind rv = AE_AML_NUMERIC_OVERFLOW; 210 1.3.2.2 rmind goto out; 211 1.3.2.2 rmind } 212 1.3.2.2 rmind 213 1.3.2.2 rmind sc->sc_cap[i] = elm[i].Integer.Value; 214 1.3.2.2 rmind } 215 1.3.2.2 rmind 216 1.3.2.2 rmind if (print != true) 217 1.3.2.2 rmind goto out; 218 1.3.2.2 rmind 219 1.3.2.2 rmind for (; i < 14; i++) { 220 1.3.2.2 rmind 221 1.3.2.2 rmind if (elm[i].Type != ACPI_TYPE_STRING) 222 1.3.2.2 rmind goto out; 223 1.3.2.2 rmind 224 1.3.2.2 rmind if (elm[i].String.Pointer == NULL) 225 1.3.2.2 rmind goto out; 226 1.3.2.2 rmind 227 1.3.2.2 rmind if (elm[i].String.Pointer[0] == '\0') 228 1.3.2.2 rmind goto out; 229 1.3.2.2 rmind } 230 1.3.2.2 rmind 231 1.3.2.2 rmind aprint_debug_dev(self, "%s, serial %s, " 232 1.3.2.2 rmind "model %s\n", elm[13].String.Pointer, 233 1.3.2.2 rmind elm[12].String.Pointer, elm[11].String.Pointer); 234 1.3.2.2 rmind 235 1.3.2.2 rmind out: 236 1.3.2.2 rmind if (ACPI_FAILURE(rv)) 237 1.3.2.2 rmind aprint_error_dev(self, "failed to evaluate _PMC: %s\n", 238 1.3.2.2 rmind AcpiFormatException(rv)); 239 1.3.2.2 rmind 240 1.3.2.2 rmind if (buf.Pointer != NULL) 241 1.3.2.2 rmind ACPI_FREE(buf.Pointer); 242 1.3.2.2 rmind 243 1.3.2.2 rmind return (rv != AE_OK) ? false : true; 244 1.3.2.2 rmind } 245 1.3.2.2 rmind 246 1.3.2.2 rmind static bool 247 1.3.2.2 rmind acpipmtr_dev_print(device_t self) 248 1.3.2.2 rmind { 249 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 250 1.3.2.2 rmind struct acpi_devnode *ad; 251 1.3.2.2 rmind ACPI_OBJECT *elm, *obj; 252 1.3.2.2 rmind ACPI_BUFFER buf; 253 1.3.2.2 rmind ACPI_HANDLE hdl; 254 1.3.2.2 rmind ACPI_STATUS rv; 255 1.3.2.2 rmind uint32_t i, n; 256 1.3.2.2 rmind 257 1.3.2.2 rmind /* 258 1.3.2.2 rmind * The _PMD method returns a package of devices whose total power 259 1.3.2.2 rmind * drawn should roughly correspond with the readings from the meter. 260 1.3.2.2 rmind */ 261 1.3.2.2 rmind rv = acpi_eval_struct(sc->sc_node->ad_handle, "_PMD", &buf); 262 1.3.2.2 rmind 263 1.3.2.2 rmind if (ACPI_FAILURE(rv)) 264 1.3.2.2 rmind goto out; 265 1.3.2.2 rmind 266 1.3.2.2 rmind obj = buf.Pointer; 267 1.3.2.2 rmind 268 1.3.2.2 rmind if (obj->Type != ACPI_TYPE_PACKAGE) { 269 1.3.2.2 rmind rv = AE_TYPE; 270 1.3.2.2 rmind goto out; 271 1.3.2.2 rmind } 272 1.3.2.2 rmind 273 1.3.2.2 rmind n = obj->Package.Count; 274 1.3.2.2 rmind 275 1.3.2.2 rmind if (n == 0) { 276 1.3.2.2 rmind rv = AE_LIMIT; 277 1.3.2.2 rmind goto out; 278 1.3.2.2 rmind } 279 1.3.2.2 rmind 280 1.3.2.2 rmind aprint_debug_dev(self, "measured devices: "); 281 1.3.2.2 rmind 282 1.3.2.2 rmind for (i = 0; i < n; i++) { 283 1.3.2.2 rmind 284 1.3.2.2 rmind elm = &obj->Package.Elements[i]; 285 1.3.2.2 rmind rv = acpi_eval_reference_handle(elm, &hdl); 286 1.3.2.2 rmind 287 1.3.2.2 rmind if (ACPI_FAILURE(rv)) 288 1.3.2.2 rmind continue; 289 1.3.2.2 rmind 290 1.3.2.2 rmind ad = acpi_get_node(hdl); 291 1.3.2.2 rmind 292 1.3.2.2 rmind if (ad == NULL) 293 1.3.2.2 rmind continue; 294 1.3.2.2 rmind 295 1.3.2.2 rmind aprint_debug("%s ", ad->ad_name); 296 1.3.2.2 rmind } 297 1.3.2.2 rmind 298 1.3.2.2 rmind aprint_debug("\n"); 299 1.3.2.2 rmind 300 1.3.2.2 rmind out: 301 1.3.2.2 rmind if (ACPI_FAILURE(rv)) 302 1.3.2.2 rmind aprint_debug_dev(self, "failed to evaluate _PMD: %s\n", 303 1.3.2.2 rmind AcpiFormatException(rv)); 304 1.3.2.2 rmind 305 1.3.2.2 rmind if (buf.Pointer != NULL) 306 1.3.2.2 rmind ACPI_FREE(buf.Pointer); 307 1.3.2.2 rmind 308 1.3.2.2 rmind return (rv != AE_OK) ? false : true; 309 1.3.2.2 rmind } 310 1.3.2.2 rmind 311 1.3.2.2 rmind static bool 312 1.3.2.2 rmind acpipmtr_sensor_init(device_t self) 313 1.3.2.2 rmind { 314 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 315 1.3.2.2 rmind const size_t siz = sizeof(sc->sc_sensor_i.desc); 316 1.3.2.2 rmind int32_t val; 317 1.3.2.2 rmind 318 1.3.2.2 rmind val = acpipmtr_sensor_get_reading(self); 319 1.3.2.2 rmind sc->sc_interval = acpipmtr_sensor_get_interval(self); 320 1.3.2.2 rmind 321 1.3.2.2 rmind if (val < 0) { 322 1.3.2.2 rmind aprint_error_dev(self, "failed to get sensor reading\n"); 323 1.3.2.2 rmind return false; 324 1.3.2.2 rmind } 325 1.3.2.2 rmind 326 1.3.2.2 rmind /* Always mW in ACPI 4.0. */ 327 1.3.2.2 rmind if (sc->sc_cap[ACPIPMTR_CAP_UNIT] != 0) 328 1.3.2.2 rmind aprint_error_dev(self, "invalid measurement unit\n"); 329 1.3.2.2 rmind 330 1.3.2.2 rmind sc->sc_sme = sysmon_envsys_create(); 331 1.3.2.2 rmind 332 1.3.2.2 rmind sc->sc_sensor_i.units = ENVSYS_SWATTS; 333 1.3.2.2 rmind sc->sc_sensor_o.units = ENVSYS_SWATTS; 334 1.3.2.2 rmind sc->sc_sensor_i.value_cur = val * 1000; 335 1.3.2.2 rmind sc->sc_sensor_o.value_cur = val * 1000; 336 1.3.2.2 rmind 337 1.3.2.2 rmind acpipmtr_sensor_type(self); 338 1.3.2.2 rmind 339 1.3.2.2 rmind (void)strlcpy(sc->sc_sensor_i.desc, "input power", siz); 340 1.3.2.2 rmind (void)strlcpy(sc->sc_sensor_o.desc, "output power", siz); 341 1.3.2.2 rmind 342 1.3.2.2 rmind sc->sc_sme->sme_cookie = self; 343 1.3.2.2 rmind sc->sc_sme->sme_flags = SME_POLL_ONLY; 344 1.3.2.2 rmind sc->sc_sme->sme_name = device_xname(self); 345 1.3.2.2 rmind sc->sc_sme->sme_refresh = acpipmtr_sensor_refresh; 346 1.3.2.2 rmind 347 1.3.2.2 rmind if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor_i) != 0) 348 1.3.2.2 rmind goto fail; 349 1.3.2.2 rmind 350 1.3.2.2 rmind if (sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor_o) != 0) 351 1.3.2.2 rmind goto fail; 352 1.3.2.2 rmind 353 1.3.2.2 rmind if (sysmon_envsys_register(sc->sc_sme) != 0) 354 1.3.2.2 rmind goto fail; 355 1.3.2.2 rmind 356 1.3.2.2 rmind return true; 357 1.3.2.2 rmind 358 1.3.2.2 rmind fail: 359 1.3.2.2 rmind aprint_error_dev(self, "failed to initialize sysmon\n"); 360 1.3.2.2 rmind 361 1.3.2.2 rmind sysmon_envsys_destroy(sc->sc_sme); 362 1.3.2.2 rmind sc->sc_sme = NULL; 363 1.3.2.2 rmind 364 1.3.2.2 rmind return false; 365 1.3.2.2 rmind } 366 1.3.2.2 rmind 367 1.3.2.2 rmind static void 368 1.3.2.2 rmind acpipmtr_sensor_type(device_t self) 369 1.3.2.2 rmind { 370 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 371 1.3.2.2 rmind 372 1.3.2.2 rmind switch (sc->sc_cap[ACPIPMTR_CAP_TYPE]) { 373 1.3.2.2 rmind 374 1.3.2.2 rmind case ACPIPMTR_POWER_INPUT: 375 1.3.2.2 rmind sc->sc_sensor_i.state = ENVSYS_SVALID; 376 1.3.2.2 rmind sc->sc_sensor_o.state = ENVSYS_SINVALID; 377 1.3.2.2 rmind break; 378 1.3.2.2 rmind 379 1.3.2.2 rmind case ACPIPMTR_POWER_OUTPUT: 380 1.3.2.2 rmind sc->sc_sensor_i.state = ENVSYS_SINVALID; 381 1.3.2.2 rmind sc->sc_sensor_o.state = ENVSYS_SVALID; 382 1.3.2.2 rmind break; 383 1.3.2.2 rmind 384 1.3.2.2 rmind default: 385 1.3.2.2 rmind sc->sc_sensor_i.state = ENVSYS_SINVALID; 386 1.3.2.2 rmind sc->sc_sensor_o.state = ENVSYS_SINVALID; 387 1.3.2.2 rmind break; 388 1.3.2.2 rmind } 389 1.3.2.2 rmind } 390 1.3.2.2 rmind 391 1.3.2.2 rmind static int32_t 392 1.3.2.2 rmind acpipmtr_sensor_get(device_t self, const char *path) 393 1.3.2.2 rmind { 394 1.3.2.2 rmind struct acpipmtr_softc *sc = device_private(self); 395 1.3.2.2 rmind ACPI_INTEGER val = 0; 396 1.3.2.2 rmind ACPI_STATUS rv; 397 1.3.2.2 rmind 398 1.3.2.2 rmind rv = acpi_eval_integer(sc->sc_node->ad_handle, path, &val); 399 1.3.2.2 rmind 400 1.3.2.2 rmind if (ACPI_FAILURE(rv)) 401 1.3.2.2 rmind goto fail; 402 1.3.2.2 rmind 403 1.3.2.2 rmind if (val == 0 || val > INT32_MAX) { 404 1.3.2.2 rmind rv = AE_LIMIT; 405 1.3.2.2 rmind goto fail; 406 1.3.2.2 rmind } 407 1.3.2.2 rmind 408 1.3.2.2 rmind return val; 409 1.3.2.2 rmind 410 1.3.2.2 rmind fail: 411 1.3.2.2 rmind aprint_debug_dev(self, "failed to evaluate " 412 1.3.2.2 rmind "%s: %s\n", path, AcpiFormatException(rv)); 413 1.3.2.2 rmind 414 1.3.2.2 rmind return -1; 415 1.3.2.2 rmind } 416 1.3.2.2 rmind 417 1.3.2.2 rmind static int32_t 418 1.3.2.2 rmind acpipmtr_sensor_get_reading(device_t self) 419 1.3.2.2 rmind { 420 1.3.2.2 rmind return acpipmtr_sensor_get(self, "_PMM"); 421 1.3.2.2 rmind } 422 1.3.2.2 rmind 423 1.3.2.2 rmind static int32_t 424 1.3.2.2 rmind acpipmtr_sensor_get_interval(device_t self) 425 1.3.2.2 rmind { 426 1.3.2.2 rmind return acpipmtr_sensor_get(self, "_GAI"); 427 1.3.2.2 rmind } 428 1.3.2.2 rmind 429 1.3.2.2 rmind static void 430 1.3.2.2 rmind acpipmtr_sensor_refresh(struct sysmon_envsys *sme, envsys_data_t *edata) 431 1.3.2.2 rmind { 432 1.3.2.2 rmind device_t self = sme->sme_cookie; 433 1.3.2.2 rmind struct acpipmtr_softc *sc; 434 1.3.2.2 rmind int32_t val; 435 1.3.2.2 rmind 436 1.3.2.2 rmind sc = device_private(self); 437 1.3.2.2 rmind 438 1.3.2.2 rmind sc->sc_sensor_i.state = ENVSYS_SINVALID; 439 1.3.2.2 rmind sc->sc_sensor_o.state = ENVSYS_SINVALID; 440 1.3.2.2 rmind 441 1.3.2.2 rmind val = acpipmtr_sensor_get_reading(self) * 1000; 442 1.3.2.2 rmind 443 1.3.2.2 rmind if (val < 0) 444 1.3.2.2 rmind return; 445 1.3.2.2 rmind 446 1.3.2.2 rmind sc->sc_sensor_i.value_cur = val; 447 1.3.2.2 rmind sc->sc_sensor_o.value_cur = val; 448 1.3.2.2 rmind 449 1.3.2.2 rmind acpipmtr_sensor_type(self); 450 1.3.2.2 rmind } 451 1.3.2.2 rmind 452 1.3.2.2 rmind static void 453 1.3.2.2 rmind acpipmtr_notify(ACPI_HANDLE hdl, uint32_t evt, void *aux) 454 1.3.2.2 rmind { 455 1.3.2.2 rmind struct acpipmtr_softc *sc; 456 1.3.2.2 rmind device_t self = aux; 457 1.3.2.2 rmind int32_t val; 458 1.3.2.2 rmind 459 1.3.2.2 rmind sc = device_private(self); 460 1.3.2.2 rmind 461 1.3.2.2 rmind switch (evt) { 462 1.3.2.2 rmind 463 1.3.2.2 rmind case ACPIPMTR_NOTIFY_CAP: 464 1.3.2.2 rmind 465 1.3.2.2 rmind if (acpipmtr_cap_get(self, false) != true) 466 1.3.2.2 rmind break; 467 1.3.2.2 rmind 468 1.3.2.2 rmind acpipmtr_sensor_type(self); 469 1.3.2.2 rmind break; 470 1.3.2.2 rmind 471 1.3.2.2 rmind case ACPIPMTR_NOTIFY_INTERVAL: 472 1.3.2.2 rmind val = acpipmtr_sensor_get_interval(self); 473 1.3.2.2 rmind 474 1.3.2.2 rmind if (val < 0 || val == sc->sc_interval) 475 1.3.2.2 rmind break; 476 1.3.2.2 rmind 477 1.3.2.2 rmind aprint_debug_dev(self, "averaging interval changed " 478 1.3.2.2 rmind "from %u ms to %u ms\n", sc->sc_interval, val); 479 1.3.2.2 rmind 480 1.3.2.2 rmind sc->sc_interval = val; 481 1.3.2.2 rmind break; 482 1.3.2.2 rmind 483 1.3.2.2 rmind case ACPIPMTR_NOTIFY_TRIP: /* AE_SUPPORT */ 484 1.3.2.2 rmind case ACPIPMTR_NOTIFY_HWLIMIT1: /* AE_SUPPORT */ 485 1.3.2.2 rmind case ACPIPMTR_NOTIFY_HWLIMIT2: /* AE_SUPPORT */ 486 1.3.2.2 rmind break; 487 1.3.2.2 rmind 488 1.3.2.2 rmind default: 489 1.3.2.2 rmind aprint_debug_dev(self, "unknown notify 0x%02x\n", evt); 490 1.3.2.2 rmind } 491 1.3.2.2 rmind } 492 1.3.2.2 rmind 493 1.3.2.2 rmind MODULE(MODULE_CLASS_DRIVER, acpipmtr, NULL); 494 1.3.2.2 rmind 495 1.3.2.2 rmind #ifdef _MODULE 496 1.3.2.2 rmind #include "ioconf.c" 497 1.3.2.2 rmind #endif 498 1.3.2.2 rmind 499 1.3.2.2 rmind static int 500 1.3.2.2 rmind acpipmtr_modcmd(modcmd_t cmd, void *aux) 501 1.3.2.2 rmind { 502 1.3.2.2 rmind int rv = 0; 503 1.3.2.2 rmind 504 1.3.2.2 rmind switch (cmd) { 505 1.3.2.2 rmind 506 1.3.2.2 rmind case MODULE_CMD_INIT: 507 1.3.2.2 rmind 508 1.3.2.2 rmind #ifdef _MODULE 509 1.3.2.2 rmind rv = config_init_component(cfdriver_ioconf_acpipmtr, 510 1.3.2.2 rmind cfattach_ioconf_acpipmtr, cfdata_ioconf_acpipmtr); 511 1.3.2.2 rmind #endif 512 1.3.2.2 rmind break; 513 1.3.2.2 rmind 514 1.3.2.2 rmind case MODULE_CMD_FINI: 515 1.3.2.2 rmind 516 1.3.2.2 rmind #ifdef _MODULE 517 1.3.2.2 rmind rv = config_fini_component(cfdriver_ioconf_acpipmtr, 518 1.3.2.2 rmind cfattach_ioconf_acpipmtr, cfdata_ioconf_acpipmtr); 519 1.3.2.2 rmind #endif 520 1.3.2.2 rmind break; 521 1.3.2.2 rmind 522 1.3.2.2 rmind default: 523 1.3.2.2 rmind rv = ENOTTY; 524 1.3.2.2 rmind } 525 1.3.2.2 rmind 526 1.3.2.2 rmind return rv; 527 1.3.2.2 rmind } 528
Indexes created Mon Oct 20 01:09:56 GMT 2025