atkbdc_subr.c revision 129880
143105Sdfr/*- 243105Sdfr * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> 343105Sdfr * All rights reserved. 443105Sdfr * 543105Sdfr * Redistribution and use in source and binary forms, with or without 643105Sdfr * modification, are permitted provided that the following conditions 743105Sdfr * are met: 843105Sdfr * 1. Redistributions of source code must retain the above copyright 943105Sdfr * notice, this list of conditions and the following disclaimer as 1043105Sdfr * the first lines of this file unmodified. 1143105Sdfr * 2. Redistributions in binary form must reproduce the above copyright 1243105Sdfr * notice, this list of conditions and the following disclaimer in the 1343105Sdfr * documentation and/or other materials provided with the distribution. 1443105Sdfr * 1543105Sdfr * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 1643105Sdfr * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 1743105Sdfr * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 1843105Sdfr * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 1943105Sdfr * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 2043105Sdfr * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 2143105Sdfr * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 2243105Sdfr * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 2343105Sdfr * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 2443105Sdfr * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2543105Sdfr */ 2643105Sdfr 27116181Sobrien#include <sys/cdefs.h> 28116181Sobrien__FBSDID("$FreeBSD: head/sys/dev/atkbdc/atkbdc_subr.c 129880 2004-05-30 20:27:19Z phk $"); 29116181Sobrien 3043105Sdfr#include "opt_kbd.h" 3143105Sdfr 3243105Sdfr#include <sys/param.h> 3343105Sdfr#include <sys/systm.h> 3443105Sdfr#include <sys/kernel.h> 35129880Sphk#include <sys/module.h> 3643105Sdfr#include <sys/bus.h> 3743105Sdfr#include <sys/malloc.h> 3858271Syokota#include <machine/bus_pio.h> 3947400Sdfr#include <machine/bus.h> 4047400Sdfr#include <machine/resource.h> 4147400Sdfr#include <sys/rman.h> 4243105Sdfr 4343105Sdfr#include <dev/kbd/atkbdcreg.h> 4443105Sdfr 4543105Sdfr#include <isa/isareg.h> 4643105Sdfr#include <isa/isavar.h> 4743105Sdfr 4869774Sphkstatic MALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device"); 4943105Sdfr 5043105Sdfr/* children */ 5143105Sdfrtypedef struct atkbdc_device { 5283147Syokota struct resource_list resources; 5383147Syokota int rid; 5458272Syokota u_int32_t vendorid; 5558272Syokota u_int32_t serial; 5658272Syokota u_int32_t logicalid; 5758272Syokota u_int32_t compatid; 5843105Sdfr} atkbdc_device_t; 5943105Sdfr 6043105Sdfr/* kbdc */ 61114293Smarkmstatic devclass_t atkbdc_devclass; 6243105Sdfr 6343105Sdfrstatic int atkbdc_probe(device_t dev); 6443105Sdfrstatic int atkbdc_attach(device_t dev); 6583147Syokotastatic device_t atkbdc_add_child(device_t bus, int order, char *name, 6683147Syokota int unit); 6749195Smdoddstatic int atkbdc_print_child(device_t bus, device_t dev); 6843105Sdfrstatic int atkbdc_read_ivar(device_t bus, device_t dev, int index, 6959783Sbde uintptr_t *val); 7043105Sdfrstatic int atkbdc_write_ivar(device_t bus, device_t dev, int index, 7159783Sbde uintptr_t val); 7283147Syokotastatic struct resource_list 7383147Syokota *atkbdc_get_resource_list (device_t bus, device_t dev); 7483147Syokotastatic struct resource 7583147Syokota *atkbdc_alloc_resource(device_t bus, device_t dev, int type, 7683147Syokota int *rid, u_long start, u_long end, 7783147Syokota u_long count, u_int flags); 7883147Syokotastatic int atkbdc_release_resource(device_t bus, device_t dev, int type, 7983147Syokota int rid, struct resource *res); 8043105Sdfr 8143105Sdfrstatic device_method_t atkbdc_methods[] = { 8243105Sdfr DEVMETHOD(device_probe, atkbdc_probe), 8343105Sdfr DEVMETHOD(device_attach, atkbdc_attach), 8447296Syokota DEVMETHOD(device_suspend, bus_generic_suspend), 8547296Syokota DEVMETHOD(device_resume, bus_generic_resume), 8643105Sdfr 8783147Syokota DEVMETHOD(bus_add_child, atkbdc_add_child), 8843105Sdfr DEVMETHOD(bus_print_child, atkbdc_print_child), 8943105Sdfr DEVMETHOD(bus_read_ivar, atkbdc_read_ivar), 9043105Sdfr DEVMETHOD(bus_write_ivar, atkbdc_write_ivar), 9183147Syokota DEVMETHOD(bus_get_resource_list,atkbdc_get_resource_list), 9283147Syokota DEVMETHOD(bus_alloc_resource, atkbdc_alloc_resource), 9383147Syokota DEVMETHOD(bus_release_resource, atkbdc_release_resource), 9443105Sdfr DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 9543105Sdfr DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 9683147Syokota DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 9783147Syokota DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource), 9883147Syokota DEVMETHOD(bus_delete_resource, bus_generic_rl_delete_resource), 9943105Sdfr DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 10043105Sdfr DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 10143105Sdfr 10243105Sdfr { 0, 0 } 10343105Sdfr}; 10443105Sdfr 10543105Sdfrstatic driver_t atkbdc_driver = { 10643105Sdfr ATKBDC_DRIVER_NAME, 10743105Sdfr atkbdc_methods, 10843105Sdfr sizeof(atkbdc_softc_t *), 10943105Sdfr}; 11043105Sdfr 11158271Syokotastatic struct isa_pnp_id atkbdc_ids[] = { 11258271Syokota { 0x0303d041, "Keyboard controller (i8042)" }, /* PNP0303 */ 11358271Syokota { 0 } 11458271Syokota}; 11558271Syokota 11643105Sdfrstatic int 11743105Sdfratkbdc_probe(device_t dev) 11843105Sdfr{ 11958271Syokota struct resource *port0; 12058271Syokota struct resource *port1; 12183147Syokota u_long start; 12283147Syokota u_long count; 12358271Syokota int error; 12458271Syokota int rid; 12543105Sdfr 12658271Syokota /* check PnP IDs */ 12758271Syokota if (ISA_PNP_PROBE(device_get_parent(dev), dev, atkbdc_ids) == ENXIO) 12858271Syokota return ENXIO; 12947618Sdfr 13058271Syokota device_set_desc(dev, "Keyboard controller (i8042)"); 13158271Syokota 13283147Syokota /* 13383147Syokota * Adjust I/O port resources. 13483147Syokota * The AT keyboard controller uses two ports (a command/data port 13583147Syokota * 0x60 and a status port 0x64), which may be given to us in 13683147Syokota * one resource (0x60 through 0x64) or as two separate resources 13783147Syokota * (0x60 and 0x64). Furthermore, /boot/device.hints may contain 13883147Syokota * just one port, 0x60. We shall adjust resource settings 13983147Syokota * so that these two ports are available as two separate resources. 14083147Syokota */ 14183147Syokota device_quiet(dev); 14247400Sdfr rid = 0; 14383147Syokota if (bus_get_resource(dev, SYS_RES_IOPORT, rid, &start, &count) != 0) 14483147Syokota return ENXIO; 14583147Syokota if (count > 1) /* adjust the count */ 14683147Syokota bus_set_resource(dev, SYS_RES_IOPORT, rid, start, 1); 147127135Snjl port0 = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 14858271Syokota if (port0 == NULL) 14947400Sdfr return ENXIO; 15083147Syokota rid = 1; 15183147Syokota if (bus_get_resource(dev, SYS_RES_IOPORT, rid, NULL, NULL) != 0) 15258271Syokota bus_set_resource(dev, SYS_RES_IOPORT, 1, 15383147Syokota start + KBD_STATUS_PORT, 1); 154127135Snjl port1 = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, RF_ACTIVE); 15558271Syokota if (port1 == NULL) { 15658271Syokota bus_release_resource(dev, SYS_RES_IOPORT, 0, port0); 15758271Syokota return ENXIO; 15858271Syokota } 15983147Syokota device_verbose(dev); 16058271Syokota 16158271Syokota error = atkbdc_probe_unit(device_get_unit(dev), port0, port1); 16283147Syokota if (error == 0) 16383147Syokota bus_generic_probe(dev); 16458271Syokota 16558271Syokota bus_release_resource(dev, SYS_RES_IOPORT, 0, port0); 16658271Syokota bus_release_resource(dev, SYS_RES_IOPORT, 1, port1); 16758271Syokota 16843105Sdfr return error; 16943105Sdfr} 17043105Sdfr 17143105Sdfrstatic int 17243105Sdfratkbdc_attach(device_t dev) 17343105Sdfr{ 17443105Sdfr atkbdc_softc_t *sc; 17583147Syokota int unit; 17647296Syokota int error; 17748341Syokota int rid; 17843105Sdfr 17947296Syokota unit = device_get_unit(dev); 18043105Sdfr sc = *(atkbdc_softc_t **)device_get_softc(dev); 18147296Syokota if (sc == NULL) { 18247296Syokota /* 18347296Syokota * We have to maintain two copies of the kbdc_softc struct, 18447296Syokota * as the low-level console needs to have access to the 18547296Syokota * keyboard controller before kbdc is probed and attached. 18647296Syokota * kbdc_soft[] contains the default entry for that purpose. 18747296Syokota * See atkbdc.c. XXX 18847296Syokota */ 18947296Syokota sc = atkbdc_get_softc(unit); 19047296Syokota if (sc == NULL) 19147296Syokota return ENOMEM; 19247296Syokota } 19343105Sdfr 19448341Syokota rid = 0; 195127135Snjl sc->port0 = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, 196127135Snjl RF_ACTIVE); 19758271Syokota if (sc->port0 == NULL) 19848341Syokota return ENXIO; 19958271Syokota rid = 1; 200127135Snjl sc->port1 = bus_alloc_resource_any(dev, SYS_RES_IOPORT, &rid, 201127135Snjl RF_ACTIVE); 20258271Syokota if (sc->port1 == NULL) { 20358271Syokota bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port0); 20458271Syokota return ENXIO; 20558271Syokota } 20658271Syokota 20758271Syokota error = atkbdc_attach_unit(unit, sc, sc->port0, sc->port1); 20858271Syokota if (error) { 20958271Syokota bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port0); 21058271Syokota bus_release_resource(dev, SYS_RES_IOPORT, 1, sc->port1); 21147296Syokota return error; 21258271Syokota } 21347296Syokota *(atkbdc_softc_t **)device_get_softc(dev) = sc; 21447296Syokota 21583147Syokota bus_generic_attach(dev); 21643105Sdfr 21783147Syokota return 0; 21883147Syokota} 21983147Syokota 22083147Syokotastatic device_t 22183147Syokotaatkbdc_add_child(device_t bus, int order, char *name, int unit) 22283147Syokota{ 22383147Syokota atkbdc_device_t *ivar; 22483147Syokota device_t child; 22583147Syokota int t; 22683147Syokota 22783147Syokota ivar = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, 22883147Syokota M_NOWAIT | M_ZERO); 22983147Syokota if (!ivar) 23083147Syokota return NULL; 23183147Syokota 23283931Syokota child = device_add_child_ordered(bus, order, name, unit); 23383147Syokota if (child == NULL) { 23483147Syokota free(ivar, M_ATKBDDEV); 23583147Syokota return child; 23683147Syokota } 23783147Syokota 23883147Syokota resource_list_init(&ivar->resources); 23983147Syokota ivar->rid = order; 24083147Syokota 24143105Sdfr /* 24283147Syokota * If the device is not created by the PnP BIOS or ACPI, 24383147Syokota * refer to device hints for IRQ. 24443105Sdfr */ 24583147Syokota if (ISA_PNP_PROBE(device_get_parent(bus), bus, atkbdc_ids) != 0) { 24683147Syokota if (resource_int_value(name, unit, "irq", &t) != 0) 24783147Syokota t = -1; 24883147Syokota } else { 24983147Syokota t = bus_get_resource_start(bus, SYS_RES_IRQ, ivar->rid); 25083147Syokota } 25183147Syokota if (t > 0) 25283147Syokota resource_list_add(&ivar->resources, SYS_RES_IRQ, ivar->rid, 25383147Syokota t, t, 1); 25443105Sdfr 25583147Syokota if (resource_int_value(name, unit, "flags", &t) == 0) 25683147Syokota device_set_flags(child, t); 257117167Sjhb if (resource_disabled(name, unit)) 25883147Syokota device_disable(child); 25943105Sdfr 26083147Syokota device_set_ivars(child, ivar); 26183147Syokota 26283147Syokota return child; 26343105Sdfr} 26443105Sdfr 26549195Smdoddstatic int 26643105Sdfratkbdc_print_child(device_t bus, device_t dev) 26743105Sdfr{ 26843105Sdfr atkbdc_device_t *kbdcdev; 26983147Syokota u_long irq; 27083147Syokota int flags; 27149195Smdodd int retval = 0; 27243105Sdfr 27343105Sdfr kbdcdev = (atkbdc_device_t *)device_get_ivars(dev); 27443105Sdfr 27549195Smdodd retval += bus_print_child_header(bus, dev); 27683147Syokota flags = device_get_flags(dev); 27783147Syokota if (flags != 0) 27883147Syokota retval += printf(" flags 0x%x", flags); 27983147Syokota irq = bus_get_resource_start(dev, SYS_RES_IRQ, kbdcdev->rid); 28083147Syokota if (irq != 0) 28183147Syokota retval += printf(" irq %ld", irq); 28249195Smdodd retval += bus_print_child_footer(bus, dev); 28343105Sdfr 28449195Smdodd return (retval); 28543105Sdfr} 28643105Sdfr 28743105Sdfrstatic int 28859783Sbdeatkbdc_read_ivar(device_t bus, device_t dev, int index, uintptr_t *val) 28943105Sdfr{ 29043105Sdfr atkbdc_device_t *ivar; 29143105Sdfr 29243105Sdfr ivar = (atkbdc_device_t *)device_get_ivars(dev); 29343105Sdfr switch (index) { 29458272Syokota case KBDC_IVAR_VENDORID: 29558272Syokota *val = (u_long)ivar->vendorid; 29658272Syokota break; 29758272Syokota case KBDC_IVAR_SERIAL: 29858272Syokota *val = (u_long)ivar->serial; 29958272Syokota break; 30058272Syokota case KBDC_IVAR_LOGICALID: 30158272Syokota *val = (u_long)ivar->logicalid; 30258272Syokota break; 30358272Syokota case KBDC_IVAR_COMPATID: 30458272Syokota *val = (u_long)ivar->compatid; 30558272Syokota break; 30643105Sdfr default: 30743105Sdfr return ENOENT; 30843105Sdfr } 30943105Sdfr return 0; 31043105Sdfr} 31143105Sdfr 31243105Sdfrstatic int 31359783Sbdeatkbdc_write_ivar(device_t bus, device_t dev, int index, uintptr_t val) 31443105Sdfr{ 31543105Sdfr atkbdc_device_t *ivar; 31643105Sdfr 31743105Sdfr ivar = (atkbdc_device_t *)device_get_ivars(dev); 31843105Sdfr switch (index) { 31958272Syokota case KBDC_IVAR_VENDORID: 32058272Syokota ivar->vendorid = (u_int32_t)val; 32158272Syokota break; 32258272Syokota case KBDC_IVAR_SERIAL: 32358272Syokota ivar->serial = (u_int32_t)val; 32458272Syokota break; 32558272Syokota case KBDC_IVAR_LOGICALID: 32658272Syokota ivar->logicalid = (u_int32_t)val; 32758272Syokota break; 32858272Syokota case KBDC_IVAR_COMPATID: 32958272Syokota ivar->compatid = (u_int32_t)val; 33058272Syokota break; 33143105Sdfr default: 33243105Sdfr return ENOENT; 33343105Sdfr } 33443105Sdfr return 0; 33543105Sdfr} 33643105Sdfr 33783147Syokotastatic struct resource_list 33883147Syokota*atkbdc_get_resource_list (device_t bus, device_t dev) 33983147Syokota{ 34083147Syokota atkbdc_device_t *ivar; 34183147Syokota 34283147Syokota ivar = (atkbdc_device_t *)device_get_ivars(dev); 34383147Syokota return &ivar->resources; 34483147Syokota} 34583147Syokota 34683147Syokotastatic struct resource 34783147Syokota*atkbdc_alloc_resource(device_t bus, device_t dev, int type, int *rid, 34883147Syokota u_long start, u_long end, u_long count, u_int flags) 34983147Syokota{ 35083147Syokota atkbdc_device_t *ivar; 35183147Syokota 35283147Syokota ivar = (atkbdc_device_t *)device_get_ivars(dev); 35383147Syokota return resource_list_alloc(&ivar->resources, bus, dev, type, rid, 35483147Syokota start, end, count, flags); 35583147Syokota} 35683147Syokota 35783147Syokotastatic int 35883147Syokotaatkbdc_release_resource(device_t bus, device_t dev, int type, int rid, 35983147Syokota struct resource *res) 36083147Syokota{ 36183147Syokota atkbdc_device_t *ivar; 36283147Syokota 36383147Syokota ivar = (atkbdc_device_t *)device_get_ivars(dev); 36483147Syokota return resource_list_release(&ivar->resources, bus, dev, type, rid, 36583147Syokota res); 36683147Syokota} 36783147Syokota 36843105SdfrDRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0); 36982555SmsmithDRIVER_MODULE(atkbdc, acpi, atkbdc_driver, atkbdc_devclass, 0, 0); 370