atkbdc_isa.c revision 54073
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 * 2650477Speter * $FreeBSD: head/sys/dev/atkbdc/atkbdc_isa.c 54073 1999-12-03 08:41:24Z mdodd $ 2743105Sdfr */ 2843105Sdfr 2943105Sdfr#include "atkbdc.h" 3043105Sdfr#include "opt_kbd.h" 3143105Sdfr 3243105Sdfr#if NATKBDC > 0 3343105Sdfr 3443105Sdfr#include <sys/param.h> 3543105Sdfr#include <sys/systm.h> 3643105Sdfr#include <sys/kernel.h> 3743105Sdfr#include <sys/bus.h> 3843105Sdfr#include <sys/malloc.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 4843105SdfrMALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device"); 4943105Sdfr 5043105Sdfr/* children */ 5143105Sdfrtypedef struct atkbdc_device { 5243105Sdfr int flags; /* configuration flags */ 5343105Sdfr int port; /* port number (same as the controller's) */ 5443105Sdfr int irq; /* ISA IRQ mask */ 5543105Sdfr} atkbdc_device_t; 5643105Sdfr 5743105Sdfr/* kbdc */ 5843105Sdfrdevclass_t atkbdc_devclass; 5943105Sdfr 6043105Sdfrstatic int atkbdc_probe(device_t dev); 6143105Sdfrstatic int atkbdc_attach(device_t dev); 6249195Smdoddstatic int atkbdc_print_child(device_t bus, device_t dev); 6343105Sdfrstatic int atkbdc_read_ivar(device_t bus, device_t dev, int index, 6443105Sdfr u_long *val); 6543105Sdfrstatic int atkbdc_write_ivar(device_t bus, device_t dev, int index, 6643105Sdfr u_long val); 6743105Sdfr 6843105Sdfrstatic device_method_t atkbdc_methods[] = { 6943105Sdfr DEVMETHOD(device_probe, atkbdc_probe), 7043105Sdfr DEVMETHOD(device_attach, atkbdc_attach), 7147296Syokota DEVMETHOD(device_suspend, bus_generic_suspend), 7247296Syokota DEVMETHOD(device_resume, bus_generic_resume), 7343105Sdfr 7443105Sdfr DEVMETHOD(bus_print_child, atkbdc_print_child), 7543105Sdfr DEVMETHOD(bus_read_ivar, atkbdc_read_ivar), 7643105Sdfr DEVMETHOD(bus_write_ivar, atkbdc_write_ivar), 7743105Sdfr DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource), 7843105Sdfr DEVMETHOD(bus_release_resource, bus_generic_release_resource), 7943105Sdfr DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 8043105Sdfr DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 8143105Sdfr DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 8243105Sdfr DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 8343105Sdfr 8443105Sdfr { 0, 0 } 8543105Sdfr}; 8643105Sdfr 8743105Sdfrstatic driver_t atkbdc_driver = { 8843105Sdfr ATKBDC_DRIVER_NAME, 8943105Sdfr atkbdc_methods, 9043105Sdfr sizeof(atkbdc_softc_t *), 9143105Sdfr}; 9243105Sdfr 9343105Sdfrstatic int 9443105Sdfratkbdc_probe(device_t dev) 9543105Sdfr{ 9643105Sdfr int error; 9747400Sdfr int rid; 9847400Sdfr struct resource *port; 9943105Sdfr 10047618Sdfr /* Check isapnp ids */ 10147618Sdfr if (isa_get_vendorid(dev)) 10247618Sdfr return (ENXIO); 10347618Sdfr 10443105Sdfr device_set_desc(dev, "keyboard controller (i8042)"); 10547400Sdfr rid = 0; 10647400Sdfr port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 10747400Sdfr 0, ~0, IO_KBDSIZE, RF_ACTIVE); 10847400Sdfr if (!port) 10947400Sdfr return ENXIO; 11047400Sdfr error = atkbdc_probe_unit(device_get_unit(dev), rman_get_start(port)); 11147400Sdfr bus_release_resource(dev, SYS_RES_IOPORT, rid, port); 11243105Sdfr return error; 11343105Sdfr} 11443105Sdfr 11543105Sdfrstatic void 11643105Sdfratkbdc_add_device(device_t dev, const char *name, int unit) 11743105Sdfr{ 11843105Sdfr atkbdc_softc_t *sc = *(atkbdc_softc_t **)device_get_softc(dev); 11943105Sdfr atkbdc_device_t *kdev; 12043105Sdfr device_t child; 12143105Sdfr int t; 12243105Sdfr 12343105Sdfr kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT); 12443105Sdfr if (!kdev) 12543105Sdfr return; 12643105Sdfr bzero(kdev, sizeof *kdev); 12743105Sdfr 12843105Sdfr kdev->port = sc->port; 12943105Sdfr 13043105Sdfr if (resource_int_value(name, unit, "irq", &t) == 0) 13143105Sdfr kdev->irq = t; 13243105Sdfr else 13343105Sdfr kdev->irq = -1; 13443105Sdfr 13543105Sdfr if (resource_int_value(name, unit, "flags", &t) == 0) 13643105Sdfr kdev->flags = t; 13743105Sdfr else 13843105Sdfr kdev->flags = 0; 13943105Sdfr 14054073Smdodd child = device_add_child(dev, name, unit); 14154073Smdodd device_set_ivars(child, kdev); 14243105Sdfr} 14343105Sdfr 14443105Sdfrstatic int 14543105Sdfratkbdc_attach(device_t dev) 14643105Sdfr{ 14743105Sdfr atkbdc_softc_t *sc; 14848341Syokota struct resource *port; 14947296Syokota int unit; 15047296Syokota int error; 15148341Syokota int rid; 15243105Sdfr int i; 15343105Sdfr 15447296Syokota unit = device_get_unit(dev); 15543105Sdfr sc = *(atkbdc_softc_t **)device_get_softc(dev); 15647296Syokota if (sc == NULL) { 15747296Syokota /* 15847296Syokota * We have to maintain two copies of the kbdc_softc struct, 15947296Syokota * as the low-level console needs to have access to the 16047296Syokota * keyboard controller before kbdc is probed and attached. 16147296Syokota * kbdc_soft[] contains the default entry for that purpose. 16247296Syokota * See atkbdc.c. XXX 16347296Syokota */ 16447296Syokota sc = atkbdc_get_softc(unit); 16547296Syokota if (sc == NULL) 16647296Syokota return ENOMEM; 16747296Syokota } 16843105Sdfr 16948341Syokota /* XXX should track resource in softc */ 17048341Syokota rid = 0; 17148341Syokota port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 17248341Syokota 0, ~0, IO_KBDSIZE, RF_ACTIVE); 17348341Syokota if (!port) 17448341Syokota return ENXIO; 17548341Syokota error = atkbdc_attach_unit(unit, sc, rman_get_start(port)); 17647296Syokota if (error) 17747296Syokota return error; 17847296Syokota *(atkbdc_softc_t **)device_get_softc(dev) = sc; 17947296Syokota 18043105Sdfr /* 18143105Sdfr * Add all devices configured to be attached to atkbdc0. 18243105Sdfr */ 18343105Sdfr for (i = resource_query_string(-1, "at", "atkbdc0"); 18443105Sdfr i != -1; 18543105Sdfr i = resource_query_string(i, "at", "atkbdc0")) { 18643105Sdfr atkbdc_add_device(dev, resource_query_name(i), 18743105Sdfr resource_query_unit(i)); 18843105Sdfr } 18943105Sdfr 19043105Sdfr /* 19143105Sdfr * and atkbdc? 19243105Sdfr */ 19343105Sdfr for (i = resource_query_string(-1, "at", "atkbdc"); 19443105Sdfr i != -1; 19543105Sdfr i = resource_query_string(i, "at", "atkbdc")) { 19643105Sdfr atkbdc_add_device(dev, resource_query_name(i), 19743105Sdfr resource_query_unit(i)); 19843105Sdfr } 19943105Sdfr 20043105Sdfr bus_generic_attach(dev); 20143105Sdfr 20243105Sdfr return 0; 20343105Sdfr} 20443105Sdfr 20549195Smdoddstatic int 20643105Sdfratkbdc_print_child(device_t bus, device_t dev) 20743105Sdfr{ 20843105Sdfr atkbdc_device_t *kbdcdev; 20949195Smdodd int retval = 0; 21043105Sdfr 21143105Sdfr kbdcdev = (atkbdc_device_t *)device_get_ivars(dev); 21243105Sdfr 21349195Smdodd retval += bus_print_child_header(bus, dev); 21443105Sdfr if (kbdcdev->flags != 0) 21549195Smdodd retval += printf(" flags 0x%x", kbdcdev->flags); 21646729Speter if (kbdcdev->irq != -1) 21749195Smdodd retval += printf(" irq %d", kbdcdev->irq); 21849195Smdodd retval += bus_print_child_footer(bus, dev); 21943105Sdfr 22049195Smdodd return (retval); 22143105Sdfr} 22243105Sdfr 22343105Sdfrstatic int 22443105Sdfratkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val) 22543105Sdfr{ 22643105Sdfr atkbdc_device_t *ivar; 22743105Sdfr 22843105Sdfr ivar = (atkbdc_device_t *)device_get_ivars(dev); 22943105Sdfr switch (index) { 23043105Sdfr case KBDC_IVAR_PORT: 23143105Sdfr *val = (u_long)ivar->port; 23243105Sdfr break; 23343105Sdfr case KBDC_IVAR_IRQ: 23443105Sdfr *val = (u_long)ivar->irq; 23543105Sdfr break; 23643105Sdfr case KBDC_IVAR_FLAGS: 23743105Sdfr *val = (u_long)ivar->flags; 23843105Sdfr break; 23943105Sdfr default: 24043105Sdfr return ENOENT; 24143105Sdfr } 24243105Sdfr return 0; 24343105Sdfr} 24443105Sdfr 24543105Sdfrstatic int 24643105Sdfratkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val) 24743105Sdfr{ 24843105Sdfr atkbdc_device_t *ivar; 24943105Sdfr 25043105Sdfr ivar = (atkbdc_device_t *)device_get_ivars(dev); 25143105Sdfr switch (index) { 25243105Sdfr case KBDC_IVAR_PORT: 25343105Sdfr ivar->port = (int)val; 25443105Sdfr break; 25543105Sdfr case KBDC_IVAR_IRQ: 25643105Sdfr ivar->irq = (int)val; 25743105Sdfr break; 25843105Sdfr case KBDC_IVAR_FLAGS: 25943105Sdfr ivar->flags = (int)val; 26043105Sdfr break; 26143105Sdfr default: 26243105Sdfr return ENOENT; 26343105Sdfr } 26443105Sdfr return 0; 26543105Sdfr} 26643105Sdfr 26743105SdfrDRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0); 26843105Sdfr 26943105Sdfr#endif /* NATKBDC > 0 */ 270