1 /*- 2 * Copyright (C) 2002 Benno Rice. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR 15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 18 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 19 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 20 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 21 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 22 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 23 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24 * 25 * $FreeBSD$ 26 */ 27 28 #include "opt_ddb.h" 29 30 #include <sys/param.h> 31 #include <sys/systm.h> 32 #include <sys/kdb.h> 33 #include <sys/kernel.h> 34 #include <sys/module.h> 35 #include <sys/malloc.h> 36 #include <sys/bus.h> 37 #include <machine/bus.h> 38 #include <sys/rman.h> 39 40 #include <machine/resource.h> 41 42 #include <dev/ofw/openfirm.h> 43 44 #include <powerpc/powermac/maciovar.h> 45 46 struct pswitch_softc { 47 int sc_irqrid; 48 struct resource *sc_irq; 49 void *sc_ih; 50 }; 51 52 static int pswitch_probe(device_t); 53 static int pswitch_attach(device_t); 54 55 static int pswitch_intr(void *); 56 57 static device_method_t pswitch_methods[] = { 58 /* Device interface */ 59 DEVMETHOD(device_probe, pswitch_probe), 60 DEVMETHOD(device_attach, pswitch_attach), 61 62 { 0, 0 } 63 }; 64 65 static driver_t pswitch_driver = { 66 "pswitch", 67 pswitch_methods, 68 sizeof(struct pswitch_softc) 69 }; 70 71 static devclass_t pswitch_devclass; 72 73 DRIVER_MODULE(pswitch, macio, pswitch_driver, pswitch_devclass, 0, 0); 74 75 static int 76 pswitch_probe(device_t dev) 77 { 78 char *type = macio_get_devtype(dev); 79 80 if (strcmp(type, "gpio") != 0) 81 return (ENXIO); 82 83 device_set_desc(dev, "GPIO Programmer's Switch"); 84 return (0); 85 } 86 87 static int 88 pswitch_attach(device_t dev) 89 { 90 struct pswitch_softc *sc; 91 phandle_t node, child; 92 char type[32]; 93 u_int irq[2]; 94 95 sc = device_get_softc(dev); 96 node = macio_get_node(dev); 97 98 for (child = OF_child(node); child != 0; child = OF_peer(child)) { 99 if (OF_getprop(child, "device_type", type, 32) == -1) 100 continue; 101 102 if (strcmp(type, "programmer-switch") == 0) 103 break; 104 } 105 106 if (child == 0) { 107 device_printf(dev, "could not find correct node\n"); 108 return (ENXIO); 109 } 110 111 if (OF_getprop(child, "interrupts", irq, sizeof(irq)) == -1) { 112 device_printf(dev, "could not get interrupt\n"); 113 return (ENXIO); 114 } 115 116 sc->sc_irqrid = 0; 117 sc->sc_irq = bus_alloc_resource(dev, SYS_RES_IRQ, &sc->sc_irqrid, 118 irq[0], irq[0], 1, RF_ACTIVE); 119 if (sc->sc_irq == NULL) { 120 device_printf(dev, "could not allocate interrupt\n"); 121 return (ENXIO); 122 } 123 124 if (bus_setup_intr(dev, sc->sc_irq, INTR_TYPE_MISC, 125 pswitch_intr, NULL, dev, &sc->sc_ih) != 0) { 126 device_printf(dev, "could not setup interrupt\n"); 127 bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irqrid, 128 sc->sc_irq); 129 return (ENXIO); 130 } 131 132 return (0); 133 } 134 135 static int 136 pswitch_intr(void *arg) 137 { 138 device_t dev; 139 140 dev = (device_t)arg; 141 142 kdb_enter(KDB_WHY_POWERPC, device_get_nameunit(dev)); 143 return (FILTER_HANDLED); 144 } 145