atkbdc_subr.c revision 43105
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 * $Id: $ 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> 3943105Sdfr 4043105Sdfr#include <dev/kbd/atkbdcreg.h> 4143105Sdfr 4243105Sdfr#include <isa/isareg.h> 4343105Sdfr#include <isa/isavar.h> 4443105Sdfr 4543105SdfrMALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device"); 4643105Sdfr 4743105Sdfr/* children */ 4843105Sdfrtypedef struct atkbdc_device { 4943105Sdfr int flags; /* configuration flags */ 5043105Sdfr int port; /* port number (same as the controller's) */ 5143105Sdfr int irq; /* ISA IRQ mask */ 5243105Sdfr} atkbdc_device_t; 5343105Sdfr 5443105Sdfr/* kbdc */ 5543105Sdfrdevclass_t atkbdc_devclass; 5643105Sdfr 5743105Sdfrstatic int atkbdc_probe(device_t dev); 5843105Sdfrstatic int atkbdc_attach(device_t dev); 5943105Sdfrstatic void atkbdc_print_child(device_t bus, device_t dev); 6043105Sdfrstatic int atkbdc_read_ivar(device_t bus, device_t dev, int index, 6143105Sdfr u_long *val); 6243105Sdfrstatic int atkbdc_write_ivar(device_t bus, device_t dev, int index, 6343105Sdfr u_long val); 6443105Sdfr 6543105Sdfrstatic device_method_t atkbdc_methods[] = { 6643105Sdfr DEVMETHOD(device_probe, atkbdc_probe), 6743105Sdfr DEVMETHOD(device_attach, atkbdc_attach), 6843105Sdfr 6943105Sdfr DEVMETHOD(bus_print_child, atkbdc_print_child), 7043105Sdfr DEVMETHOD(bus_read_ivar, atkbdc_read_ivar), 7143105Sdfr DEVMETHOD(bus_write_ivar, atkbdc_write_ivar), 7243105Sdfr DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource), 7343105Sdfr DEVMETHOD(bus_release_resource, bus_generic_release_resource), 7443105Sdfr DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 7543105Sdfr DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 7643105Sdfr DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 7743105Sdfr DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 7843105Sdfr 7943105Sdfr { 0, 0 } 8043105Sdfr}; 8143105Sdfr 8243105Sdfrstatic driver_t atkbdc_driver = { 8343105Sdfr ATKBDC_DRIVER_NAME, 8443105Sdfr atkbdc_methods, 8543105Sdfr DRIVER_TYPE_MISC, 8643105Sdfr sizeof(atkbdc_softc_t *), 8743105Sdfr}; 8843105Sdfr 8943105Sdfrstatic int 9043105Sdfratkbdc_probe(device_t dev) 9143105Sdfr{ 9243105Sdfr atkbdc_softc_t *sc; 9343105Sdfr int unit; 9443105Sdfr int error; 9543105Sdfr 9643105Sdfr unit = device_get_unit(dev); 9743105Sdfr sc = *(atkbdc_softc_t **)device_get_softc(dev); 9843105Sdfr if (sc == NULL) { 9943105Sdfr /* 10043105Sdfr * We have to maintain two copies of the kbdc_softc struct, 10143105Sdfr * as the low-level console needs to have access to the 10243105Sdfr * keyboard controller before kbdc is probed and attached. 10343105Sdfr * kbdc_soft[] contains the default entry for that purpose. 10443105Sdfr * See atkbdc.c. XXX 10543105Sdfr */ 10643105Sdfr sc = atkbdc_get_softc(unit); 10743105Sdfr if (sc == NULL) 10843105Sdfr return ENOMEM; 10943105Sdfr } 11043105Sdfr 11143105Sdfr device_set_desc(dev, "keyboard controller (i8042)"); 11243105Sdfr 11343105Sdfr error = atkbdc_probe_unit(sc, unit, isa_get_port(dev)); 11443105Sdfr if (error == 0) 11543105Sdfr *(atkbdc_softc_t **)device_get_softc(dev) = sc; 11643105Sdfr 11743105Sdfr return error; 11843105Sdfr} 11943105Sdfr 12043105Sdfrstatic void 12143105Sdfratkbdc_add_device(device_t dev, const char *name, int unit) 12243105Sdfr{ 12343105Sdfr atkbdc_softc_t *sc = *(atkbdc_softc_t **)device_get_softc(dev); 12443105Sdfr atkbdc_device_t *kdev; 12543105Sdfr device_t child; 12643105Sdfr int t; 12743105Sdfr 12843105Sdfr kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT); 12943105Sdfr if (!kdev) 13043105Sdfr return; 13143105Sdfr bzero(kdev, sizeof *kdev); 13243105Sdfr 13343105Sdfr kdev->port = sc->port; 13443105Sdfr 13543105Sdfr if (resource_int_value(name, unit, "irq", &t) == 0) 13643105Sdfr kdev->irq = t; 13743105Sdfr else 13843105Sdfr kdev->irq = -1; 13943105Sdfr 14043105Sdfr if (resource_int_value(name, unit, "flags", &t) == 0) 14143105Sdfr kdev->flags = t; 14243105Sdfr else 14343105Sdfr kdev->flags = 0; 14443105Sdfr 14543105Sdfr child = device_add_child(dev, name, unit, kdev); 14643105Sdfr} 14743105Sdfr 14843105Sdfrstatic int 14943105Sdfratkbdc_attach(device_t dev) 15043105Sdfr{ 15143105Sdfr atkbdc_softc_t *sc; 15243105Sdfr int i; 15343105Sdfr 15443105Sdfr sc = *(atkbdc_softc_t **)device_get_softc(dev); 15543105Sdfr if ((sc == NULL) || (sc->port <= 0)) 15643105Sdfr return ENXIO; 15743105Sdfr 15843105Sdfr /* 15943105Sdfr * Add all devices configured to be attached to atkbdc0. 16043105Sdfr */ 16143105Sdfr for (i = resource_query_string(-1, "at", "atkbdc0"); 16243105Sdfr i != -1; 16343105Sdfr i = resource_query_string(i, "at", "atkbdc0")) { 16443105Sdfr atkbdc_add_device(dev, resource_query_name(i), 16543105Sdfr resource_query_unit(i)); 16643105Sdfr } 16743105Sdfr 16843105Sdfr /* 16943105Sdfr * and atkbdc? 17043105Sdfr */ 17143105Sdfr for (i = resource_query_string(-1, "at", "atkbdc"); 17243105Sdfr i != -1; 17343105Sdfr i = resource_query_string(i, "at", "atkbdc")) { 17443105Sdfr atkbdc_add_device(dev, resource_query_name(i), 17543105Sdfr resource_query_unit(i)); 17643105Sdfr } 17743105Sdfr 17843105Sdfr bus_generic_attach(dev); 17943105Sdfr 18043105Sdfr return 0; 18143105Sdfr} 18243105Sdfr 18343105Sdfrstatic void 18443105Sdfratkbdc_print_child(device_t bus, device_t dev) 18543105Sdfr{ 18643105Sdfr atkbdc_device_t *kbdcdev; 18743105Sdfr 18843105Sdfr kbdcdev = (atkbdc_device_t *)device_get_ivars(dev); 18943105Sdfr 19043105Sdfr if (kbdcdev->flags != 0) 19143105Sdfr printf(" flags 0x%x", kbdcdev->flags); 19243105Sdfr 19343105Sdfr printf(" on %s%d", device_get_name(bus), device_get_unit(bus)); 19443105Sdfr} 19543105Sdfr 19643105Sdfrstatic int 19743105Sdfratkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val) 19843105Sdfr{ 19943105Sdfr atkbdc_device_t *ivar; 20043105Sdfr 20143105Sdfr ivar = (atkbdc_device_t *)device_get_ivars(dev); 20243105Sdfr switch (index) { 20343105Sdfr case KBDC_IVAR_PORT: 20443105Sdfr *val = (u_long)ivar->port; 20543105Sdfr break; 20643105Sdfr case KBDC_IVAR_IRQ: 20743105Sdfr *val = (u_long)ivar->irq; 20843105Sdfr break; 20943105Sdfr case KBDC_IVAR_FLAGS: 21043105Sdfr *val = (u_long)ivar->flags; 21143105Sdfr break; 21243105Sdfr default: 21343105Sdfr return ENOENT; 21443105Sdfr } 21543105Sdfr return 0; 21643105Sdfr} 21743105Sdfr 21843105Sdfrstatic int 21943105Sdfratkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val) 22043105Sdfr{ 22143105Sdfr atkbdc_device_t *ivar; 22243105Sdfr 22343105Sdfr ivar = (atkbdc_device_t *)device_get_ivars(dev); 22443105Sdfr switch (index) { 22543105Sdfr case KBDC_IVAR_PORT: 22643105Sdfr ivar->port = (int)val; 22743105Sdfr break; 22843105Sdfr case KBDC_IVAR_IRQ: 22943105Sdfr ivar->irq = (int)val; 23043105Sdfr break; 23143105Sdfr case KBDC_IVAR_FLAGS: 23243105Sdfr ivar->flags = (int)val; 23343105Sdfr break; 23443105Sdfr default: 23543105Sdfr return ENOENT; 23643105Sdfr } 23743105Sdfr return 0; 23843105Sdfr} 23943105Sdfr 24043105SdfrDRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0); 24143105Sdfr 24243105Sdfr#endif /* NATKBDC > 0 */ 243