1 /*- 2 * (MPSAFE) 3 * 4 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer as 12 * the first lines of this file unmodified. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 * 28 * $FreeBSD: src/sys/isa/atkbd_isa.c,v 1.7.2.3 2001/08/01 10:42:28 yokota Exp $ 29 */ 30 31 #include "opt_kbd.h" 32 33 #include <sys/param.h> 34 #include <sys/systm.h> 35 #include <sys/kernel.h> 36 #include <sys/bus.h> 37 #include <sys/rman.h> 38 #include <sys/thread.h> 39 #include <sys/machintr.h> 40 41 #include <sys/kbio.h> 42 #include <dev/misc/kbd/kbdreg.h> 43 #include <dev/misc/kbd/atkbdreg.h> 44 #include <dev/misc/kbd/atkbdcreg.h> 45 46 #include <bus/isa/isareg.h> 47 #include <bus/isa/isavar.h> 48 49 #if 0 50 #define lwkt_gettoken(x) 51 #define lwkt_reltoken(x) 52 #endif 53 54 typedef struct { 55 struct resource *intr; 56 void *ih; 57 } atkbd_softc_t; 58 59 devclass_t atkbd_devclass; 60 61 static int atkbdprobe(device_t dev); 62 static int atkbdattach(device_t dev); 63 static int atkbdresume(device_t dev); 64 static void atkbd_isa_intr(void *arg); 65 66 static device_method_t atkbd_methods[] = { 67 DEVMETHOD(device_probe, atkbdprobe), 68 DEVMETHOD(device_attach, atkbdattach), 69 DEVMETHOD(device_resume, atkbdresume), 70 DEVMETHOD_END 71 }; 72 73 static driver_t atkbd_driver = { 74 ATKBD_DRIVER_NAME, 75 atkbd_methods, 76 sizeof(atkbd_softc_t), 77 }; 78 79 static int 80 atkbdprobe(device_t dev) 81 { 82 uintptr_t irq; 83 uintptr_t flags; 84 85 device_set_desc(dev, "AT Keyboard"); 86 87 /* obtain parameters */ 88 BUS_READ_IVAR(device_get_parent(dev), dev, KBDC_IVAR_IRQ, &irq); 89 BUS_READ_IVAR(device_get_parent(dev), dev, KBDC_IVAR_FLAGS, &flags); 90 91 /* probe the device */ 92 return atkbd_probe_unit(device_get_unit(dev), 93 device_get_unit(device_get_parent(dev)), 94 irq, flags); 95 } 96 97 static int 98 atkbdattach(device_t dev) 99 { 100 atkbd_softc_t *sc; 101 keyboard_t *kbd; 102 uintptr_t irq; 103 uintptr_t flags; 104 int rid; 105 int error; 106 107 sc = device_get_softc(dev); 108 109 BUS_READ_IVAR(device_get_parent(dev), dev, KBDC_IVAR_IRQ, &irq); 110 BUS_READ_IVAR(device_get_parent(dev), dev, KBDC_IVAR_FLAGS, &flags); 111 112 error = atkbd_attach_unit(device_get_unit(dev), &kbd, 113 device_get_unit(device_get_parent(dev)), 114 irq, flags); 115 if (error) 116 return error; 117 118 /* declare our interrupt handler */ 119 rid = 0; 120 sc->intr = bus_alloc_legacy_irq_resource(dev, &rid, irq, RF_ACTIVE); 121 BUS_SETUP_INTR(device_get_parent(dev), dev, sc->intr, INTR_MPSAFE, 122 atkbd_isa_intr, kbd, &sc->ih, NULL, NULL); 123 124 return 0; 125 } 126 127 static int 128 atkbdresume(device_t dev) 129 { 130 atkbd_softc_t *sc; 131 keyboard_t *kbd; 132 int args[2]; 133 134 lwkt_gettoken(&kbd_token); 135 sc = device_get_softc(dev); 136 kbd = kbd_get_keyboard(kbd_find_keyboard(ATKBD_DRIVER_NAME, 137 device_get_unit(dev))); 138 if (kbd) { 139 kbd->kb_flags &= ~KB_INITIALIZED; 140 args[0] = device_get_unit(device_get_parent(dev)); 141 args[1] = rman_get_start(sc->intr); 142 sw_init(kbdsw[kbd->kb_index], device_get_unit(dev), &kbd, 143 args, device_get_flags(dev)); 144 kbd_clear_state(kbd); 145 146 } 147 lwkt_reltoken(&kbd_token); 148 return 0; 149 } 150 151 static void 152 atkbd_isa_intr(void *arg) 153 { 154 keyboard_t *kbd; 155 156 lwkt_gettoken(&kbd_token); 157 kbd = (keyboard_t *)arg; 158 kbd_intr(kbd, NULL); 159 lwkt_reltoken(&kbd_token); 160 } 161 162 DRIVER_MODULE(atkbd, atkbdc, atkbd_driver, atkbd_devclass, NULL, NULL); 163