Home | History | Annotate | Line # | Download | only in acpi
acpi_cpu_tstate.c revision 1.16.2.2
      1  1.16.2.2  yamt /* $NetBSD: acpi_cpu_tstate.c,v 1.16.2.2 2010/10/09 03:32:04 yamt Exp $ */
      2  1.16.2.2  yamt 
      3  1.16.2.2  yamt /*-
      4  1.16.2.2  yamt  * Copyright (c) 2010 Jukka Ruohonen <jruohonen (at) iki.fi>
      5  1.16.2.2  yamt  * All rights reserved.
      6  1.16.2.2  yamt  *
      7  1.16.2.2  yamt  * Redistribution and use in source and binary forms, with or without
      8  1.16.2.2  yamt  * modification, are permitted provided that the following conditions
      9  1.16.2.2  yamt  * are met:
     10  1.16.2.2  yamt  *
     11  1.16.2.2  yamt  * 1. Redistributions of source code must retain the above copyright
     12  1.16.2.2  yamt  *    notice, this list of conditions and the following disclaimer.
     13  1.16.2.2  yamt  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.16.2.2  yamt  *    notice, this list of conditions and the following disclaimer in the
     15  1.16.2.2  yamt  *    documentation and/or other materials provided with the distribution.
     16  1.16.2.2  yamt  *
     17  1.16.2.2  yamt  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     18  1.16.2.2  yamt  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     19  1.16.2.2  yamt  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     20  1.16.2.2  yamt  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     21  1.16.2.2  yamt  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     22  1.16.2.2  yamt  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     23  1.16.2.2  yamt  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     24  1.16.2.2  yamt  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     25  1.16.2.2  yamt  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     26  1.16.2.2  yamt  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     27  1.16.2.2  yamt  * SUCH DAMAGE.
     28  1.16.2.2  yamt  */
     29  1.16.2.2  yamt #include <sys/cdefs.h>
     30  1.16.2.2  yamt __KERNEL_RCSID(0, "$NetBSD: acpi_cpu_tstate.c,v 1.16.2.2 2010/10/09 03:32:04 yamt Exp $");
     31  1.16.2.2  yamt 
     32  1.16.2.2  yamt #include <sys/param.h>
     33  1.16.2.2  yamt #include <sys/evcnt.h>
     34  1.16.2.2  yamt #include <sys/kmem.h>
     35  1.16.2.2  yamt 
     36  1.16.2.2  yamt #include <dev/acpi/acpireg.h>
     37  1.16.2.2  yamt #include <dev/acpi/acpivar.h>
     38  1.16.2.2  yamt #include <dev/acpi/acpi_cpu.h>
     39  1.16.2.2  yamt 
     40  1.16.2.2  yamt #define _COMPONENT	 ACPI_BUS_COMPONENT
     41  1.16.2.2  yamt ACPI_MODULE_NAME	 ("acpi_cpu_tstate")
     42  1.16.2.2  yamt 
     43  1.16.2.2  yamt static void		 acpicpu_tstate_attach_print(struct acpicpu_softc *);
     44  1.16.2.2  yamt static void		 acpicpu_tstate_attach_evcnt(struct acpicpu_softc *);
     45  1.16.2.2  yamt static void		 acpicpu_tstate_detach_evcnt(struct acpicpu_softc *);
     46  1.16.2.2  yamt static ACPI_STATUS	 acpicpu_tstate_tss(struct acpicpu_softc *);
     47  1.16.2.2  yamt static ACPI_STATUS	 acpicpu_tstate_tss_add(struct acpicpu_tstate *,
     48  1.16.2.2  yamt 						ACPI_OBJECT *);
     49  1.16.2.2  yamt static ACPI_STATUS	 acpicpu_tstate_ptc(struct acpicpu_softc *);
     50  1.16.2.2  yamt static ACPI_STATUS	 acpicpu_tstate_fadt(struct acpicpu_softc *);
     51  1.16.2.2  yamt static ACPI_STATUS	 acpicpu_tstate_change(struct acpicpu_softc *);
     52  1.16.2.2  yamt static void		 acpicpu_tstate_reset(struct acpicpu_softc *);
     53  1.16.2.2  yamt 
     54  1.16.2.2  yamt void
     55  1.16.2.2  yamt acpicpu_tstate_attach(device_t self)
     56  1.16.2.2  yamt {
     57  1.16.2.2  yamt 	struct acpicpu_softc *sc = device_private(self);
     58  1.16.2.2  yamt 	const char *str;
     59  1.16.2.2  yamt 	ACPI_HANDLE tmp;
     60  1.16.2.2  yamt 	ACPI_STATUS rv;
     61  1.16.2.2  yamt 
     62  1.16.2.2  yamt 	/*
     63  1.16.2.2  yamt 	 * Disable T-states for PIIX4.
     64  1.16.2.2  yamt 	 */
     65  1.16.2.2  yamt 	if ((sc->sc_flags & ACPICPU_FLAG_PIIX4) != 0)
     66  1.16.2.2  yamt 		return;
     67  1.16.2.2  yamt 
     68  1.16.2.2  yamt 	rv  = acpicpu_tstate_tss(sc);
     69  1.16.2.2  yamt 
     70  1.16.2.2  yamt 	if (ACPI_FAILURE(rv)) {
     71  1.16.2.2  yamt 		str = "_TSS";
     72  1.16.2.2  yamt 		goto out;
     73  1.16.2.2  yamt 	}
     74  1.16.2.2  yamt 
     75  1.16.2.2  yamt 	rv = acpicpu_tstate_ptc(sc);
     76  1.16.2.2  yamt 
     77  1.16.2.2  yamt 	if (ACPI_FAILURE(rv)) {
     78  1.16.2.2  yamt 		str = "_PTC";
     79  1.16.2.2  yamt 		goto out;
     80  1.16.2.2  yamt 	}
     81  1.16.2.2  yamt 
     82  1.16.2.2  yamt 	/*
     83  1.16.2.2  yamt 	 * Comparable to P-states, the _TPC object may
     84  1.16.2.2  yamt 	 * be absent in some systems, even though it is
     85  1.16.2.2  yamt 	 * required by ACPI 3.0 along with _TSS and _PTC.
     86  1.16.2.2  yamt 	 */
     87  1.16.2.2  yamt 	rv = AcpiGetHandle(sc->sc_node->ad_handle, "_TPC", &tmp);
     88  1.16.2.2  yamt 
     89  1.16.2.2  yamt 	if (ACPI_FAILURE(rv)) {
     90  1.16.2.2  yamt 		aprint_debug_dev(self, "_TPC missing\n");
     91  1.16.2.2  yamt 		rv = AE_OK;
     92  1.16.2.2  yamt 	}
     93  1.16.2.2  yamt 
     94  1.16.2.2  yamt out:
     95  1.16.2.2  yamt 	if (ACPI_FAILURE(rv)) {
     96  1.16.2.2  yamt 
     97  1.16.2.2  yamt 		if (rv != AE_NOT_FOUND)
     98  1.16.2.2  yamt 			aprint_error_dev(sc->sc_dev, "failed to evaluate "
     99  1.16.2.2  yamt 			    "%s: %s\n", str, AcpiFormatException(rv));
    100  1.16.2.2  yamt 
    101  1.16.2.2  yamt 		rv = acpicpu_tstate_fadt(sc);
    102  1.16.2.2  yamt 
    103  1.16.2.2  yamt 		if (ACPI_FAILURE(rv))
    104  1.16.2.2  yamt 			return;
    105  1.16.2.2  yamt 
    106  1.16.2.2  yamt 		sc->sc_flags |= ACPICPU_FLAG_T_FADT;
    107  1.16.2.2  yamt 	}
    108  1.16.2.2  yamt 
    109  1.16.2.2  yamt 	sc->sc_flags |= ACPICPU_FLAG_T;
    110  1.16.2.2  yamt 
    111  1.16.2.2  yamt 	acpicpu_tstate_reset(sc);
    112  1.16.2.2  yamt 	acpicpu_tstate_attach_evcnt(sc);
    113  1.16.2.2  yamt 	acpicpu_tstate_attach_print(sc);
    114  1.16.2.2  yamt }
    115  1.16.2.2  yamt 
    116  1.16.2.2  yamt static void
    117  1.16.2.2  yamt acpicpu_tstate_attach_print(struct acpicpu_softc *sc)
    118  1.16.2.2  yamt {
    119  1.16.2.2  yamt 	const uint8_t method = sc->sc_tstate_control.reg_spaceid;
    120  1.16.2.2  yamt 	struct acpicpu_tstate *ts;
    121  1.16.2.2  yamt 	static bool once = false;
    122  1.16.2.2  yamt 	const char *str;
    123  1.16.2.2  yamt 	uint32_t i;
    124  1.16.2.2  yamt 
    125  1.16.2.2  yamt 	if (once != false)
    126  1.16.2.2  yamt 		return;
    127  1.16.2.2  yamt 
    128  1.16.2.2  yamt 	str = (method != ACPI_ADR_SPACE_FIXED_HARDWARE) ? "I/O" : "FFH";
    129  1.16.2.2  yamt 
    130  1.16.2.2  yamt 	for (i = 0; i < sc->sc_tstate_count; i++) {
    131  1.16.2.2  yamt 
    132  1.16.2.2  yamt 		ts = &sc->sc_tstate[i];
    133  1.16.2.2  yamt 
    134  1.16.2.2  yamt 		if (ts->ts_percent == 0)
    135  1.16.2.2  yamt 			continue;
    136  1.16.2.2  yamt 
    137  1.16.2.2  yamt 		aprint_debug_dev(sc->sc_dev, "T%u: %3s, "
    138  1.16.2.2  yamt 		    "lat %3u us, pow %5u mW, %3u %%\n", i, str,
    139  1.16.2.2  yamt 		    ts->ts_latency, ts->ts_power, ts->ts_percent);
    140  1.16.2.2  yamt 	}
    141  1.16.2.2  yamt 
    142  1.16.2.2  yamt 	once = true;
    143  1.16.2.2  yamt }
    144  1.16.2.2  yamt 
    145  1.16.2.2  yamt static void
    146  1.16.2.2  yamt acpicpu_tstate_attach_evcnt(struct acpicpu_softc *sc)
    147  1.16.2.2  yamt {
    148  1.16.2.2  yamt 	struct acpicpu_tstate *ts;
    149  1.16.2.2  yamt 	uint32_t i;
    150  1.16.2.2  yamt 
    151  1.16.2.2  yamt 	for (i = 0; i < sc->sc_tstate_count; i++) {
    152  1.16.2.2  yamt 
    153  1.16.2.2  yamt 		ts = &sc->sc_tstate[i];
    154  1.16.2.2  yamt 
    155  1.16.2.2  yamt 		if (ts->ts_percent == 0)
    156  1.16.2.2  yamt 			continue;
    157  1.16.2.2  yamt 
    158  1.16.2.2  yamt 		(void)snprintf(ts->ts_name, sizeof(ts->ts_name),
    159  1.16.2.2  yamt 		    "T%u (%u %%)", i, ts->ts_percent);
    160  1.16.2.2  yamt 
    161  1.16.2.2  yamt 		evcnt_attach_dynamic(&ts->ts_evcnt, EVCNT_TYPE_MISC,
    162  1.16.2.2  yamt 		    NULL, device_xname(sc->sc_dev), ts->ts_name);
    163  1.16.2.2  yamt 	}
    164  1.16.2.2  yamt }
    165  1.16.2.2  yamt 
    166  1.16.2.2  yamt int
    167  1.16.2.2  yamt acpicpu_tstate_detach(device_t self)
    168  1.16.2.2  yamt {
    169  1.16.2.2  yamt 	struct acpicpu_softc *sc = device_private(self);
    170  1.16.2.2  yamt 	size_t size;
    171  1.16.2.2  yamt 
    172  1.16.2.2  yamt 	if ((sc->sc_flags & ACPICPU_FLAG_T) == 0)
    173  1.16.2.2  yamt 		return 0;
    174  1.16.2.2  yamt 
    175  1.16.2.2  yamt 	size = sc->sc_tstate_count * sizeof(*sc->sc_tstate);
    176  1.16.2.2  yamt 
    177  1.16.2.2  yamt 	if (sc->sc_tstate != NULL)
    178  1.16.2.2  yamt 		kmem_free(sc->sc_tstate, size);
    179  1.16.2.2  yamt 
    180  1.16.2.2  yamt 	sc->sc_flags &= ~ACPICPU_FLAG_T;
    181  1.16.2.2  yamt 	acpicpu_tstate_detach_evcnt(sc);
    182  1.16.2.2  yamt 
    183  1.16.2.2  yamt 	return 0;
    184  1.16.2.2  yamt }
    185  1.16.2.2  yamt 
    186  1.16.2.2  yamt static void
    187  1.16.2.2  yamt acpicpu_tstate_detach_evcnt(struct acpicpu_softc *sc)
    188  1.16.2.2  yamt {
    189  1.16.2.2  yamt 	struct acpicpu_tstate *ts;
    190  1.16.2.2  yamt 	uint32_t i;
    191  1.16.2.2  yamt 
    192  1.16.2.2  yamt 	for (i = 0; i < sc->sc_tstate_count; i++) {
    193  1.16.2.2  yamt 
    194  1.16.2.2  yamt 		ts = &sc->sc_tstate[i];
    195  1.16.2.2  yamt 
    196  1.16.2.2  yamt 		if (ts->ts_percent != 0)
    197  1.16.2.2  yamt 			evcnt_detach(&ts->ts_evcnt);
    198  1.16.2.2  yamt 	}
    199  1.16.2.2  yamt }
    200  1.16.2.2  yamt 
    201  1.16.2.2  yamt void
    202  1.16.2.2  yamt acpicpu_tstate_start(device_t self)
    203  1.16.2.2  yamt {
    204  1.16.2.2  yamt 	/* Nothing. */
    205  1.16.2.2  yamt }
    206  1.16.2.2  yamt 
    207  1.16.2.2  yamt bool
    208  1.16.2.2  yamt acpicpu_tstate_suspend(device_t self)
    209  1.16.2.2  yamt {
    210  1.16.2.2  yamt 	struct acpicpu_softc *sc = device_private(self);
    211  1.16.2.2  yamt 
    212  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    213  1.16.2.2  yamt 	acpicpu_tstate_reset(sc);
    214  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    215  1.16.2.2  yamt 
    216  1.16.2.2  yamt 	return true;
    217  1.16.2.2  yamt }
    218  1.16.2.2  yamt 
    219  1.16.2.2  yamt bool
    220  1.16.2.2  yamt acpicpu_tstate_resume(device_t self)
    221  1.16.2.2  yamt {
    222  1.16.2.2  yamt 
    223  1.16.2.2  yamt 	return true;
    224  1.16.2.2  yamt }
    225  1.16.2.2  yamt 
    226  1.16.2.2  yamt void
    227  1.16.2.2  yamt acpicpu_tstate_callback(void *aux)
    228  1.16.2.2  yamt {
    229  1.16.2.2  yamt 	struct acpicpu_softc *sc;
    230  1.16.2.2  yamt 	device_t self = aux;
    231  1.16.2.2  yamt 	uint32_t omax, omin;
    232  1.16.2.2  yamt 	int i;
    233  1.16.2.2  yamt 
    234  1.16.2.2  yamt 	sc = device_private(self);
    235  1.16.2.2  yamt 
    236  1.16.2.2  yamt 	if ((sc->sc_flags & ACPICPU_FLAG_T_FADT) != 0)
    237  1.16.2.2  yamt 		return;
    238  1.16.2.2  yamt 
    239  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    240  1.16.2.2  yamt 
    241  1.16.2.2  yamt 	/*
    242  1.16.2.2  yamt 	 * If P-states are in use, we should ignore
    243  1.16.2.2  yamt 	 * the interrupt unless we are in the highest
    244  1.16.2.2  yamt 	 * P-state (see ACPI 4.0, section 8.4.3.3).
    245  1.16.2.2  yamt 	 */
    246  1.16.2.2  yamt 	if ((sc->sc_flags & ACPICPU_FLAG_P) != 0) {
    247  1.16.2.2  yamt 
    248  1.16.2.2  yamt 		for (i = sc->sc_pstate_count - 1; i >= 0; i--) {
    249  1.16.2.2  yamt 
    250  1.16.2.2  yamt 			if (sc->sc_pstate[i].ps_freq != 0)
    251  1.16.2.2  yamt 				break;
    252  1.16.2.2  yamt 		}
    253  1.16.2.2  yamt 
    254  1.16.2.2  yamt 		if (sc->sc_pstate_current != sc->sc_pstate[i].ps_freq) {
    255  1.16.2.2  yamt 			mutex_exit(&sc->sc_mtx);
    256  1.16.2.2  yamt 			return;
    257  1.16.2.2  yamt 		}
    258  1.16.2.2  yamt 	}
    259  1.16.2.2  yamt 
    260  1.16.2.2  yamt 	omax = sc->sc_tstate_max;
    261  1.16.2.2  yamt 	omin = sc->sc_tstate_min;
    262  1.16.2.2  yamt 
    263  1.16.2.2  yamt 	(void)acpicpu_tstate_change(sc);
    264  1.16.2.2  yamt 
    265  1.16.2.2  yamt 	if (omax != sc->sc_tstate_max || omin != sc->sc_tstate_min) {
    266  1.16.2.2  yamt 
    267  1.16.2.2  yamt 		aprint_debug_dev(sc->sc_dev, "throttling window "
    268  1.16.2.2  yamt 		    "changed from %u-%u %% to %u-%u %%\n",
    269  1.16.2.2  yamt 		    sc->sc_tstate[omax].ts_percent,
    270  1.16.2.2  yamt 		    sc->sc_tstate[omin].ts_percent,
    271  1.16.2.2  yamt 		    sc->sc_tstate[sc->sc_tstate_max].ts_percent,
    272  1.16.2.2  yamt 		    sc->sc_tstate[sc->sc_tstate_min].ts_percent);
    273  1.16.2.2  yamt 	}
    274  1.16.2.2  yamt 
    275  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    276  1.16.2.2  yamt }
    277  1.16.2.2  yamt 
    278  1.16.2.2  yamt static ACPI_STATUS
    279  1.16.2.2  yamt acpicpu_tstate_tss(struct acpicpu_softc *sc)
    280  1.16.2.2  yamt {
    281  1.16.2.2  yamt 	struct acpicpu_tstate *ts;
    282  1.16.2.2  yamt 	ACPI_OBJECT *obj;
    283  1.16.2.2  yamt 	ACPI_BUFFER buf;
    284  1.16.2.2  yamt 	ACPI_STATUS rv;
    285  1.16.2.2  yamt 	uint32_t count;
    286  1.16.2.2  yamt 	uint32_t i, j;
    287  1.16.2.2  yamt 
    288  1.16.2.2  yamt 	rv = acpi_eval_struct(sc->sc_node->ad_handle, "_TSS", &buf);
    289  1.16.2.2  yamt 
    290  1.16.2.2  yamt 	if (ACPI_FAILURE(rv))
    291  1.16.2.2  yamt 		return rv;
    292  1.16.2.2  yamt 
    293  1.16.2.2  yamt 	obj = buf.Pointer;
    294  1.16.2.2  yamt 
    295  1.16.2.2  yamt 	if (obj->Type != ACPI_TYPE_PACKAGE) {
    296  1.16.2.2  yamt 		rv = AE_TYPE;
    297  1.16.2.2  yamt 		goto out;
    298  1.16.2.2  yamt 	}
    299  1.16.2.2  yamt 
    300  1.16.2.2  yamt 	sc->sc_tstate_count = obj->Package.Count;
    301  1.16.2.2  yamt 
    302  1.16.2.2  yamt 	if (sc->sc_tstate_count == 0) {
    303  1.16.2.2  yamt 		rv = AE_NOT_EXIST;
    304  1.16.2.2  yamt 		goto out;
    305  1.16.2.2  yamt 	}
    306  1.16.2.2  yamt 
    307  1.16.2.2  yamt 	if (sc->sc_tstate_count > ACPICPU_T_STATE_MAX) {
    308  1.16.2.2  yamt 		rv = AE_LIMIT;
    309  1.16.2.2  yamt 		goto out;
    310  1.16.2.2  yamt 	}
    311  1.16.2.2  yamt 
    312  1.16.2.2  yamt 	sc->sc_tstate = kmem_zalloc(sc->sc_tstate_count *
    313  1.16.2.2  yamt 	    sizeof(struct acpicpu_tstate), KM_SLEEP);
    314  1.16.2.2  yamt 
    315  1.16.2.2  yamt 	if (sc->sc_tstate == NULL) {
    316  1.16.2.2  yamt 		rv = AE_NO_MEMORY;
    317  1.16.2.2  yamt 		goto out;
    318  1.16.2.2  yamt 	}
    319  1.16.2.2  yamt 
    320  1.16.2.2  yamt 	for (count = i = 0; i < sc->sc_tstate_count; i++) {
    321  1.16.2.2  yamt 
    322  1.16.2.2  yamt 		ts = &sc->sc_tstate[i];
    323  1.16.2.2  yamt 		rv = acpicpu_tstate_tss_add(ts, &obj->Package.Elements[i]);
    324  1.16.2.2  yamt 
    325  1.16.2.2  yamt 		if (ACPI_FAILURE(rv)) {
    326  1.16.2.2  yamt 			ts->ts_percent = 0;
    327  1.16.2.2  yamt 			continue;
    328  1.16.2.2  yamt 		}
    329  1.16.2.2  yamt 
    330  1.16.2.2  yamt 		for (j = 0; j < i; j++) {
    331  1.16.2.2  yamt 
    332  1.16.2.2  yamt 			if (ts->ts_percent >= sc->sc_tstate[j].ts_percent) {
    333  1.16.2.2  yamt 				ts->ts_percent = 0;
    334  1.16.2.2  yamt 				break;
    335  1.16.2.2  yamt 			}
    336  1.16.2.2  yamt 		}
    337  1.16.2.2  yamt 
    338  1.16.2.2  yamt 		if (ts->ts_percent != 0)
    339  1.16.2.2  yamt 			count++;
    340  1.16.2.2  yamt 	}
    341  1.16.2.2  yamt 
    342  1.16.2.2  yamt 	if (count == 0) {
    343  1.16.2.2  yamt 		rv = AE_NOT_EXIST;
    344  1.16.2.2  yamt 		goto out;
    345  1.16.2.2  yamt 	}
    346  1.16.2.2  yamt 
    347  1.16.2.2  yamt 	/*
    348  1.16.2.2  yamt 	 * There must be an entry with the percent
    349  1.16.2.2  yamt 	 * field of 100. If this is not true, and if
    350  1.16.2.2  yamt 	 * this entry is not in the expected index,
    351  1.16.2.2  yamt 	 * invalidate the use of T-states via _TSS.
    352  1.16.2.2  yamt 	 */
    353  1.16.2.2  yamt 	if (sc->sc_tstate[0].ts_percent != 100) {
    354  1.16.2.2  yamt 		rv = AE_BAD_DECIMAL_CONSTANT;
    355  1.16.2.2  yamt 		goto out;
    356  1.16.2.2  yamt 	}
    357  1.16.2.2  yamt 
    358  1.16.2.2  yamt 	/*
    359  1.16.2.2  yamt 	 * The first entry with 100 % duty cycle
    360  1.16.2.2  yamt 	 * should have zero in the control field.
    361  1.16.2.2  yamt 	 */
    362  1.16.2.2  yamt 	if (sc->sc_tstate[0].ts_control != 0) {
    363  1.16.2.2  yamt 		rv = AE_AML_BAD_RESOURCE_VALUE;
    364  1.16.2.2  yamt 		goto out;
    365  1.16.2.2  yamt 	}
    366  1.16.2.2  yamt 
    367  1.16.2.2  yamt out:
    368  1.16.2.2  yamt 	if (buf.Pointer != NULL)
    369  1.16.2.2  yamt 		ACPI_FREE(buf.Pointer);
    370  1.16.2.2  yamt 
    371  1.16.2.2  yamt 	return rv;
    372  1.16.2.2  yamt }
    373  1.16.2.2  yamt 
    374  1.16.2.2  yamt static ACPI_STATUS
    375  1.16.2.2  yamt acpicpu_tstate_tss_add(struct acpicpu_tstate *ts, ACPI_OBJECT *obj)
    376  1.16.2.2  yamt {
    377  1.16.2.2  yamt 	ACPI_OBJECT *elm;
    378  1.16.2.2  yamt 	uint32_t val[5];
    379  1.16.2.2  yamt 	uint32_t *p;
    380  1.16.2.2  yamt 	int i;
    381  1.16.2.2  yamt 
    382  1.16.2.2  yamt 	if (obj->Type != ACPI_TYPE_PACKAGE)
    383  1.16.2.2  yamt 		return AE_TYPE;
    384  1.16.2.2  yamt 
    385  1.16.2.2  yamt 	if (obj->Package.Count != 5)
    386  1.16.2.2  yamt 		return AE_BAD_DATA;
    387  1.16.2.2  yamt 
    388  1.16.2.2  yamt 	elm = obj->Package.Elements;
    389  1.16.2.2  yamt 
    390  1.16.2.2  yamt 	for (i = 0; i < 5; i++) {
    391  1.16.2.2  yamt 
    392  1.16.2.2  yamt 		if (elm[i].Type != ACPI_TYPE_INTEGER)
    393  1.16.2.2  yamt 			return AE_TYPE;
    394  1.16.2.2  yamt 
    395  1.16.2.2  yamt 		if (elm[i].Integer.Value > UINT32_MAX)
    396  1.16.2.2  yamt 			return AE_AML_NUMERIC_OVERFLOW;
    397  1.16.2.2  yamt 
    398  1.16.2.2  yamt 		val[i] = elm[i].Integer.Value;
    399  1.16.2.2  yamt 	}
    400  1.16.2.2  yamt 
    401  1.16.2.2  yamt 	p = &ts->ts_percent;
    402  1.16.2.2  yamt 
    403  1.16.2.2  yamt 	for (i = 0; i < 5; i++, p++)
    404  1.16.2.2  yamt 		*p = val[i];
    405  1.16.2.2  yamt 
    406  1.16.2.2  yamt 	/*
    407  1.16.2.2  yamt 	 * The minimum should be around 100 / 8 = 12.5 %.
    408  1.16.2.2  yamt 	 */
    409  1.16.2.2  yamt         if (ts->ts_percent < 10 || ts->ts_percent > 100)
    410  1.16.2.2  yamt 		return AE_BAD_DECIMAL_CONSTANT;
    411  1.16.2.2  yamt 
    412  1.16.2.2  yamt 	if (ts->ts_latency < 1)
    413  1.16.2.2  yamt 		ts->ts_latency = 1;
    414  1.16.2.2  yamt 
    415  1.16.2.2  yamt 	return AE_OK;
    416  1.16.2.2  yamt }
    417  1.16.2.2  yamt 
    418  1.16.2.2  yamt ACPI_STATUS
    419  1.16.2.2  yamt acpicpu_tstate_ptc(struct acpicpu_softc *sc)
    420  1.16.2.2  yamt {
    421  1.16.2.2  yamt 	static const size_t size = sizeof(struct acpicpu_reg);
    422  1.16.2.2  yamt 	struct acpicpu_reg *reg[2];
    423  1.16.2.2  yamt 	ACPI_OBJECT *elm, *obj;
    424  1.16.2.2  yamt 	ACPI_BUFFER buf;
    425  1.16.2.2  yamt 	ACPI_STATUS rv;
    426  1.16.2.2  yamt 	int i;
    427  1.16.2.2  yamt 
    428  1.16.2.2  yamt 	rv = acpi_eval_struct(sc->sc_node->ad_handle, "_PTC", &buf);
    429  1.16.2.2  yamt 
    430  1.16.2.2  yamt 	if (ACPI_FAILURE(rv))
    431  1.16.2.2  yamt 		return rv;
    432  1.16.2.2  yamt 
    433  1.16.2.2  yamt 	obj = buf.Pointer;
    434  1.16.2.2  yamt 
    435  1.16.2.2  yamt 	if (obj->Type != ACPI_TYPE_PACKAGE) {
    436  1.16.2.2  yamt 		rv = AE_TYPE;
    437  1.16.2.2  yamt 		goto out;
    438  1.16.2.2  yamt 	}
    439  1.16.2.2  yamt 
    440  1.16.2.2  yamt 	if (obj->Package.Count != 2) {
    441  1.16.2.2  yamt 		rv = AE_LIMIT;
    442  1.16.2.2  yamt 		goto out;
    443  1.16.2.2  yamt 	}
    444  1.16.2.2  yamt 
    445  1.16.2.2  yamt 	for (i = 0; i < 2; i++) {
    446  1.16.2.2  yamt 
    447  1.16.2.2  yamt 		elm = &obj->Package.Elements[i];
    448  1.16.2.2  yamt 
    449  1.16.2.2  yamt 		if (elm->Type != ACPI_TYPE_BUFFER) {
    450  1.16.2.2  yamt 			rv = AE_TYPE;
    451  1.16.2.2  yamt 			goto out;
    452  1.16.2.2  yamt 		}
    453  1.16.2.2  yamt 
    454  1.16.2.2  yamt 		if (size > elm->Buffer.Length) {
    455  1.16.2.2  yamt 			rv = AE_AML_BAD_RESOURCE_LENGTH;
    456  1.16.2.2  yamt 			goto out;
    457  1.16.2.2  yamt 		}
    458  1.16.2.2  yamt 
    459  1.16.2.2  yamt 		reg[i] = (struct acpicpu_reg *)elm->Buffer.Pointer;
    460  1.16.2.2  yamt 
    461  1.16.2.2  yamt 		switch (reg[i]->reg_spaceid) {
    462  1.16.2.2  yamt 
    463  1.16.2.2  yamt 		case ACPI_ADR_SPACE_SYSTEM_IO:
    464  1.16.2.2  yamt 
    465  1.16.2.2  yamt 			if (reg[i]->reg_addr == 0) {
    466  1.16.2.2  yamt 				rv = AE_AML_ILLEGAL_ADDRESS;
    467  1.16.2.2  yamt 				goto out;
    468  1.16.2.2  yamt 			}
    469  1.16.2.2  yamt 
    470  1.16.2.2  yamt 			/*
    471  1.16.2.2  yamt 			 * Check that the values match the IA32 clock
    472  1.16.2.2  yamt 			 * modulation MSR, where the bit 0 is reserved,
    473  1.16.2.2  yamt 			 * bits 1 through 3 define the duty cycle, and
    474  1.16.2.2  yamt 			 * the fourth bit enables the modulation.
    475  1.16.2.2  yamt 			 */
    476  1.16.2.2  yamt 			if (reg[i]->reg_bitwidth != 4) {
    477  1.16.2.2  yamt 				rv = AE_AML_BAD_RESOURCE_VALUE;
    478  1.16.2.2  yamt 				goto out;
    479  1.16.2.2  yamt 			}
    480  1.16.2.2  yamt 
    481  1.16.2.2  yamt 			if (reg[i]->reg_bitoffset != 1) {
    482  1.16.2.2  yamt 				rv = AE_AML_BAD_RESOURCE_VALUE;
    483  1.16.2.2  yamt 				goto out;
    484  1.16.2.2  yamt 			}
    485  1.16.2.2  yamt 
    486  1.16.2.2  yamt 			break;
    487  1.16.2.2  yamt 
    488  1.16.2.2  yamt 		case ACPI_ADR_SPACE_FIXED_HARDWARE:
    489  1.16.2.2  yamt 
    490  1.16.2.2  yamt 			if ((sc->sc_flags & ACPICPU_FLAG_T_FFH) == 0) {
    491  1.16.2.2  yamt 				rv = AE_SUPPORT;
    492  1.16.2.2  yamt 				goto out;
    493  1.16.2.2  yamt 			}
    494  1.16.2.2  yamt 
    495  1.16.2.2  yamt 			break;
    496  1.16.2.2  yamt 
    497  1.16.2.2  yamt 		default:
    498  1.16.2.2  yamt 			rv = AE_AML_INVALID_SPACE_ID;
    499  1.16.2.2  yamt 			goto out;
    500  1.16.2.2  yamt 		}
    501  1.16.2.2  yamt 	}
    502  1.16.2.2  yamt 
    503  1.16.2.2  yamt 	if (reg[0]->reg_spaceid != reg[1]->reg_spaceid) {
    504  1.16.2.2  yamt 		rv = AE_AML_INVALID_SPACE_ID;
    505  1.16.2.2  yamt 		goto out;
    506  1.16.2.2  yamt 	}
    507  1.16.2.2  yamt 
    508  1.16.2.2  yamt 	(void)memcpy(&sc->sc_tstate_control, reg[0], size);
    509  1.16.2.2  yamt 	(void)memcpy(&sc->sc_tstate_status,  reg[1], size);
    510  1.16.2.2  yamt 
    511  1.16.2.2  yamt out:
    512  1.16.2.2  yamt 	if (buf.Pointer != NULL)
    513  1.16.2.2  yamt 		ACPI_FREE(buf.Pointer);
    514  1.16.2.2  yamt 
    515  1.16.2.2  yamt 	return rv;
    516  1.16.2.2  yamt }
    517  1.16.2.2  yamt 
    518  1.16.2.2  yamt static ACPI_STATUS
    519  1.16.2.2  yamt acpicpu_tstate_fadt(struct acpicpu_softc *sc)
    520  1.16.2.2  yamt {
    521  1.16.2.2  yamt 	static const size_t size = sizeof(struct acpicpu_tstate);
    522  1.16.2.2  yamt 	const uint8_t offset = AcpiGbl_FADT.DutyOffset;
    523  1.16.2.2  yamt 	const uint8_t width = AcpiGbl_FADT.DutyWidth;
    524  1.16.2.2  yamt 	uint8_t beta, count, i;
    525  1.16.2.2  yamt 
    526  1.16.2.2  yamt 	if (sc->sc_object.ao_pblkaddr == 0)
    527  1.16.2.2  yamt 		return AE_AML_ILLEGAL_ADDRESS;
    528  1.16.2.2  yamt 
    529  1.16.2.2  yamt 	/*
    530  1.16.2.2  yamt 	 * A zero DUTY_WIDTH is used announce that
    531  1.16.2.2  yamt 	 * T-states are not available via FADT.
    532  1.16.2.2  yamt 	 */
    533  1.16.2.2  yamt 	if (width == 0 || width + offset > 4)
    534  1.16.2.2  yamt 		return AE_AML_BAD_RESOURCE_VALUE;
    535  1.16.2.2  yamt 
    536  1.16.2.2  yamt 	count = 1 << width;
    537  1.16.2.2  yamt 
    538  1.16.2.2  yamt 	if (count > ACPICPU_T_STATE_MAX)
    539  1.16.2.2  yamt 		return AE_LIMIT;
    540  1.16.2.2  yamt 
    541  1.16.2.2  yamt 	if (sc->sc_tstate != NULL)
    542  1.16.2.2  yamt 		kmem_free(sc->sc_tstate, sc->sc_tstate_count * size);
    543  1.16.2.2  yamt 
    544  1.16.2.2  yamt 	sc->sc_tstate = kmem_zalloc(count * size, KM_SLEEP);
    545  1.16.2.2  yamt 
    546  1.16.2.2  yamt 	if (sc->sc_tstate == NULL)
    547  1.16.2.2  yamt 		return ENOMEM;
    548  1.16.2.2  yamt 
    549  1.16.2.2  yamt 	sc->sc_tstate_count = count;
    550  1.16.2.2  yamt 
    551  1.16.2.2  yamt 	/*
    552  1.16.2.2  yamt 	 * Approximate duty cycles and set the MSR values.
    553  1.16.2.2  yamt 	 */
    554  1.16.2.2  yamt 	for (beta = 100 / count, i = 0; i < count; i++) {
    555  1.16.2.2  yamt 		sc->sc_tstate[i].ts_percent = 100 - beta * i;
    556  1.16.2.2  yamt 		sc->sc_tstate[i].ts_latency = 1;
    557  1.16.2.2  yamt 	}
    558  1.16.2.2  yamt 
    559  1.16.2.2  yamt 	for (i = 1; i < count; i++)
    560  1.16.2.2  yamt 		sc->sc_tstate[i].ts_control = (count - i) | __BIT(3);
    561  1.16.2.2  yamt 
    562  1.16.2.2  yamt 	/*
    563  1.16.2.2  yamt 	 * Fake values for throttling registers.
    564  1.16.2.2  yamt 	 */
    565  1.16.2.2  yamt 	(void)memset(&sc->sc_tstate_status, 0, sizeof(struct acpicpu_reg));
    566  1.16.2.2  yamt 	(void)memset(&sc->sc_tstate_control, 0, sizeof(struct acpicpu_reg));
    567  1.16.2.2  yamt 
    568  1.16.2.2  yamt 	sc->sc_tstate_status.reg_bitwidth = width;
    569  1.16.2.2  yamt 	sc->sc_tstate_status.reg_bitoffset = offset;
    570  1.16.2.2  yamt 	sc->sc_tstate_status.reg_addr = sc->sc_object.ao_pblkaddr;
    571  1.16.2.2  yamt 	sc->sc_tstate_status.reg_spaceid = ACPI_ADR_SPACE_SYSTEM_IO;
    572  1.16.2.2  yamt 
    573  1.16.2.2  yamt 	sc->sc_tstate_control.reg_bitwidth = width;
    574  1.16.2.2  yamt 	sc->sc_tstate_control.reg_bitoffset = offset;
    575  1.16.2.2  yamt 	sc->sc_tstate_control.reg_addr = sc->sc_object.ao_pblkaddr;
    576  1.16.2.2  yamt 	sc->sc_tstate_control.reg_spaceid = ACPI_ADR_SPACE_SYSTEM_IO;
    577  1.16.2.2  yamt 
    578  1.16.2.2  yamt 	return AE_OK;
    579  1.16.2.2  yamt }
    580  1.16.2.2  yamt 
    581  1.16.2.2  yamt static ACPI_STATUS
    582  1.16.2.2  yamt acpicpu_tstate_change(struct acpicpu_softc *sc)
    583  1.16.2.2  yamt {
    584  1.16.2.2  yamt 	ACPI_INTEGER val;
    585  1.16.2.2  yamt 	ACPI_STATUS rv;
    586  1.16.2.2  yamt 
    587  1.16.2.2  yamt 	acpicpu_tstate_reset(sc);
    588  1.16.2.2  yamt 
    589  1.16.2.2  yamt 	/*
    590  1.16.2.2  yamt 	 * Evaluate the available T-state window:
    591  1.16.2.2  yamt 	 *
    592  1.16.2.2  yamt 	 *   _TPC : either this maximum or any lower power
    593  1.16.2.2  yamt 	 *          (i.e. higher numbered) state may be used.
    594  1.16.2.2  yamt 	 *
    595  1.16.2.2  yamt 	 *   _TDL : either this minimum or any higher power
    596  1.16.2.2  yamt 	 *	    (i.e. lower numbered) state may be used.
    597  1.16.2.2  yamt 	 *
    598  1.16.2.2  yamt 	 *   _TDL >= _TPC || _TDL >= _TSS[last entry].
    599  1.16.2.2  yamt 	 */
    600  1.16.2.2  yamt 	rv = acpi_eval_integer(sc->sc_node->ad_handle, "_TPC", &val);
    601  1.16.2.2  yamt 
    602  1.16.2.2  yamt 	if (ACPI_SUCCESS(rv) && val < sc->sc_tstate_count) {
    603  1.16.2.2  yamt 
    604  1.16.2.2  yamt 		if (sc->sc_tstate[val].ts_percent != 0)
    605  1.16.2.2  yamt 			sc->sc_tstate_max = val;
    606  1.16.2.2  yamt 	}
    607  1.16.2.2  yamt 
    608  1.16.2.2  yamt 	if (sc->sc_passive != true)
    609  1.16.2.2  yamt 		return AE_OK;
    610  1.16.2.2  yamt 
    611  1.16.2.2  yamt 	rv = acpi_eval_integer(sc->sc_node->ad_handle, "_TDL", &val);
    612  1.16.2.2  yamt 
    613  1.16.2.2  yamt 	if (ACPI_SUCCESS(rv) && val < sc->sc_tstate_count) {
    614  1.16.2.2  yamt 
    615  1.16.2.2  yamt 		if (val >= sc->sc_tstate_max &&
    616  1.16.2.2  yamt 		    sc->sc_tstate[val].ts_percent != 0)
    617  1.16.2.2  yamt 			sc->sc_tstate_min = val;
    618  1.16.2.2  yamt 	}
    619  1.16.2.2  yamt 
    620  1.16.2.2  yamt 	return AE_OK;
    621  1.16.2.2  yamt }
    622  1.16.2.2  yamt 
    623  1.16.2.2  yamt static void
    624  1.16.2.2  yamt acpicpu_tstate_reset(struct acpicpu_softc *sc)
    625  1.16.2.2  yamt {
    626  1.16.2.2  yamt 
    627  1.16.2.2  yamt 	sc->sc_tstate_max = 0;
    628  1.16.2.2  yamt 	sc->sc_tstate_min = sc->sc_tstate_count - 1;
    629  1.16.2.2  yamt }
    630  1.16.2.2  yamt 
    631  1.16.2.2  yamt int
    632  1.16.2.2  yamt acpicpu_tstate_get(struct acpicpu_softc *sc, uint32_t *percent)
    633  1.16.2.2  yamt {
    634  1.16.2.2  yamt 	const uint8_t method = sc->sc_tstate_control.reg_spaceid;
    635  1.16.2.2  yamt 	struct acpicpu_tstate *ts = NULL;
    636  1.16.2.2  yamt 	uint32_t i, val = 0;
    637  1.16.2.2  yamt 	uint8_t offset;
    638  1.16.2.2  yamt 	uint64_t addr;
    639  1.16.2.2  yamt 	int rv;
    640  1.16.2.2  yamt 
    641  1.16.2.2  yamt 	if (sc->sc_cold != false) {
    642  1.16.2.2  yamt 		rv = EBUSY;
    643  1.16.2.2  yamt 		goto fail;
    644  1.16.2.2  yamt 	}
    645  1.16.2.2  yamt 
    646  1.16.2.2  yamt 	if ((sc->sc_flags & ACPICPU_FLAG_T) == 0) {
    647  1.16.2.2  yamt 		rv = ENODEV;
    648  1.16.2.2  yamt 		goto fail;
    649  1.16.2.2  yamt 	}
    650  1.16.2.2  yamt 
    651  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    652  1.16.2.2  yamt 
    653  1.16.2.2  yamt 	if (sc->sc_tstate_current != ACPICPU_T_STATE_UNKNOWN) {
    654  1.16.2.2  yamt 		*percent = sc->sc_tstate_current;
    655  1.16.2.2  yamt 		mutex_exit(&sc->sc_mtx);
    656  1.16.2.2  yamt 		return 0;
    657  1.16.2.2  yamt 	}
    658  1.16.2.2  yamt 
    659  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    660  1.16.2.2  yamt 
    661  1.16.2.2  yamt 	switch (method) {
    662  1.16.2.2  yamt 
    663  1.16.2.2  yamt 	case ACPI_ADR_SPACE_FIXED_HARDWARE:
    664  1.16.2.2  yamt 
    665  1.16.2.2  yamt 		rv = acpicpu_md_tstate_get(sc, percent);
    666  1.16.2.2  yamt 
    667  1.16.2.2  yamt 		if (rv != 0)
    668  1.16.2.2  yamt 			goto fail;
    669  1.16.2.2  yamt 
    670  1.16.2.2  yamt 		break;
    671  1.16.2.2  yamt 
    672  1.16.2.2  yamt 	case ACPI_ADR_SPACE_SYSTEM_IO:
    673  1.16.2.2  yamt 
    674  1.16.2.2  yamt 		addr   = sc->sc_tstate_status.reg_addr;
    675  1.16.2.2  yamt 		offset = sc->sc_tstate_status.reg_bitoffset;
    676  1.16.2.2  yamt 
    677  1.16.2.2  yamt 		(void)AcpiOsReadPort(addr, &val, 8);
    678  1.16.2.2  yamt 
    679  1.16.2.2  yamt 		val = (val >> offset) & 0x0F;
    680  1.16.2.2  yamt 
    681  1.16.2.2  yamt 		for (i = 0; i < sc->sc_tstate_count; i++) {
    682  1.16.2.2  yamt 
    683  1.16.2.2  yamt 			if (sc->sc_tstate[i].ts_percent == 0)
    684  1.16.2.2  yamt 				continue;
    685  1.16.2.2  yamt 
    686  1.16.2.2  yamt 			if (val == sc->sc_tstate[i].ts_status) {
    687  1.16.2.2  yamt 				ts = &sc->sc_tstate[i];
    688  1.16.2.2  yamt 				break;
    689  1.16.2.2  yamt 			}
    690  1.16.2.2  yamt 		}
    691  1.16.2.2  yamt 
    692  1.16.2.2  yamt 		if (__predict_false(ts == NULL)) {
    693  1.16.2.2  yamt 			rv = EIO;
    694  1.16.2.2  yamt 			goto fail;
    695  1.16.2.2  yamt 		}
    696  1.16.2.2  yamt 
    697  1.16.2.2  yamt 		*percent = ts->ts_percent;
    698  1.16.2.2  yamt 		break;
    699  1.16.2.2  yamt 
    700  1.16.2.2  yamt 	default:
    701  1.16.2.2  yamt 		rv = ENOTTY;
    702  1.16.2.2  yamt 		goto fail;
    703  1.16.2.2  yamt 	}
    704  1.16.2.2  yamt 
    705  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    706  1.16.2.2  yamt 	sc->sc_tstate_current = *percent;
    707  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    708  1.16.2.2  yamt 
    709  1.16.2.2  yamt 	return 0;
    710  1.16.2.2  yamt 
    711  1.16.2.2  yamt fail:
    712  1.16.2.2  yamt 	aprint_error_dev(sc->sc_dev, "failed "
    713  1.16.2.2  yamt 	    "to get T-state (err %d)\n", rv);
    714  1.16.2.2  yamt 
    715  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    716  1.16.2.2  yamt 	*percent = sc->sc_tstate_current = ACPICPU_T_STATE_UNKNOWN;
    717  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    718  1.16.2.2  yamt 
    719  1.16.2.2  yamt 	return rv;
    720  1.16.2.2  yamt }
    721  1.16.2.2  yamt 
    722  1.16.2.2  yamt int
    723  1.16.2.2  yamt acpicpu_tstate_set(struct acpicpu_softc *sc, uint32_t percent)
    724  1.16.2.2  yamt {
    725  1.16.2.2  yamt 	const uint8_t method = sc->sc_tstate_control.reg_spaceid;
    726  1.16.2.2  yamt 	struct acpicpu_tstate *ts = NULL;
    727  1.16.2.2  yamt 	uint32_t i, val;
    728  1.16.2.2  yamt 	uint8_t offset;
    729  1.16.2.2  yamt 	uint64_t addr;
    730  1.16.2.2  yamt 	int rv;
    731  1.16.2.2  yamt 
    732  1.16.2.2  yamt 	if (sc->sc_cold != false) {
    733  1.16.2.2  yamt 		rv = EBUSY;
    734  1.16.2.2  yamt 		goto fail;
    735  1.16.2.2  yamt 	}
    736  1.16.2.2  yamt 
    737  1.16.2.2  yamt 	if ((sc->sc_flags & ACPICPU_FLAG_T) == 0) {
    738  1.16.2.2  yamt 		rv = ENODEV;
    739  1.16.2.2  yamt 		goto fail;
    740  1.16.2.2  yamt 	}
    741  1.16.2.2  yamt 
    742  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    743  1.16.2.2  yamt 
    744  1.16.2.2  yamt 	if (sc->sc_tstate_current == percent) {
    745  1.16.2.2  yamt 		mutex_exit(&sc->sc_mtx);
    746  1.16.2.2  yamt 		return 0;
    747  1.16.2.2  yamt 	}
    748  1.16.2.2  yamt 
    749  1.16.2.2  yamt 	for (i = sc->sc_tstate_max; i <= sc->sc_tstate_min; i++) {
    750  1.16.2.2  yamt 
    751  1.16.2.2  yamt 		if (sc->sc_tstate[i].ts_percent == 0)
    752  1.16.2.2  yamt 			continue;
    753  1.16.2.2  yamt 
    754  1.16.2.2  yamt 		if (sc->sc_tstate[i].ts_percent == percent) {
    755  1.16.2.2  yamt 			ts = &sc->sc_tstate[i];
    756  1.16.2.2  yamt 			break;
    757  1.16.2.2  yamt 		}
    758  1.16.2.2  yamt 	}
    759  1.16.2.2  yamt 
    760  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    761  1.16.2.2  yamt 
    762  1.16.2.2  yamt 	if (__predict_false(ts == NULL)) {
    763  1.16.2.2  yamt 		rv = EINVAL;
    764  1.16.2.2  yamt 		goto fail;
    765  1.16.2.2  yamt 	}
    766  1.16.2.2  yamt 
    767  1.16.2.2  yamt 	switch (method) {
    768  1.16.2.2  yamt 
    769  1.16.2.2  yamt 	case ACPI_ADR_SPACE_FIXED_HARDWARE:
    770  1.16.2.2  yamt 
    771  1.16.2.2  yamt 		rv = acpicpu_md_tstate_set(ts);
    772  1.16.2.2  yamt 
    773  1.16.2.2  yamt 		if (rv != 0)
    774  1.16.2.2  yamt 			goto fail;
    775  1.16.2.2  yamt 
    776  1.16.2.2  yamt 		break;
    777  1.16.2.2  yamt 
    778  1.16.2.2  yamt 	case ACPI_ADR_SPACE_SYSTEM_IO:
    779  1.16.2.2  yamt 
    780  1.16.2.2  yamt 		addr   = sc->sc_tstate_control.reg_addr;
    781  1.16.2.2  yamt 		offset = sc->sc_tstate_control.reg_bitoffset;
    782  1.16.2.2  yamt 
    783  1.16.2.2  yamt 		val = (ts->ts_control & 0x0F) << offset;
    784  1.16.2.2  yamt 
    785  1.16.2.2  yamt 		if (ts->ts_percent != 100 && (val & __BIT(4)) == 0) {
    786  1.16.2.2  yamt 			rv = EINVAL;
    787  1.16.2.2  yamt 			goto fail;
    788  1.16.2.2  yamt 		}
    789  1.16.2.2  yamt 
    790  1.16.2.2  yamt 		(void)AcpiOsWritePort(addr, val, 8);
    791  1.16.2.2  yamt 
    792  1.16.2.2  yamt 		/*
    793  1.16.2.2  yamt 		 * If the status field is zero, the transition is
    794  1.16.2.2  yamt 		 * specified to be "asynchronous" and there is no
    795  1.16.2.2  yamt 		 * need to check the status (ACPI 4.0, 8.4.3.2).
    796  1.16.2.2  yamt 		 */
    797  1.16.2.2  yamt 		if (ts->ts_status == 0)
    798  1.16.2.2  yamt 			break;
    799  1.16.2.2  yamt 
    800  1.16.2.2  yamt 		addr   = sc->sc_tstate_status.reg_addr;
    801  1.16.2.2  yamt 		offset = sc->sc_tstate_status.reg_bitoffset;
    802  1.16.2.2  yamt 
    803  1.16.2.2  yamt 		for (i = val = 0; i < ACPICPU_T_STATE_RETRY; i++) {
    804  1.16.2.2  yamt 
    805  1.16.2.2  yamt 			(void)AcpiOsReadPort(addr, &val, 8);
    806  1.16.2.2  yamt 
    807  1.16.2.2  yamt 			val = (val >> offset) & 0x0F;
    808  1.16.2.2  yamt 
    809  1.16.2.2  yamt 			if (val == ts->ts_status)
    810  1.16.2.2  yamt 				break;
    811  1.16.2.2  yamt 
    812  1.16.2.2  yamt 			DELAY(ts->ts_latency);
    813  1.16.2.2  yamt 		}
    814  1.16.2.2  yamt 
    815  1.16.2.2  yamt 		if (i == ACPICPU_T_STATE_RETRY) {
    816  1.16.2.2  yamt 			rv = EAGAIN;
    817  1.16.2.2  yamt 			goto fail;
    818  1.16.2.2  yamt 		}
    819  1.16.2.2  yamt 
    820  1.16.2.2  yamt 		break;
    821  1.16.2.2  yamt 
    822  1.16.2.2  yamt 	default:
    823  1.16.2.2  yamt 		rv = ENOTTY;
    824  1.16.2.2  yamt 		goto fail;
    825  1.16.2.2  yamt 	}
    826  1.16.2.2  yamt 
    827  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    828  1.16.2.2  yamt 	ts->ts_evcnt.ev_count++;
    829  1.16.2.2  yamt 	sc->sc_tstate_current = percent;
    830  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    831  1.16.2.2  yamt 
    832  1.16.2.2  yamt 	return 0;
    833  1.16.2.2  yamt 
    834  1.16.2.2  yamt fail:
    835  1.16.2.2  yamt 	aprint_error_dev(sc->sc_dev, "failed to "
    836  1.16.2.2  yamt 	    "throttle to %u %% (err %d)\n", percent, rv);
    837  1.16.2.2  yamt 
    838  1.16.2.2  yamt 	mutex_enter(&sc->sc_mtx);
    839  1.16.2.2  yamt 	sc->sc_tstate_current = ACPICPU_T_STATE_UNKNOWN;
    840  1.16.2.2  yamt 	mutex_exit(&sc->sc_mtx);
    841  1.16.2.2  yamt 
    842  1.16.2.2  yamt 	return rv;
    843  1.16.2.2  yamt }
    844