sys/powerpc/powermac/pswitch.c

   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 }