atkbdc_isa.c revision 58272
1254721Semaste/*- 2254721Semaste * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> 3254721Semaste * All rights reserved. 4254721Semaste * 5254721Semaste * Redistribution and use in source and binary forms, with or without 6254721Semaste * modification, are permitted provided that the following conditions 7254721Semaste * are met: 8254721Semaste * 1. Redistributions of source code must retain the above copyright 9254721Semaste * notice, this list of conditions and the following disclaimer as 10254721Semaste * the first lines of this file unmodified. 11254721Semaste * 2. Redistributions in binary form must reproduce the above copyright 12254721Semaste * notice, this list of conditions and the following disclaimer in the 13254721Semaste * documentation and/or other materials provided with the distribution. 14254721Semaste * 15254721Semaste * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 16254721Semaste * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17254721Semaste * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18254721Semaste * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 19254721Semaste * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20254721Semaste * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21254721Semaste * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22254721Semaste * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23254721Semaste * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24254721Semaste * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25254721Semaste * 26254721Semaste * $FreeBSD: head/sys/dev/atkbdc/atkbdc_isa.c 58272 2000-03-19 04:37:18Z yokota $ 27254721Semaste */ 28254721Semaste 29254721Semaste#include "opt_kbd.h" 30254721Semaste 31254721Semaste#include <sys/param.h> 32254721Semaste#include <sys/systm.h> 33254721Semaste#include <sys/kernel.h> 34254721Semaste#include <sys/bus.h> 35254721Semaste#include <sys/malloc.h> 36254721Semaste#include <machine/bus_pio.h> 37254721Semaste#include <machine/bus.h> 38254721Semaste#include <machine/resource.h> 39254721Semaste#include <sys/rman.h> 40254721Semaste 41254721Semaste#include <dev/kbd/atkbdcreg.h> 42254721Semaste 43254721Semaste#include <isa/isareg.h> 44254721Semaste#include <isa/isavar.h> 45254721Semaste 46254721SemasteMALLOC_DEFINE(M_ATKBDDEV, "atkbddev", "AT Keyboard device"); 47254721Semaste 48254721Semaste/* children */ 49254721Semastetypedef struct atkbdc_device { 50254721Semaste int flags; /* configuration flags */ 51254721Semaste int irq; /* ISA IRQ mask */ 52254721Semaste u_int32_t vendorid; 53254721Semaste u_int32_t serial; 54254721Semaste u_int32_t logicalid; 55254721Semaste u_int32_t compatid; 56254721Semaste} atkbdc_device_t; 57254721Semaste 58254721Semaste/* kbdc */ 59254721Semastedevclass_t atkbdc_devclass; 60254721Semaste 61254721Semastestatic int atkbdc_probe(device_t dev); 62254721Semastestatic int atkbdc_attach(device_t dev); 63254721Semastestatic int atkbdc_print_child(device_t bus, device_t dev); 64254721Semastestatic int atkbdc_read_ivar(device_t bus, device_t dev, int index, 65254721Semaste u_long *val); 66254721Semastestatic int atkbdc_write_ivar(device_t bus, device_t dev, int index, 67254721Semaste u_long val); 68254721Semaste 69254721Semastestatic device_method_t atkbdc_methods[] = { 70254721Semaste DEVMETHOD(device_probe, atkbdc_probe), 71254721Semaste DEVMETHOD(device_attach, atkbdc_attach), 72254721Semaste DEVMETHOD(device_suspend, bus_generic_suspend), 73254721Semaste DEVMETHOD(device_resume, bus_generic_resume), 74254721Semaste 75254721Semaste DEVMETHOD(bus_print_child, atkbdc_print_child), 76254721Semaste DEVMETHOD(bus_read_ivar, atkbdc_read_ivar), 77254721Semaste DEVMETHOD(bus_write_ivar, atkbdc_write_ivar), 78254721Semaste DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource), 79254721Semaste DEVMETHOD(bus_release_resource, bus_generic_release_resource), 80254721Semaste DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 81254721Semaste DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 82254721Semaste DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 83254721Semaste DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr), 84254721Semaste 85254721Semaste { 0, 0 } 86254721Semaste}; 87254721Semaste 88254721Semastestatic driver_t atkbdc_driver = { 89254721Semaste ATKBDC_DRIVER_NAME, 90254721Semaste atkbdc_methods, 91254721Semaste sizeof(atkbdc_softc_t *), 92254721Semaste}; 93254721Semaste 94254721Semastestatic struct isa_pnp_id atkbdc_ids[] = { 95254721Semaste { 0x0303d041, "Keyboard controller (i8042)" }, /* PNP0303 */ 96254721Semaste { 0 } 97254721Semaste}; 98254721Semaste 99254721Semastestatic int 100254721Semasteatkbdc_probe(device_t dev) 101254721Semaste{ 102254721Semaste struct resource *port0; 103254721Semaste struct resource *port1; 104254721Semaste int error; 105254721Semaste int rid; 106254721Semaste 107254721Semaste /* check PnP IDs */ 108254721Semaste if (ISA_PNP_PROBE(device_get_parent(dev), dev, atkbdc_ids) == ENXIO) 109254721Semaste return ENXIO; 110254721Semaste 111254721Semaste device_set_desc(dev, "Keyboard controller (i8042)"); 112254721Semaste 113254721Semaste rid = 0; 114254721Semaste port0 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, 115254721Semaste RF_ACTIVE); 116254721Semaste if (port0 == NULL) 117254721Semaste return ENXIO; 118254721Semaste /* XXX */ 119254721Semaste if (bus_get_resource_start(dev, SYS_RES_IOPORT, 1) <= 0) { 120254721Semaste bus_set_resource(dev, SYS_RES_IOPORT, 1, 121254721Semaste rman_get_start(port0) + KBD_STATUS_PORT, 1); 122254721Semaste } 123254721Semaste rid = 1; 124254721Semaste port1 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, 125254721Semaste RF_ACTIVE); 126254721Semaste if (port1 == NULL) { 127254721Semaste bus_release_resource(dev, SYS_RES_IOPORT, 0, port0); 128254721Semaste return ENXIO; 129254721Semaste } 130254721Semaste 131254721Semaste error = atkbdc_probe_unit(device_get_unit(dev), port0, port1); 132254721Semaste 133254721Semaste bus_release_resource(dev, SYS_RES_IOPORT, 0, port0); 134254721Semaste bus_release_resource(dev, SYS_RES_IOPORT, 1, port1); 135254721Semaste 136254721Semaste return error; 137254721Semaste} 138254721Semaste 139254721Semastestatic void 140254721Semasteatkbdc_add_device(device_t dev, const char *name, int unit) 141254721Semaste{ 142254721Semaste atkbdc_device_t *kdev; 143254721Semaste device_t child; 144254721Semaste int t; 145254721Semaste 146254721Semaste if (resource_int_value(name, unit, "disabled", &t) == 0 && t != 0) 147254721Semaste return; 148254721Semaste 149254721Semaste kdev = malloc(sizeof(struct atkbdc_device), M_ATKBDDEV, M_NOWAIT); 150254721Semaste if (!kdev) 151254721Semaste return; 152254721Semaste bzero(kdev, sizeof *kdev); 153254721Semaste 154254721Semaste if (resource_int_value(name, unit, "irq", &t) == 0) 155254721Semaste kdev->irq = t; 156254721Semaste else 157254721Semaste kdev->irq = -1; 158254721Semaste 159254721Semaste if (resource_int_value(name, unit, "flags", &t) == 0) 160254721Semaste kdev->flags = t; 161254721Semaste else 162254721Semaste kdev->flags = 0; 163254721Semaste 164254721Semaste child = device_add_child(dev, name, unit); 165254721Semaste device_set_ivars(child, kdev); 166254721Semaste} 167254721Semaste 168254721Semastestatic int 169254721Semasteatkbdc_attach(device_t dev) 170254721Semaste{ 171254721Semaste atkbdc_softc_t *sc; 172254721Semaste int unit; 173254721Semaste int error; 174254721Semaste int rid; 175254721Semaste int i; 176254721Semaste 177254721Semaste unit = device_get_unit(dev); 178254721Semaste sc = *(atkbdc_softc_t **)device_get_softc(dev); 179254721Semaste if (sc == NULL) { 180254721Semaste /* 181254721Semaste * We have to maintain two copies of the kbdc_softc struct, 182254721Semaste * as the low-level console needs to have access to the 183 * keyboard controller before kbdc is probed and attached. 184 * kbdc_soft[] contains the default entry for that purpose. 185 * See atkbdc.c. XXX 186 */ 187 sc = atkbdc_get_softc(unit); 188 if (sc == NULL) 189 return ENOMEM; 190 } 191 192 rid = 0; 193 sc->port0 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, 194 RF_ACTIVE); 195 if (sc->port0 == NULL) 196 return ENXIO; 197 rid = 1; 198 sc->port1 = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, 199 RF_ACTIVE); 200 if (sc->port1 == NULL) { 201 bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port0); 202 return ENXIO; 203 } 204 205 error = atkbdc_attach_unit(unit, sc, sc->port0, sc->port1); 206 if (error) { 207 bus_release_resource(dev, SYS_RES_IOPORT, 0, sc->port0); 208 bus_release_resource(dev, SYS_RES_IOPORT, 1, sc->port1); 209 return error; 210 } 211 *(atkbdc_softc_t **)device_get_softc(dev) = sc; 212 213 /* 214 * Add all devices configured to be attached to atkbdc0. 215 */ 216 for (i = resource_query_string(-1, "at", device_get_nameunit(dev)); 217 i != -1; 218 i = resource_query_string(i, "at", device_get_nameunit(dev))) { 219 atkbdc_add_device(dev, resource_query_name(i), 220 resource_query_unit(i)); 221 } 222 223 /* 224 * and atkbdc? 225 */ 226 for (i = resource_query_string(-1, "at", device_get_name(dev)); 227 i != -1; 228 i = resource_query_string(i, "at", device_get_name(dev))) { 229 atkbdc_add_device(dev, resource_query_name(i), 230 resource_query_unit(i)); 231 } 232 233 bus_generic_attach(dev); 234 235 return 0; 236} 237 238static int 239atkbdc_print_child(device_t bus, device_t dev) 240{ 241 atkbdc_device_t *kbdcdev; 242 int retval = 0; 243 244 kbdcdev = (atkbdc_device_t *)device_get_ivars(dev); 245 246 retval += bus_print_child_header(bus, dev); 247 if (kbdcdev->flags != 0) 248 retval += printf(" flags 0x%x", kbdcdev->flags); 249 if (kbdcdev->irq != -1) 250 retval += printf(" irq %d", kbdcdev->irq); 251 retval += bus_print_child_footer(bus, dev); 252 253 return (retval); 254} 255 256static int 257atkbdc_read_ivar(device_t bus, device_t dev, int index, u_long *val) 258{ 259 atkbdc_device_t *ivar; 260 261 ivar = (atkbdc_device_t *)device_get_ivars(dev); 262 switch (index) { 263 case KBDC_IVAR_IRQ: 264 *val = (u_long)ivar->irq; 265 break; 266 case KBDC_IVAR_FLAGS: 267 *val = (u_long)ivar->flags; 268 break; 269 case KBDC_IVAR_VENDORID: 270 *val = (u_long)ivar->vendorid; 271 break; 272 case KBDC_IVAR_SERIAL: 273 *val = (u_long)ivar->serial; 274 break; 275 case KBDC_IVAR_LOGICALID: 276 *val = (u_long)ivar->logicalid; 277 break; 278 case KBDC_IVAR_COMPATID: 279 *val = (u_long)ivar->compatid; 280 break; 281 default: 282 return ENOENT; 283 } 284 return 0; 285} 286 287static int 288atkbdc_write_ivar(device_t bus, device_t dev, int index, u_long val) 289{ 290 atkbdc_device_t *ivar; 291 292 ivar = (atkbdc_device_t *)device_get_ivars(dev); 293 switch (index) { 294 case KBDC_IVAR_IRQ: 295 ivar->irq = (int)val; 296 break; 297 case KBDC_IVAR_FLAGS: 298 ivar->flags = (int)val; 299 break; 300 case KBDC_IVAR_VENDORID: 301 ivar->vendorid = (u_int32_t)val; 302 break; 303 case KBDC_IVAR_SERIAL: 304 ivar->serial = (u_int32_t)val; 305 break; 306 case KBDC_IVAR_LOGICALID: 307 ivar->logicalid = (u_int32_t)val; 308 break; 309 case KBDC_IVAR_COMPATID: 310 ivar->compatid = (u_int32_t)val; 311 break; 312 default: 313 return ENOENT; 314 } 315 return 0; 316} 317 318DRIVER_MODULE(atkbdc, isa, atkbdc_driver, atkbdc_devclass, 0, 0); 319