150f14c4fSAndriy Gapon /*- 250f14c4fSAndriy Gapon * SPDX-License-Identifier: BSD-2-Clause 350f14c4fSAndriy Gapon * 450f14c4fSAndriy Gapon * Copyright (c) 2019 Andriy Gapon 5e3722b78SAndriy Gapon * 6e3722b78SAndriy Gapon * Redistribution and use in source and binary forms, with or without 7e3722b78SAndriy Gapon * modification, are permitted provided that the following conditions 8e3722b78SAndriy Gapon * are met: 9e3722b78SAndriy Gapon * 1. Redistributions of source code must retain the above copyright 10e3722b78SAndriy Gapon * notice, this list of conditions and the following disclaimer. 11e3722b78SAndriy Gapon * 2. Redistributions in binary form must reproduce the above copyright 12e3722b78SAndriy Gapon * notice, this list of conditions and the following disclaimer in the 13e3722b78SAndriy Gapon * documentation and/or other materials provided with the distribution. 14e3722b78SAndriy Gapon * 1550f14c4fSAndriy Gapon * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16e3722b78SAndriy Gapon * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17e3722b78SAndriy Gapon * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18e3722b78SAndriy Gapon * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19e3722b78SAndriy Gapon * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20e3722b78SAndriy Gapon * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21e3722b78SAndriy Gapon * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22e3722b78SAndriy Gapon * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23e3722b78SAndriy Gapon * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24e3722b78SAndriy Gapon * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25e3722b78SAndriy Gapon * SUCH DAMAGE. 2650f14c4fSAndriy Gapon * 2750f14c4fSAndriy Gapon * $FreeBSD$ 28e3722b78SAndriy Gapon */ 29e3722b78SAndriy Gapon 30e3722b78SAndriy Gapon #include <sys/cdefs.h> 31e3722b78SAndriy Gapon __FBSDID("$FreeBSD$"); 32e3722b78SAndriy Gapon 33e3722b78SAndriy Gapon #include <sys/param.h> 34e3722b78SAndriy Gapon #include <sys/systm.h> 35e3722b78SAndriy Gapon #include <sys/bus.h> 36e3722b78SAndriy Gapon #include <sys/conf.h> 37e3722b78SAndriy Gapon #include <sys/kernel.h> 38e3722b78SAndriy Gapon #include <sys/lock.h> 39e3722b78SAndriy Gapon #include <sys/mutex.h> 40e3722b78SAndriy Gapon #include <sys/malloc.h> 41e3722b78SAndriy Gapon #include <sys/module.h> 42e3722b78SAndriy Gapon #include <sys/proc.h> 43e3722b78SAndriy Gapon #include <sys/rman.h> 44ddfc9c4cSWarner Losh #include <sys/sbuf.h> 45e3722b78SAndriy Gapon #include <sys/time.h> 46e3722b78SAndriy Gapon 47e3722b78SAndriy Gapon #include <machine/bus.h> 48e3722b78SAndriy Gapon #include <machine/resource.h> 49e3722b78SAndriy Gapon #include <machine/stdarg.h> 50e3722b78SAndriy Gapon 51e3722b78SAndriy Gapon #include <isa/isavar.h> 52e3722b78SAndriy Gapon 53e3722b78SAndriy Gapon #include <dev/superio/superio.h> 540aee3bdcSAndriy Gapon #include <dev/superio/superio_io.h> 55e3722b78SAndriy Gapon 56e3722b78SAndriy Gapon #include "isa_if.h" 57e3722b78SAndriy Gapon 58e3722b78SAndriy Gapon typedef void (*sio_conf_enter_f)(struct resource*, uint16_t); 59e3722b78SAndriy Gapon typedef void (*sio_conf_exit_f)(struct resource*, uint16_t); 60e3722b78SAndriy Gapon 61e3722b78SAndriy Gapon struct sio_conf_methods { 62e3722b78SAndriy Gapon sio_conf_enter_f enter; 63e3722b78SAndriy Gapon sio_conf_exit_f exit; 64e3722b78SAndriy Gapon superio_vendor_t vendor; 65e3722b78SAndriy Gapon }; 66e3722b78SAndriy Gapon 67e3722b78SAndriy Gapon struct sio_device { 68e3722b78SAndriy Gapon uint8_t ldn; 69e3722b78SAndriy Gapon superio_dev_type_t type; 70e3722b78SAndriy Gapon }; 71e3722b78SAndriy Gapon 72e3722b78SAndriy Gapon struct superio_devinfo { 73e3722b78SAndriy Gapon STAILQ_ENTRY(superio_devinfo) link; 74e3722b78SAndriy Gapon struct resource_list resources; 75e3722b78SAndriy Gapon device_t dev; 76e3722b78SAndriy Gapon uint8_t ldn; 77e3722b78SAndriy Gapon superio_dev_type_t type; 78e3722b78SAndriy Gapon uint16_t iobase; 79e3722b78SAndriy Gapon uint16_t iobase2; 80e3722b78SAndriy Gapon uint8_t irq; 81e3722b78SAndriy Gapon uint8_t dma; 82e3722b78SAndriy Gapon }; 83e3722b78SAndriy Gapon 84e3722b78SAndriy Gapon struct siosc { 85e3722b78SAndriy Gapon struct mtx conf_lock; 86e3722b78SAndriy Gapon STAILQ_HEAD(, superio_devinfo) devlist; 87e3722b78SAndriy Gapon struct resource* io_res; 880aee3bdcSAndriy Gapon struct cdev *chardev; 89e3722b78SAndriy Gapon int io_rid; 90e3722b78SAndriy Gapon uint16_t io_port; 91e3722b78SAndriy Gapon const struct sio_conf_methods *methods; 92e3722b78SAndriy Gapon const struct sio_device *known_devices; 93e3722b78SAndriy Gapon superio_vendor_t vendor; 94e3722b78SAndriy Gapon uint16_t devid; 95e3722b78SAndriy Gapon uint8_t revid; 96e3722b78SAndriy Gapon uint8_t current_ldn; 97e3722b78SAndriy Gapon uint8_t ldn_reg; 98e3722b78SAndriy Gapon uint8_t enable_reg; 99e3722b78SAndriy Gapon }; 100e3722b78SAndriy Gapon 1010aee3bdcSAndriy Gapon static d_ioctl_t superio_ioctl; 1020aee3bdcSAndriy Gapon 1030aee3bdcSAndriy Gapon static struct cdevsw superio_cdevsw = { 1040aee3bdcSAndriy Gapon .d_version = D_VERSION, 1050aee3bdcSAndriy Gapon .d_ioctl = superio_ioctl, 1060aee3bdcSAndriy Gapon .d_name = "superio", 1070aee3bdcSAndriy Gapon }; 1080aee3bdcSAndriy Gapon 109e3722b78SAndriy Gapon #define NUMPORTS 2 110e3722b78SAndriy Gapon 111e3722b78SAndriy Gapon static uint8_t 112e3722b78SAndriy Gapon sio_read(struct resource* res, uint8_t reg) 113e3722b78SAndriy Gapon { 114e3722b78SAndriy Gapon bus_write_1(res, 0, reg); 115e3722b78SAndriy Gapon return (bus_read_1(res, 1)); 116e3722b78SAndriy Gapon } 117e3722b78SAndriy Gapon 118e3722b78SAndriy Gapon /* Read a word from two one-byte registers, big endian. */ 119e3722b78SAndriy Gapon static uint16_t 120e3722b78SAndriy Gapon sio_readw(struct resource* res, uint8_t reg) 121e3722b78SAndriy Gapon { 122e3722b78SAndriy Gapon uint16_t v; 123e3722b78SAndriy Gapon 124e3722b78SAndriy Gapon v = sio_read(res, reg); 125e3722b78SAndriy Gapon v <<= 8; 126e3722b78SAndriy Gapon v |= sio_read(res, reg + 1); 127e3722b78SAndriy Gapon return (v); 128e3722b78SAndriy Gapon } 129e3722b78SAndriy Gapon 130e3722b78SAndriy Gapon static void 131e3722b78SAndriy Gapon sio_write(struct resource* res, uint8_t reg, uint8_t val) 132e3722b78SAndriy Gapon { 133e3722b78SAndriy Gapon bus_write_1(res, 0, reg); 134e3722b78SAndriy Gapon bus_write_1(res, 1, val); 135e3722b78SAndriy Gapon } 136e3722b78SAndriy Gapon 137e3722b78SAndriy Gapon static void 138e3722b78SAndriy Gapon sio_ldn_select(struct siosc *sc, uint8_t ldn) 139e3722b78SAndriy Gapon { 140e3722b78SAndriy Gapon mtx_assert(&sc->conf_lock, MA_OWNED); 141e3722b78SAndriy Gapon if (ldn == sc->current_ldn) 142e3722b78SAndriy Gapon return; 143e3722b78SAndriy Gapon sio_write(sc->io_res, sc->ldn_reg, ldn); 144e3722b78SAndriy Gapon sc->current_ldn = ldn; 145e3722b78SAndriy Gapon } 146e3722b78SAndriy Gapon 147e3722b78SAndriy Gapon static uint8_t 148e3722b78SAndriy Gapon sio_ldn_read(struct siosc *sc, uint8_t ldn, uint8_t reg) 149e3722b78SAndriy Gapon { 150e3722b78SAndriy Gapon mtx_assert(&sc->conf_lock, MA_OWNED); 151e3722b78SAndriy Gapon if (reg >= sc->enable_reg) { 152e3722b78SAndriy Gapon sio_ldn_select(sc, ldn); 153e3722b78SAndriy Gapon KASSERT(sc->current_ldn == ldn, ("sio_ldn_select failed")); 154e3722b78SAndriy Gapon } 155e3722b78SAndriy Gapon return (sio_read(sc->io_res, reg)); 156e3722b78SAndriy Gapon } 157e3722b78SAndriy Gapon 158e3722b78SAndriy Gapon static uint16_t 159e3722b78SAndriy Gapon sio_ldn_readw(struct siosc *sc, uint8_t ldn, uint8_t reg) 160e3722b78SAndriy Gapon { 161e3722b78SAndriy Gapon mtx_assert(&sc->conf_lock, MA_OWNED); 162e3722b78SAndriy Gapon if (reg >= sc->enable_reg) { 163e3722b78SAndriy Gapon sio_ldn_select(sc, ldn); 164e3722b78SAndriy Gapon KASSERT(sc->current_ldn == ldn, ("sio_ldn_select failed")); 165e3722b78SAndriy Gapon } 166e3722b78SAndriy Gapon return (sio_readw(sc->io_res, reg)); 167e3722b78SAndriy Gapon } 168e3722b78SAndriy Gapon 169e3722b78SAndriy Gapon static void 170e3722b78SAndriy Gapon sio_ldn_write(struct siosc *sc, uint8_t ldn, uint8_t reg, uint8_t val) 171e3722b78SAndriy Gapon { 172e3722b78SAndriy Gapon mtx_assert(&sc->conf_lock, MA_OWNED); 173e3722b78SAndriy Gapon if (reg <= sc->ldn_reg) { 174e3722b78SAndriy Gapon printf("ignored attempt to write special register 0x%x\n", reg); 175e3722b78SAndriy Gapon return; 176e3722b78SAndriy Gapon } 177e3722b78SAndriy Gapon sio_ldn_select(sc, ldn); 178e3722b78SAndriy Gapon KASSERT(sc->current_ldn == ldn, ("sio_ldn_select failed")); 179e3722b78SAndriy Gapon sio_write(sc->io_res, reg, val); 180e3722b78SAndriy Gapon } 181e3722b78SAndriy Gapon 182e3722b78SAndriy Gapon static void 183e3722b78SAndriy Gapon sio_conf_enter(struct siosc *sc) 184e3722b78SAndriy Gapon { 185e3722b78SAndriy Gapon mtx_lock(&sc->conf_lock); 186e3722b78SAndriy Gapon sc->methods->enter(sc->io_res, sc->io_port); 187e3722b78SAndriy Gapon } 188e3722b78SAndriy Gapon 189e3722b78SAndriy Gapon static void 190e3722b78SAndriy Gapon sio_conf_exit(struct siosc *sc) 191e3722b78SAndriy Gapon { 192e3722b78SAndriy Gapon sc->methods->exit(sc->io_res, sc->io_port); 193e84d4316SAndriy Gapon sc->current_ldn = 0xff; 194e3722b78SAndriy Gapon mtx_unlock(&sc->conf_lock); 195e3722b78SAndriy Gapon } 196e3722b78SAndriy Gapon 197e3722b78SAndriy Gapon static void 198e3722b78SAndriy Gapon ite_conf_enter(struct resource* res, uint16_t port) 199e3722b78SAndriy Gapon { 200e3722b78SAndriy Gapon bus_write_1(res, 0, 0x87); 201e3722b78SAndriy Gapon bus_write_1(res, 0, 0x01); 202e3722b78SAndriy Gapon bus_write_1(res, 0, 0x55); 203e3722b78SAndriy Gapon bus_write_1(res, 0, port == 0x2e ? 0x55 : 0xaa); 204e3722b78SAndriy Gapon } 205e3722b78SAndriy Gapon 206e3722b78SAndriy Gapon static void 207e3722b78SAndriy Gapon ite_conf_exit(struct resource* res, uint16_t port) 208e3722b78SAndriy Gapon { 209e3722b78SAndriy Gapon sio_write(res, 0x02, 0x02); 210e3722b78SAndriy Gapon } 211e3722b78SAndriy Gapon 212e3722b78SAndriy Gapon static const struct sio_conf_methods ite_conf_methods = { 213e3722b78SAndriy Gapon .enter = ite_conf_enter, 214e3722b78SAndriy Gapon .exit = ite_conf_exit, 215e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE 216e3722b78SAndriy Gapon }; 217e3722b78SAndriy Gapon 218e3722b78SAndriy Gapon static void 219e3722b78SAndriy Gapon nvt_conf_enter(struct resource* res, uint16_t port) 220e3722b78SAndriy Gapon { 221e3722b78SAndriy Gapon bus_write_1(res, 0, 0x87); 222e3722b78SAndriy Gapon bus_write_1(res, 0, 0x87); 223e3722b78SAndriy Gapon } 224e3722b78SAndriy Gapon 225e3722b78SAndriy Gapon static void 226e3722b78SAndriy Gapon nvt_conf_exit(struct resource* res, uint16_t port) 227e3722b78SAndriy Gapon { 228e3722b78SAndriy Gapon bus_write_1(res, 0, 0xaa); 229e3722b78SAndriy Gapon } 230e3722b78SAndriy Gapon 231e3722b78SAndriy Gapon static const struct sio_conf_methods nvt_conf_methods = { 232e3722b78SAndriy Gapon .enter = nvt_conf_enter, 233e3722b78SAndriy Gapon .exit = nvt_conf_exit, 234e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON 235e3722b78SAndriy Gapon }; 236e3722b78SAndriy Gapon 237c0c23454SPoul-Henning Kamp static void 238c0c23454SPoul-Henning Kamp fintek_conf_enter(struct resource* res, uint16_t port) 239c0c23454SPoul-Henning Kamp { 240c0c23454SPoul-Henning Kamp bus_write_1(res, 0, 0x87); 241c0c23454SPoul-Henning Kamp bus_write_1(res, 0, 0x87); 242c0c23454SPoul-Henning Kamp } 243c0c23454SPoul-Henning Kamp 244c0c23454SPoul-Henning Kamp static void 245c0c23454SPoul-Henning Kamp fintek_conf_exit(struct resource* res, uint16_t port) 246c0c23454SPoul-Henning Kamp { 247c0c23454SPoul-Henning Kamp bus_write_1(res, 0, 0xaa); 248c0c23454SPoul-Henning Kamp } 249c0c23454SPoul-Henning Kamp 250c0c23454SPoul-Henning Kamp static const struct sio_conf_methods fintek_conf_methods = { 251c0c23454SPoul-Henning Kamp .enter = fintek_conf_enter, 252c0c23454SPoul-Henning Kamp .exit = fintek_conf_exit, 253c0c23454SPoul-Henning Kamp .vendor = SUPERIO_VENDOR_FINTEK 254c0c23454SPoul-Henning Kamp }; 255c0c23454SPoul-Henning Kamp 256e3722b78SAndriy Gapon static const struct sio_conf_methods * const methods_table[] = { 257e3722b78SAndriy Gapon &ite_conf_methods, 258e3722b78SAndriy Gapon &nvt_conf_methods, 259c0c23454SPoul-Henning Kamp &fintek_conf_methods, 260e3722b78SAndriy Gapon NULL 261e3722b78SAndriy Gapon }; 262e3722b78SAndriy Gapon 263e3722b78SAndriy Gapon static const uint16_t ports_table[] = { 264e3722b78SAndriy Gapon 0x2e, 0x4e, 0 265e3722b78SAndriy Gapon }; 266e3722b78SAndriy Gapon 267e3722b78SAndriy Gapon const struct sio_device ite_devices[] = { 268e3722b78SAndriy Gapon { .ldn = 4, .type = SUPERIO_DEV_HWM }, 269e3722b78SAndriy Gapon { .ldn = 7, .type = SUPERIO_DEV_WDT }, 270e3722b78SAndriy Gapon { .type = SUPERIO_DEV_NONE }, 271e3722b78SAndriy Gapon }; 272e3722b78SAndriy Gapon 273e3722b78SAndriy Gapon const struct sio_device nvt_devices[] = { 274e3722b78SAndriy Gapon { .ldn = 8, .type = SUPERIO_DEV_WDT }, 275e3722b78SAndriy Gapon { .type = SUPERIO_DEV_NONE }, 276e3722b78SAndriy Gapon }; 277e3722b78SAndriy Gapon 278e3722b78SAndriy Gapon const struct sio_device nct5104_devices[] = { 279e3722b78SAndriy Gapon { .ldn = 7, .type = SUPERIO_DEV_GPIO }, 280e3722b78SAndriy Gapon { .ldn = 8, .type = SUPERIO_DEV_WDT }, 281e3722b78SAndriy Gapon { .ldn = 15, .type = SUPERIO_DEV_GPIO }, 282e3722b78SAndriy Gapon { .type = SUPERIO_DEV_NONE }, 283e3722b78SAndriy Gapon }; 284e3722b78SAndriy Gapon 285c0c23454SPoul-Henning Kamp const struct sio_device fintek_devices[] = { 286*1b10e191SStéphane Rochoy { .ldn = 6, .type = SUPERIO_DEV_GPIO }, 287c0c23454SPoul-Henning Kamp { .ldn = 7, .type = SUPERIO_DEV_WDT }, 288c0c23454SPoul-Henning Kamp { .type = SUPERIO_DEV_NONE }, 289c0c23454SPoul-Henning Kamp }; 290c0c23454SPoul-Henning Kamp 291e3722b78SAndriy Gapon static const struct { 292e3722b78SAndriy Gapon superio_vendor_t vendor; 293e3722b78SAndriy Gapon uint16_t devid; 294e3722b78SAndriy Gapon uint16_t mask; 295e3722b78SAndriy Gapon const char *descr; 296e3722b78SAndriy Gapon const struct sio_device *devices; 297e3722b78SAndriy Gapon } superio_table[] = { 298e3722b78SAndriy Gapon { 299e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8712, 300e3722b78SAndriy Gapon .devices = ite_devices, 301e3722b78SAndriy Gapon }, 302e3722b78SAndriy Gapon { 303e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8716, 304e3722b78SAndriy Gapon .devices = ite_devices, 305e3722b78SAndriy Gapon }, 306e3722b78SAndriy Gapon { 307e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8718, 308e3722b78SAndriy Gapon .devices = ite_devices, 309e3722b78SAndriy Gapon }, 310e3722b78SAndriy Gapon { 311e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8720, 312e3722b78SAndriy Gapon .devices = ite_devices, 313e3722b78SAndriy Gapon }, 314e3722b78SAndriy Gapon { 315e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8721, 316e3722b78SAndriy Gapon .devices = ite_devices, 317e3722b78SAndriy Gapon }, 318e3722b78SAndriy Gapon { 319e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8726, 320e3722b78SAndriy Gapon .devices = ite_devices, 321e3722b78SAndriy Gapon }, 322e3722b78SAndriy Gapon { 323e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8728, 324e3722b78SAndriy Gapon .devices = ite_devices, 325e3722b78SAndriy Gapon }, 326e3722b78SAndriy Gapon { 327e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_ITE, .devid = 0x8771, 328e3722b78SAndriy Gapon .devices = ite_devices, 329e3722b78SAndriy Gapon }, 330e3722b78SAndriy Gapon { 331e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x1061, .mask = 0x00, 332e3722b78SAndriy Gapon .descr = "Nuvoton NCT5104D/NCT6102D/NCT6106D (rev. A)", 333e3722b78SAndriy Gapon .devices = nct5104_devices, 334e3722b78SAndriy Gapon }, 335e3722b78SAndriy Gapon { 336e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x5200, .mask = 0xff, 337e3722b78SAndriy Gapon .descr = "Winbond 83627HF/F/HG/G", 338e3722b78SAndriy Gapon .devices = nvt_devices, 339e3722b78SAndriy Gapon }, 340e3722b78SAndriy Gapon { 341e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x5900, .mask = 0xff, 342e3722b78SAndriy Gapon .descr = "Winbond 83627S", 343e3722b78SAndriy Gapon .devices = nvt_devices, 344e3722b78SAndriy Gapon }, 345e3722b78SAndriy Gapon { 346e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x6000, .mask = 0xff, 347e3722b78SAndriy Gapon .descr = "Winbond 83697HF", 348e3722b78SAndriy Gapon .devices = nvt_devices, 349e3722b78SAndriy Gapon }, 350e3722b78SAndriy Gapon { 351e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x6800, .mask = 0xff, 352e3722b78SAndriy Gapon .descr = "Winbond 83697UG", 353e3722b78SAndriy Gapon .devices = nvt_devices, 354e3722b78SAndriy Gapon }, 355e3722b78SAndriy Gapon { 356e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x7000, .mask = 0xff, 357e3722b78SAndriy Gapon .descr = "Winbond 83637HF", 358e3722b78SAndriy Gapon .devices = nvt_devices, 359e3722b78SAndriy Gapon }, 360e3722b78SAndriy Gapon { 361e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x8200, .mask = 0xff, 362e3722b78SAndriy Gapon .descr = "Winbond 83627THF", 363e3722b78SAndriy Gapon .devices = nvt_devices, 364e3722b78SAndriy Gapon }, 365e3722b78SAndriy Gapon { 366e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x8500, .mask = 0xff, 367e3722b78SAndriy Gapon .descr = "Winbond 83687THF", 368e3722b78SAndriy Gapon .devices = nvt_devices, 369e3722b78SAndriy Gapon }, 370e3722b78SAndriy Gapon { 371e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0x8800, .mask = 0xff, 372e3722b78SAndriy Gapon .descr = "Winbond 83627EHF", 373e3722b78SAndriy Gapon .devices = nvt_devices, 374e3722b78SAndriy Gapon }, 375e3722b78SAndriy Gapon { 376e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xa000, .mask = 0xff, 377e3722b78SAndriy Gapon .descr = "Winbond 83627DHG", 378e3722b78SAndriy Gapon .devices = nvt_devices, 379e3722b78SAndriy Gapon }, 380e3722b78SAndriy Gapon { 381e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xa200, .mask = 0xff, 382e3722b78SAndriy Gapon .descr = "Winbond 83627UHG", 383e3722b78SAndriy Gapon .devices = nvt_devices, 384e3722b78SAndriy Gapon }, 385e3722b78SAndriy Gapon { 386e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xa500, .mask = 0xff, 387e3722b78SAndriy Gapon .descr = "Winbond 83667HG", 388e3722b78SAndriy Gapon .devices = nvt_devices, 389e3722b78SAndriy Gapon }, 390e3722b78SAndriy Gapon { 391e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xb000, .mask = 0xff, 392e3722b78SAndriy Gapon .descr = "Winbond 83627DHG-P", 393e3722b78SAndriy Gapon .devices = nvt_devices, 394e3722b78SAndriy Gapon }, 395e3722b78SAndriy Gapon { 396e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xb300, .mask = 0xff, 397e3722b78SAndriy Gapon .descr = "Winbond 83667HG-B", 398e3722b78SAndriy Gapon .devices = nvt_devices, 399e3722b78SAndriy Gapon }, 400e3722b78SAndriy Gapon { 401e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xb400, .mask = 0xff, 402e3722b78SAndriy Gapon .descr = "Nuvoton NCT6775", 403e3722b78SAndriy Gapon .devices = nvt_devices, 404e3722b78SAndriy Gapon }, 405e3722b78SAndriy Gapon { 406e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xc300, .mask = 0xff, 407e3722b78SAndriy Gapon .descr = "Nuvoton NCT6776", 408e3722b78SAndriy Gapon .devices = nvt_devices, 409e3722b78SAndriy Gapon }, 410e3722b78SAndriy Gapon { 411e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xc400, .mask = 0xff, 412e3722b78SAndriy Gapon .descr = "Nuvoton NCT5104D/NCT6102D/NCT6106D (rev. B+)", 413e3722b78SAndriy Gapon .devices = nct5104_devices, 414e3722b78SAndriy Gapon }, 415e3722b78SAndriy Gapon { 416e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xc500, .mask = 0xff, 417e3722b78SAndriy Gapon .descr = "Nuvoton NCT6779", 418e3722b78SAndriy Gapon .devices = nvt_devices, 419e3722b78SAndriy Gapon }, 420e3722b78SAndriy Gapon { 421e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xc800, .mask = 0xff, 422e3722b78SAndriy Gapon .descr = "Nuvoton NCT6791", 423e3722b78SAndriy Gapon .devices = nvt_devices, 424e3722b78SAndriy Gapon }, 425e3722b78SAndriy Gapon { 426e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xc900, .mask = 0xff, 427e3722b78SAndriy Gapon .descr = "Nuvoton NCT6792", 428e3722b78SAndriy Gapon .devices = nvt_devices, 429e3722b78SAndriy Gapon }, 430e3722b78SAndriy Gapon { 431e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xd100, .mask = 0xff, 432e3722b78SAndriy Gapon .descr = "Nuvoton NCT6793", 433e3722b78SAndriy Gapon .devices = nvt_devices, 434e3722b78SAndriy Gapon }, 435e3722b78SAndriy Gapon { 436e3722b78SAndriy Gapon .vendor = SUPERIO_VENDOR_NUVOTON, .devid = 0xd300, .mask = 0xff, 437e3722b78SAndriy Gapon .descr = "Nuvoton NCT6795", 438e3722b78SAndriy Gapon .devices = nvt_devices, 439e3722b78SAndriy Gapon }, 440c0c23454SPoul-Henning Kamp { 441c0c23454SPoul-Henning Kamp .vendor = SUPERIO_VENDOR_FINTEK, .devid = 0x1210, .mask = 0xff, 442c0c23454SPoul-Henning Kamp .descr = "Fintek F81803", 443c0c23454SPoul-Henning Kamp .devices = fintek_devices, 444c0c23454SPoul-Henning Kamp }, 445*1b10e191SStéphane Rochoy { 446*1b10e191SStéphane Rochoy .vendor = SUPERIO_VENDOR_FINTEK, .devid = 0x0704, 447*1b10e191SStéphane Rochoy .descr = "Fintek F81865", 448*1b10e191SStéphane Rochoy .devices = fintek_devices, 449*1b10e191SStéphane Rochoy }, 450e3722b78SAndriy Gapon { 0, 0 } 451e3722b78SAndriy Gapon }; 452e3722b78SAndriy Gapon 453e3722b78SAndriy Gapon static const char * 454e3722b78SAndriy Gapon devtype_to_str(superio_dev_type_t type) 455e3722b78SAndriy Gapon { 456e3722b78SAndriy Gapon switch (type) { 457e3722b78SAndriy Gapon case SUPERIO_DEV_NONE: 4586529459aSLi-Wen Hsu return ("none"); 459e3722b78SAndriy Gapon case SUPERIO_DEV_HWM: 460e3722b78SAndriy Gapon return ("HWM"); 461e3722b78SAndriy Gapon case SUPERIO_DEV_WDT: 462e3722b78SAndriy Gapon return ("WDT"); 463e3722b78SAndriy Gapon case SUPERIO_DEV_GPIO: 464e3722b78SAndriy Gapon return ("GPIO"); 465e3722b78SAndriy Gapon case SUPERIO_DEV_MAX: 466e3722b78SAndriy Gapon return ("invalid"); 467e3722b78SAndriy Gapon } 4686529459aSLi-Wen Hsu return ("invalid"); 469e3722b78SAndriy Gapon } 470e3722b78SAndriy Gapon 471e3722b78SAndriy Gapon static int 472e3722b78SAndriy Gapon superio_detect(device_t dev, bool claim, struct siosc *sc) 473e3722b78SAndriy Gapon { 474e3722b78SAndriy Gapon struct resource *res; 475e3722b78SAndriy Gapon rman_res_t port; 476e3722b78SAndriy Gapon rman_res_t count; 477e3722b78SAndriy Gapon uint16_t devid; 478e3722b78SAndriy Gapon uint8_t revid; 479e3722b78SAndriy Gapon int error; 480e3722b78SAndriy Gapon int rid; 481e3722b78SAndriy Gapon int i, m; 482e3722b78SAndriy Gapon 483e3722b78SAndriy Gapon error = bus_get_resource(dev, SYS_RES_IOPORT, 0, &port, &count); 484e3722b78SAndriy Gapon if (error != 0) 485e3722b78SAndriy Gapon return (error); 486e3722b78SAndriy Gapon if (port > UINT16_MAX || count < NUMPORTS) { 487e3722b78SAndriy Gapon device_printf(dev, "unexpected I/O range size\n"); 488e3722b78SAndriy Gapon return (ENXIO); 489e3722b78SAndriy Gapon } 490e3722b78SAndriy Gapon 491e3722b78SAndriy Gapon /* 492e3722b78SAndriy Gapon * Make a temporary resource reservation for hardware probing. 493e3722b78SAndriy Gapon * If we can't get the resources we need then 494e3722b78SAndriy Gapon * we need to abort. Possibly this indicates 495e3722b78SAndriy Gapon * the resources were used by another device 496e3722b78SAndriy Gapon * in which case the probe would have failed anyhow. 497e3722b78SAndriy Gapon */ 498e3722b78SAndriy Gapon rid = 0; 499e3722b78SAndriy Gapon res = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 500e3722b78SAndriy Gapon if (res == NULL) { 501e3722b78SAndriy Gapon if (claim) 502e3722b78SAndriy Gapon device_printf(dev, "failed to allocate I/O resource\n"); 503e3722b78SAndriy Gapon return (ENXIO); 504e3722b78SAndriy Gapon } 505e3722b78SAndriy Gapon 506e3722b78SAndriy Gapon for (m = 0; methods_table[m] != NULL; m++) { 507e3722b78SAndriy Gapon methods_table[m]->enter(res, port); 508e3722b78SAndriy Gapon if (methods_table[m]->vendor == SUPERIO_VENDOR_ITE) { 509e3722b78SAndriy Gapon devid = sio_readw(res, 0x20); 510e3722b78SAndriy Gapon revid = sio_read(res, 0x22); 511e3722b78SAndriy Gapon } else if (methods_table[m]->vendor == SUPERIO_VENDOR_NUVOTON) { 512e3722b78SAndriy Gapon devid = sio_read(res, 0x20); 513e3722b78SAndriy Gapon revid = sio_read(res, 0x21); 514e3722b78SAndriy Gapon devid = (devid << 8) | revid; 515c0c23454SPoul-Henning Kamp } else if (methods_table[m]->vendor == SUPERIO_VENDOR_FINTEK) { 516c0c23454SPoul-Henning Kamp devid = sio_read(res, 0x20); 517c0c23454SPoul-Henning Kamp revid = sio_read(res, 0x21); 518c0c23454SPoul-Henning Kamp devid = (devid << 8) | revid; 519e3722b78SAndriy Gapon } else { 520e3722b78SAndriy Gapon continue; 521e3722b78SAndriy Gapon } 522e3722b78SAndriy Gapon methods_table[m]->exit(res, port); 523e3722b78SAndriy Gapon for (i = 0; superio_table[i].vendor != 0; i++) { 524e3722b78SAndriy Gapon uint16_t mask; 525e3722b78SAndriy Gapon 526e3722b78SAndriy Gapon mask = superio_table[i].mask; 527e3722b78SAndriy Gapon if (superio_table[i].vendor != 528e3722b78SAndriy Gapon methods_table[m]->vendor) 529e3722b78SAndriy Gapon continue; 530e3722b78SAndriy Gapon if ((superio_table[i].devid & ~mask) != (devid & ~mask)) 531e3722b78SAndriy Gapon continue; 532e3722b78SAndriy Gapon break; 533e3722b78SAndriy Gapon } 534e3722b78SAndriy Gapon 535e3722b78SAndriy Gapon /* Found a matching SuperIO entry. */ 536e3722b78SAndriy Gapon if (superio_table[i].vendor != 0) 537e3722b78SAndriy Gapon break; 538e3722b78SAndriy Gapon } 539e3722b78SAndriy Gapon 540e3722b78SAndriy Gapon if (methods_table[m] == NULL) 541e3722b78SAndriy Gapon error = ENXIO; 542e3722b78SAndriy Gapon else 543e3722b78SAndriy Gapon error = 0; 544e3722b78SAndriy Gapon if (!claim || error != 0) { 545e3722b78SAndriy Gapon bus_release_resource(dev, SYS_RES_IOPORT, rid, res); 546e3722b78SAndriy Gapon return (error); 547e3722b78SAndriy Gapon } 548e3722b78SAndriy Gapon 549e3722b78SAndriy Gapon sc->methods = methods_table[m]; 550e3722b78SAndriy Gapon sc->vendor = sc->methods->vendor; 551e3722b78SAndriy Gapon sc->known_devices = superio_table[i].devices; 552e3722b78SAndriy Gapon sc->io_res = res; 553e3722b78SAndriy Gapon sc->io_rid = rid; 554e3722b78SAndriy Gapon sc->io_port = port; 555e3722b78SAndriy Gapon sc->devid = devid; 556e3722b78SAndriy Gapon sc->revid = revid; 557e3722b78SAndriy Gapon 558e3722b78SAndriy Gapon KASSERT(sc->vendor == SUPERIO_VENDOR_ITE || 559*1b10e191SStéphane Rochoy sc->vendor == SUPERIO_VENDOR_NUVOTON || 560*1b10e191SStéphane Rochoy sc->vendor == SUPERIO_VENDOR_FINTEK, 561*1b10e191SStéphane Rochoy ("Only ITE, Nuvoton and Fintek SuperIO-s are supported")); 562e3722b78SAndriy Gapon sc->ldn_reg = 0x07; 563e3722b78SAndriy Gapon sc->enable_reg = 0x30; 564e3722b78SAndriy Gapon sc->current_ldn = 0xff; /* no device should have this */ 565e3722b78SAndriy Gapon 566e3722b78SAndriy Gapon if (superio_table[i].descr != NULL) { 567e3722b78SAndriy Gapon device_set_desc(dev, superio_table[i].descr); 568e3722b78SAndriy Gapon } else if (sc->vendor == SUPERIO_VENDOR_ITE) { 569e3722b78SAndriy Gapon char descr[64]; 570e3722b78SAndriy Gapon 571e3722b78SAndriy Gapon snprintf(descr, sizeof(descr), 572e3722b78SAndriy Gapon "ITE IT%4x SuperIO (revision 0x%02x)", 573e3722b78SAndriy Gapon sc->devid, sc->revid); 574e3722b78SAndriy Gapon device_set_desc_copy(dev, descr); 575e3722b78SAndriy Gapon } 576e3722b78SAndriy Gapon return (0); 577e3722b78SAndriy Gapon } 578e3722b78SAndriy Gapon 579e3722b78SAndriy Gapon static void 580e3722b78SAndriy Gapon superio_identify(driver_t *driver, device_t parent) 581e3722b78SAndriy Gapon { 582e3722b78SAndriy Gapon device_t child; 583e3722b78SAndriy Gapon int i; 584e3722b78SAndriy Gapon 585e3722b78SAndriy Gapon /* 586e3722b78SAndriy Gapon * Don't create child devices if any already exist. 587e3722b78SAndriy Gapon * Those could be created via isa hints or if this 588e3722b78SAndriy Gapon * driver is loaded, unloaded and then loaded again. 589e3722b78SAndriy Gapon */ 590e3722b78SAndriy Gapon if (device_find_child(parent, "superio", -1)) { 591e3722b78SAndriy Gapon if (bootverbose) 592e3722b78SAndriy Gapon printf("superio: device(s) already created\n"); 593e3722b78SAndriy Gapon return; 594e3722b78SAndriy Gapon } 595e3722b78SAndriy Gapon 596e3722b78SAndriy Gapon /* 597e3722b78SAndriy Gapon * Create a child for each candidate port. 598e3722b78SAndriy Gapon * It would be nice if we could somehow clean up those 599e3722b78SAndriy Gapon * that this driver fails to probe. 600e3722b78SAndriy Gapon */ 601e3722b78SAndriy Gapon for (i = 0; ports_table[i] != 0; i++) { 602e3722b78SAndriy Gapon child = BUS_ADD_CHILD(parent, ISA_ORDER_SPECULATIVE, 603e3722b78SAndriy Gapon "superio", -1); 604e3722b78SAndriy Gapon if (child == NULL) { 605e3722b78SAndriy Gapon device_printf(parent, "failed to add superio child\n"); 606e3722b78SAndriy Gapon continue; 607e3722b78SAndriy Gapon } 608e3722b78SAndriy Gapon bus_set_resource(child, SYS_RES_IOPORT, 0, ports_table[i], 2); 609e3722b78SAndriy Gapon if (superio_detect(child, false, NULL) != 0) 610e3722b78SAndriy Gapon device_delete_child(parent, child); 611e3722b78SAndriy Gapon } 612e3722b78SAndriy Gapon } 613e3722b78SAndriy Gapon 614e3722b78SAndriy Gapon static int 615e3722b78SAndriy Gapon superio_probe(device_t dev) 616e3722b78SAndriy Gapon { 617e3722b78SAndriy Gapon struct siosc *sc; 618e3722b78SAndriy Gapon int error; 619e3722b78SAndriy Gapon 620e3722b78SAndriy Gapon /* Make sure we do not claim some ISA PNP device. */ 621e3722b78SAndriy Gapon if (isa_get_logicalid(dev) != 0) 622e3722b78SAndriy Gapon return (ENXIO); 623e3722b78SAndriy Gapon 624e3722b78SAndriy Gapon /* 625e3722b78SAndriy Gapon * XXX We can populate the softc now only because we return 626e3722b78SAndriy Gapon * BUS_PROBE_SPECIFIC 627e3722b78SAndriy Gapon */ 628e3722b78SAndriy Gapon sc = device_get_softc(dev); 629e3722b78SAndriy Gapon error = superio_detect(dev, true, sc); 630e3722b78SAndriy Gapon if (error != 0) 631e3722b78SAndriy Gapon return (error); 632e3722b78SAndriy Gapon return (BUS_PROBE_SPECIFIC); 633e3722b78SAndriy Gapon } 634e3722b78SAndriy Gapon 635e3722b78SAndriy Gapon static void 636e3722b78SAndriy Gapon superio_add_known_child(device_t dev, superio_dev_type_t type, uint8_t ldn) 637e3722b78SAndriy Gapon { 638e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(dev); 639e3722b78SAndriy Gapon struct superio_devinfo *dinfo; 640e3722b78SAndriy Gapon device_t child; 641e3722b78SAndriy Gapon 642e3722b78SAndriy Gapon child = BUS_ADD_CHILD(dev, 0, NULL, -1); 643e3722b78SAndriy Gapon if (child == NULL) { 644e3722b78SAndriy Gapon device_printf(dev, "failed to add child for ldn %d, type %s\n", 645e3722b78SAndriy Gapon ldn, devtype_to_str(type)); 646e3722b78SAndriy Gapon return; 647e3722b78SAndriy Gapon } 648e3722b78SAndriy Gapon dinfo = device_get_ivars(child); 649e3722b78SAndriy Gapon dinfo->ldn = ldn; 650e3722b78SAndriy Gapon dinfo->type = type; 651e3722b78SAndriy Gapon sio_conf_enter(sc); 652e3722b78SAndriy Gapon dinfo->iobase = sio_ldn_readw(sc, ldn, 0x60); 653e3722b78SAndriy Gapon dinfo->iobase2 = sio_ldn_readw(sc, ldn, 0x62); 654e3722b78SAndriy Gapon dinfo->irq = sio_ldn_readw(sc, ldn, 0x70); 655e3722b78SAndriy Gapon dinfo->dma = sio_ldn_readw(sc, ldn, 0x74); 656e3722b78SAndriy Gapon sio_conf_exit(sc); 657e3722b78SAndriy Gapon STAILQ_INSERT_TAIL(&sc->devlist, dinfo, link); 658e3722b78SAndriy Gapon } 659e3722b78SAndriy Gapon 660e3722b78SAndriy Gapon static int 661e3722b78SAndriy Gapon superio_attach(device_t dev) 662e3722b78SAndriy Gapon { 663e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(dev); 664e3722b78SAndriy Gapon int i; 665e3722b78SAndriy Gapon 666e3722b78SAndriy Gapon mtx_init(&sc->conf_lock, device_get_nameunit(dev), "superio", MTX_DEF); 667e3722b78SAndriy Gapon STAILQ_INIT(&sc->devlist); 668e3722b78SAndriy Gapon 669e3722b78SAndriy Gapon for (i = 0; sc->known_devices[i].type != SUPERIO_DEV_NONE; i++) { 670e3722b78SAndriy Gapon superio_add_known_child(dev, sc->known_devices[i].type, 671e3722b78SAndriy Gapon sc->known_devices[i].ldn); 672e3722b78SAndriy Gapon } 673e3722b78SAndriy Gapon 674e3722b78SAndriy Gapon bus_generic_probe(dev); 675e3722b78SAndriy Gapon bus_generic_attach(dev); 6760aee3bdcSAndriy Gapon 6770aee3bdcSAndriy Gapon sc->chardev = make_dev(&superio_cdevsw, device_get_unit(dev), 6780aee3bdcSAndriy Gapon UID_ROOT, GID_WHEEL, 0600, "superio%d", device_get_unit(dev)); 6790aee3bdcSAndriy Gapon if (sc->chardev == NULL) 6800aee3bdcSAndriy Gapon device_printf(dev, "failed to create character device\n"); 681174bd5b0SAndriy Gapon else 6820aee3bdcSAndriy Gapon sc->chardev->si_drv1 = sc; 683e3722b78SAndriy Gapon return (0); 684e3722b78SAndriy Gapon } 685e3722b78SAndriy Gapon 686e3722b78SAndriy Gapon static int 687e3722b78SAndriy Gapon superio_detach(device_t dev) 688e3722b78SAndriy Gapon { 689e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(dev); 690e3722b78SAndriy Gapon int error; 691e3722b78SAndriy Gapon 692e3722b78SAndriy Gapon error = bus_generic_detach(dev); 693e3722b78SAndriy Gapon if (error != 0) 694e3722b78SAndriy Gapon return (error); 6950aee3bdcSAndriy Gapon if (sc->chardev != NULL) 6960aee3bdcSAndriy Gapon destroy_dev(sc->chardev); 697e3722b78SAndriy Gapon device_delete_children(dev); 698e3722b78SAndriy Gapon bus_release_resource(dev, SYS_RES_IOPORT, sc->io_rid, sc->io_res); 699e3722b78SAndriy Gapon mtx_destroy(&sc->conf_lock); 700e3722b78SAndriy Gapon return (0); 701e3722b78SAndriy Gapon } 702e3722b78SAndriy Gapon 703e3722b78SAndriy Gapon static device_t 704e3722b78SAndriy Gapon superio_add_child(device_t dev, u_int order, const char *name, int unit) 705e3722b78SAndriy Gapon { 706e3722b78SAndriy Gapon struct superio_devinfo *dinfo; 707e3722b78SAndriy Gapon device_t child; 708e3722b78SAndriy Gapon 709e3722b78SAndriy Gapon child = device_add_child_ordered(dev, order, name, unit); 710e3722b78SAndriy Gapon if (child == NULL) 711e3722b78SAndriy Gapon return (NULL); 712e3722b78SAndriy Gapon dinfo = malloc(sizeof(*dinfo), M_DEVBUF, M_NOWAIT | M_ZERO); 713e3722b78SAndriy Gapon if (dinfo == NULL) { 714e3722b78SAndriy Gapon device_delete_child(dev, child); 715e3722b78SAndriy Gapon return (NULL); 716e3722b78SAndriy Gapon } 717e3722b78SAndriy Gapon dinfo->ldn = 0xff; 718e3722b78SAndriy Gapon dinfo->type = SUPERIO_DEV_NONE; 719e3722b78SAndriy Gapon dinfo->dev = child; 720e3722b78SAndriy Gapon resource_list_init(&dinfo->resources); 721e3722b78SAndriy Gapon device_set_ivars(child, dinfo); 722e3722b78SAndriy Gapon return (child); 723e3722b78SAndriy Gapon } 724e3722b78SAndriy Gapon 725e3722b78SAndriy Gapon static int 726e3722b78SAndriy Gapon superio_read_ivar(device_t dev, device_t child, int which, uintptr_t *result) 727e3722b78SAndriy Gapon { 728e3722b78SAndriy Gapon struct superio_devinfo *dinfo; 729e3722b78SAndriy Gapon 730e3722b78SAndriy Gapon dinfo = device_get_ivars(child); 731e3722b78SAndriy Gapon switch (which) { 732e3722b78SAndriy Gapon case SUPERIO_IVAR_LDN: 733e3722b78SAndriy Gapon *result = dinfo->ldn; 734e3722b78SAndriy Gapon break; 735e3722b78SAndriy Gapon case SUPERIO_IVAR_TYPE: 736e3722b78SAndriy Gapon *result = dinfo->type; 737e3722b78SAndriy Gapon break; 738e3722b78SAndriy Gapon case SUPERIO_IVAR_IOBASE: 739e3722b78SAndriy Gapon *result = dinfo->iobase; 740e3722b78SAndriy Gapon break; 741e3722b78SAndriy Gapon case SUPERIO_IVAR_IOBASE2: 742e3722b78SAndriy Gapon *result = dinfo->iobase2; 743e3722b78SAndriy Gapon break; 744e3722b78SAndriy Gapon case SUPERIO_IVAR_IRQ: 745e3722b78SAndriy Gapon *result = dinfo->irq; 746e3722b78SAndriy Gapon break; 747e3722b78SAndriy Gapon case SUPERIO_IVAR_DMA: 748e3722b78SAndriy Gapon *result = dinfo->dma; 749e3722b78SAndriy Gapon break; 750e3722b78SAndriy Gapon default: 751e3722b78SAndriy Gapon return (ENOENT); 752e3722b78SAndriy Gapon } 753e3722b78SAndriy Gapon return (0); 754e3722b78SAndriy Gapon } 755e3722b78SAndriy Gapon 756e3722b78SAndriy Gapon static int 757e3722b78SAndriy Gapon superio_write_ivar(device_t dev, device_t child, int which, uintptr_t value) 758e3722b78SAndriy Gapon { 759e3722b78SAndriy Gapon 760e3722b78SAndriy Gapon switch (which) { 761e3722b78SAndriy Gapon case SUPERIO_IVAR_LDN: 762e3722b78SAndriy Gapon case SUPERIO_IVAR_TYPE: 763e3722b78SAndriy Gapon case SUPERIO_IVAR_IOBASE: 764e3722b78SAndriy Gapon case SUPERIO_IVAR_IOBASE2: 765e3722b78SAndriy Gapon case SUPERIO_IVAR_IRQ: 766e3722b78SAndriy Gapon case SUPERIO_IVAR_DMA: 767e3722b78SAndriy Gapon return (EINVAL); 768e3722b78SAndriy Gapon default: 769e3722b78SAndriy Gapon return (ENOENT); 770e3722b78SAndriy Gapon } 771e3722b78SAndriy Gapon } 772e3722b78SAndriy Gapon 773e3722b78SAndriy Gapon static struct resource_list * 774e3722b78SAndriy Gapon superio_get_resource_list(device_t dev, device_t child) 775e3722b78SAndriy Gapon { 776e3722b78SAndriy Gapon struct superio_devinfo *dinfo = device_get_ivars(child); 777e3722b78SAndriy Gapon 778e3722b78SAndriy Gapon return (&dinfo->resources); 779e3722b78SAndriy Gapon } 780e3722b78SAndriy Gapon 781e3722b78SAndriy Gapon static int 782e3722b78SAndriy Gapon superio_printf(struct superio_devinfo *dinfo, const char *fmt, ...) 783e3722b78SAndriy Gapon { 784e3722b78SAndriy Gapon va_list ap; 785e3722b78SAndriy Gapon int retval; 786e3722b78SAndriy Gapon 787e3722b78SAndriy Gapon retval = printf("superio:%s@ldn%0x2x: ", 788e3722b78SAndriy Gapon devtype_to_str(dinfo->type), dinfo->ldn); 789e3722b78SAndriy Gapon va_start(ap, fmt); 790e3722b78SAndriy Gapon retval += vprintf(fmt, ap); 791e3722b78SAndriy Gapon va_end(ap); 792e3722b78SAndriy Gapon return (retval); 793e3722b78SAndriy Gapon } 794e3722b78SAndriy Gapon 795e3722b78SAndriy Gapon static void 796e3722b78SAndriy Gapon superio_child_detached(device_t dev, device_t child) 797e3722b78SAndriy Gapon { 798e3722b78SAndriy Gapon struct superio_devinfo *dinfo; 799e3722b78SAndriy Gapon struct resource_list *rl; 800e3722b78SAndriy Gapon 801e3722b78SAndriy Gapon dinfo = device_get_ivars(child); 802e3722b78SAndriy Gapon rl = &dinfo->resources; 803e3722b78SAndriy Gapon 804e3722b78SAndriy Gapon if (resource_list_release_active(rl, dev, child, SYS_RES_IRQ) != 0) 805e3722b78SAndriy Gapon superio_printf(dinfo, "Device leaked IRQ resources\n"); 806e3722b78SAndriy Gapon if (resource_list_release_active(rl, dev, child, SYS_RES_MEMORY) != 0) 807e3722b78SAndriy Gapon superio_printf(dinfo, "Device leaked memory resources\n"); 808e3722b78SAndriy Gapon if (resource_list_release_active(rl, dev, child, SYS_RES_IOPORT) != 0) 809e3722b78SAndriy Gapon superio_printf(dinfo, "Device leaked I/O resources\n"); 810e3722b78SAndriy Gapon } 811e3722b78SAndriy Gapon 812e3722b78SAndriy Gapon static int 813ddfc9c4cSWarner Losh superio_child_location(device_t parent, device_t child, struct sbuf *sb) 814e3722b78SAndriy Gapon { 815e3722b78SAndriy Gapon uint8_t ldn; 816e3722b78SAndriy Gapon 817e3722b78SAndriy Gapon ldn = superio_get_ldn(child); 818ddfc9c4cSWarner Losh sbuf_printf(sb, "ldn=0x%02x", ldn); 819e3722b78SAndriy Gapon return (0); 820e3722b78SAndriy Gapon } 821e3722b78SAndriy Gapon 822e3722b78SAndriy Gapon static int 823ddfc9c4cSWarner Losh superio_child_pnp(device_t parent, device_t child, struct sbuf *sb) 824e3722b78SAndriy Gapon { 825e3722b78SAndriy Gapon superio_dev_type_t type; 826e3722b78SAndriy Gapon 827e3722b78SAndriy Gapon type = superio_get_type(child); 828ddfc9c4cSWarner Losh sbuf_printf(sb, "type=%s", devtype_to_str(type)); 829e3722b78SAndriy Gapon return (0); 830e3722b78SAndriy Gapon } 831e3722b78SAndriy Gapon 832e3722b78SAndriy Gapon static int 833e3722b78SAndriy Gapon superio_print_child(device_t parent, device_t child) 834e3722b78SAndriy Gapon { 835e3722b78SAndriy Gapon superio_dev_type_t type; 836e3722b78SAndriy Gapon uint8_t ldn; 837e3722b78SAndriy Gapon int retval; 838e3722b78SAndriy Gapon 839e3722b78SAndriy Gapon ldn = superio_get_ldn(child); 840e3722b78SAndriy Gapon type = superio_get_type(child); 841e3722b78SAndriy Gapon 842e3722b78SAndriy Gapon retval = bus_print_child_header(parent, child); 843e3722b78SAndriy Gapon retval += printf(" at %s ldn 0x%02x", devtype_to_str(type), ldn); 844e3722b78SAndriy Gapon retval += bus_print_child_footer(parent, child); 845e3722b78SAndriy Gapon 846e3722b78SAndriy Gapon return (retval); 847e3722b78SAndriy Gapon } 848e3722b78SAndriy Gapon 849e3722b78SAndriy Gapon superio_vendor_t 850e3722b78SAndriy Gapon superio_vendor(device_t dev) 851e3722b78SAndriy Gapon { 852e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 853e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 854e3722b78SAndriy Gapon 855e3722b78SAndriy Gapon return (sc->vendor); 856e3722b78SAndriy Gapon } 857e3722b78SAndriy Gapon 858e3722b78SAndriy Gapon uint16_t 859e3722b78SAndriy Gapon superio_devid(device_t dev) 860e3722b78SAndriy Gapon { 861e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 862e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 863e3722b78SAndriy Gapon 864e3722b78SAndriy Gapon return (sc->devid); 865e3722b78SAndriy Gapon } 866e3722b78SAndriy Gapon 867e3722b78SAndriy Gapon uint8_t 868e3722b78SAndriy Gapon superio_revid(device_t dev) 869e3722b78SAndriy Gapon { 870e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 871e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 872e3722b78SAndriy Gapon 873e3722b78SAndriy Gapon return (sc->revid); 874e3722b78SAndriy Gapon } 875e3722b78SAndriy Gapon 876e3722b78SAndriy Gapon uint8_t 877e3722b78SAndriy Gapon superio_read(device_t dev, uint8_t reg) 878e3722b78SAndriy Gapon { 879e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 880e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 881e3722b78SAndriy Gapon struct superio_devinfo *dinfo = device_get_ivars(dev); 882e3722b78SAndriy Gapon uint8_t v; 883e3722b78SAndriy Gapon 884e3722b78SAndriy Gapon sio_conf_enter(sc); 885e3722b78SAndriy Gapon v = sio_ldn_read(sc, dinfo->ldn, reg); 886e3722b78SAndriy Gapon sio_conf_exit(sc); 887e3722b78SAndriy Gapon return (v); 888e3722b78SAndriy Gapon } 889e3722b78SAndriy Gapon 890e3722b78SAndriy Gapon void 891e3722b78SAndriy Gapon superio_write(device_t dev, uint8_t reg, uint8_t val) 892e3722b78SAndriy Gapon { 893e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 894e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 895e3722b78SAndriy Gapon struct superio_devinfo *dinfo = device_get_ivars(dev); 896e3722b78SAndriy Gapon 897e3722b78SAndriy Gapon sio_conf_enter(sc); 898e3722b78SAndriy Gapon sio_ldn_write(sc, dinfo->ldn, reg, val); 899e3722b78SAndriy Gapon sio_conf_exit(sc); 900e3722b78SAndriy Gapon } 901e3722b78SAndriy Gapon 902e3722b78SAndriy Gapon bool 903e3722b78SAndriy Gapon superio_dev_enabled(device_t dev, uint8_t mask) 904e3722b78SAndriy Gapon { 905e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 906e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 907e3722b78SAndriy Gapon struct superio_devinfo *dinfo = device_get_ivars(dev); 908e3722b78SAndriy Gapon uint8_t v; 909e3722b78SAndriy Gapon 910e3722b78SAndriy Gapon /* GPIO device is always active in ITE chips. */ 911e3722b78SAndriy Gapon if (sc->vendor == SUPERIO_VENDOR_ITE && dinfo->ldn == 7) 912e3722b78SAndriy Gapon return (true); 913e3722b78SAndriy Gapon 914e3722b78SAndriy Gapon v = superio_read(dev, sc->enable_reg); 915e3722b78SAndriy Gapon return ((v & mask) != 0); 916e3722b78SAndriy Gapon } 917e3722b78SAndriy Gapon 918e3722b78SAndriy Gapon void 919e3722b78SAndriy Gapon superio_dev_enable(device_t dev, uint8_t mask) 920e3722b78SAndriy Gapon { 921e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 922e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 923e3722b78SAndriy Gapon struct superio_devinfo *dinfo = device_get_ivars(dev); 924e3722b78SAndriy Gapon uint8_t v; 925e3722b78SAndriy Gapon 926e3722b78SAndriy Gapon /* GPIO device is always active in ITE chips. */ 927e3722b78SAndriy Gapon if (sc->vendor == SUPERIO_VENDOR_ITE && dinfo->ldn == 7) 928e3722b78SAndriy Gapon return; 929e3722b78SAndriy Gapon 930e3722b78SAndriy Gapon sio_conf_enter(sc); 931e3722b78SAndriy Gapon v = sio_ldn_read(sc, dinfo->ldn, sc->enable_reg); 932e3722b78SAndriy Gapon v |= mask; 933e3722b78SAndriy Gapon sio_ldn_write(sc, dinfo->ldn, sc->enable_reg, v); 934e3722b78SAndriy Gapon sio_conf_exit(sc); 935e3722b78SAndriy Gapon } 936e3722b78SAndriy Gapon 937e3722b78SAndriy Gapon void 938e3722b78SAndriy Gapon superio_dev_disable(device_t dev, uint8_t mask) 939e3722b78SAndriy Gapon { 940e3722b78SAndriy Gapon device_t sio_dev = device_get_parent(dev); 941e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(sio_dev); 942e3722b78SAndriy Gapon struct superio_devinfo *dinfo = device_get_ivars(dev); 943e3722b78SAndriy Gapon uint8_t v; 944e3722b78SAndriy Gapon 945e3722b78SAndriy Gapon /* GPIO device is always active in ITE chips. */ 946e3722b78SAndriy Gapon if (sc->vendor == SUPERIO_VENDOR_ITE && dinfo->ldn == 7) 947e3722b78SAndriy Gapon return; 948e3722b78SAndriy Gapon 949e3722b78SAndriy Gapon sio_conf_enter(sc); 950e3722b78SAndriy Gapon v = sio_ldn_read(sc, dinfo->ldn, sc->enable_reg); 951e3722b78SAndriy Gapon v &= ~mask; 952e3722b78SAndriy Gapon sio_ldn_write(sc, dinfo->ldn, sc->enable_reg, v); 953e3722b78SAndriy Gapon sio_conf_exit(sc); 954e3722b78SAndriy Gapon } 955e3722b78SAndriy Gapon 956e3722b78SAndriy Gapon device_t 957e3722b78SAndriy Gapon superio_find_dev(device_t superio, superio_dev_type_t type, int ldn) 958e3722b78SAndriy Gapon { 959e3722b78SAndriy Gapon struct siosc *sc = device_get_softc(superio); 960e3722b78SAndriy Gapon struct superio_devinfo *dinfo; 961e3722b78SAndriy Gapon 962e3722b78SAndriy Gapon if (ldn < -1 || ldn > UINT8_MAX) 963e3722b78SAndriy Gapon return (NULL); /* ERANGE */ 964e3722b78SAndriy Gapon if (type == SUPERIO_DEV_NONE && ldn == -1) 965e3722b78SAndriy Gapon return (NULL); /* EINVAL */ 966e3722b78SAndriy Gapon 967e3722b78SAndriy Gapon STAILQ_FOREACH(dinfo, &sc->devlist, link) { 968e3722b78SAndriy Gapon if (ldn != -1 && dinfo->ldn != ldn) 969e3722b78SAndriy Gapon continue; 970e3722b78SAndriy Gapon if (type != SUPERIO_DEV_NONE && dinfo->type != type) 971e3722b78SAndriy Gapon continue; 972e3722b78SAndriy Gapon return (dinfo->dev); 973e3722b78SAndriy Gapon } 974e3722b78SAndriy Gapon return (NULL); 975e3722b78SAndriy Gapon } 976e3722b78SAndriy Gapon 9770aee3bdcSAndriy Gapon static int 9780aee3bdcSAndriy Gapon superio_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int flags, 9790aee3bdcSAndriy Gapon struct thread *td) 9800aee3bdcSAndriy Gapon { 9810aee3bdcSAndriy Gapon struct siosc *sc; 9820aee3bdcSAndriy Gapon struct superiocmd *s; 9830aee3bdcSAndriy Gapon 9840aee3bdcSAndriy Gapon sc = dev->si_drv1; 9850aee3bdcSAndriy Gapon s = (struct superiocmd *)data; 9860aee3bdcSAndriy Gapon switch (cmd) { 9870aee3bdcSAndriy Gapon case SUPERIO_CR_READ: 9880aee3bdcSAndriy Gapon sio_conf_enter(sc); 9890aee3bdcSAndriy Gapon s->val = sio_ldn_read(sc, s->ldn, s->cr); 9900aee3bdcSAndriy Gapon sio_conf_exit(sc); 9910aee3bdcSAndriy Gapon return (0); 9920aee3bdcSAndriy Gapon case SUPERIO_CR_WRITE: 9930aee3bdcSAndriy Gapon sio_conf_enter(sc); 9940aee3bdcSAndriy Gapon sio_ldn_write(sc, s->ldn, s->cr, s->val); 9950aee3bdcSAndriy Gapon sio_conf_exit(sc); 9960aee3bdcSAndriy Gapon return (0); 9970aee3bdcSAndriy Gapon default: 9980aee3bdcSAndriy Gapon return (ENOTTY); 9990aee3bdcSAndriy Gapon } 10000aee3bdcSAndriy Gapon } 10010aee3bdcSAndriy Gapon 1002e3722b78SAndriy Gapon static device_method_t superio_methods[] = { 1003e3722b78SAndriy Gapon DEVMETHOD(device_identify, superio_identify), 1004e3722b78SAndriy Gapon DEVMETHOD(device_probe, superio_probe), 1005e3722b78SAndriy Gapon DEVMETHOD(device_attach, superio_attach), 1006e3722b78SAndriy Gapon DEVMETHOD(device_detach, superio_detach), 1007e3722b78SAndriy Gapon DEVMETHOD(device_shutdown, bus_generic_shutdown), 1008e3722b78SAndriy Gapon DEVMETHOD(device_suspend, bus_generic_suspend), 1009e3722b78SAndriy Gapon DEVMETHOD(device_resume, bus_generic_resume), 1010e3722b78SAndriy Gapon 1011e3722b78SAndriy Gapon DEVMETHOD(bus_add_child, superio_add_child), 1012e3722b78SAndriy Gapon DEVMETHOD(bus_child_detached, superio_child_detached), 1013ddfc9c4cSWarner Losh DEVMETHOD(bus_child_location, superio_child_location), 1014ddfc9c4cSWarner Losh DEVMETHOD(bus_child_pnpinfo, superio_child_pnp), 1015e3722b78SAndriy Gapon DEVMETHOD(bus_print_child, superio_print_child), 1016e3722b78SAndriy Gapon DEVMETHOD(bus_read_ivar, superio_read_ivar), 1017e3722b78SAndriy Gapon DEVMETHOD(bus_write_ivar, superio_write_ivar), 1018e3722b78SAndriy Gapon DEVMETHOD(bus_get_resource_list, superio_get_resource_list), 1019e3722b78SAndriy Gapon DEVMETHOD(bus_alloc_resource, bus_generic_rl_alloc_resource), 1020e3722b78SAndriy Gapon DEVMETHOD(bus_release_resource, bus_generic_rl_release_resource), 1021e3722b78SAndriy Gapon DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource), 1022e3722b78SAndriy Gapon DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 1023e3722b78SAndriy Gapon DEVMETHOD(bus_delete_resource, bus_generic_rl_delete_resource), 1024e3722b78SAndriy Gapon DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 1025e3722b78SAndriy Gapon DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 1026e3722b78SAndriy Gapon DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 1027e3722b78SAndriy Gapon DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 1028e3722b78SAndriy Gapon 1029e3722b78SAndriy Gapon DEVMETHOD_END 1030e3722b78SAndriy Gapon }; 1031e3722b78SAndriy Gapon 1032e3722b78SAndriy Gapon static driver_t superio_driver = { 1033e3722b78SAndriy Gapon "superio", 1034e3722b78SAndriy Gapon superio_methods, 1035e3722b78SAndriy Gapon sizeof(struct siosc) 1036e3722b78SAndriy Gapon }; 1037e3722b78SAndriy Gapon 1038abd890f9SJohn Baldwin DRIVER_MODULE(superio, isa, superio_driver, 0, 0); 1039e3722b78SAndriy Gapon MODULE_VERSION(superio, 1); 1040