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