clkbrd.c

Version: - FREEBSD - FREEBSD-13-STABLE - FREEBSD-13-0 - FREEBSD-12-STABLE - FREEBSD-12-0 - FREEBSD-11-STABLE - FREEBSD-11-0 - FREEBSD-10-STABLE - FREEBSD-10-0 - FREEBSD-9-STABLE - FREEBSD-9-0 - FREEBSD-8-STABLE - FREEBSD-8-0 - FREEBSD-7-STABLE - FREEBSD-7-0 - FREEBSD-6-STABLE - FREEBSD-6-0 - FREEBSD-5-STABLE - FREEBSD-5-0 - FREEBSD-4-STABLE - FREEBSD-3-STABLE - FREEBSD22 - l41 - OPENBSD - linux-2.6 - MK84 - PLAN9 - xnu-8792
SearchContext: - none - 3 - 10

    1 /*-
    2  * Copyright (c) 2004 Jason L. Wright (jason@thought.net)
    3  * Copyright (c) 2005 Marius Strobl <marius@FreeBSD.org>
    4  * All rights reserved.
    5  *
    6  * Redistribution and use in source and binary forms, with or without
    7  * modification, are permitted provided that the following conditions
    8  * are met:
    9  * 1. Redistributions of source code must retain the above copyright
   10  *    notice, this list of conditions and the following disclaimer.
   11  * 2. Redistributions in binary form must reproduce the above copyright
   12  *    notice, this list of conditions and the following disclaimer in the
   13  *    documentation and/or other materials provided with the distribution.
   14  *
   15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
   17  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
   18  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
   19  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
   20  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
   21  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
   23  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
   24  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
   25  * POSSIBILITY OF SUCH DAMAGE.
   26  *
   27  *      from: OpenBSD: clkbrd.c,v 1.5 2004/10/01 18:18:49 jason Exp
   28  */
   29 
   30 #include <sys/cdefs.h>
   31 __FBSDID("$FreeBSD: releng/11.0/sys/sparc64/fhc/clkbrd.c 157225 2006-03-28 19:46:48Z marius $");
   32 
   33 #include <sys/param.h>
   34 #include <sys/systm.h>
   35 #include <sys/kernel.h>
   36 #include <sys/module.h>
   37 #include <sys/resource.h>
   38 #include <sys/rman.h>
   39 
   40 #include <dev/led/led.h>
   41 #include <dev/ofw/ofw_bus.h>
   42 
   43 #include <machine/bus.h>
   44 #include <machine/resource.h>
   45 
   46 #include <sparc64/fhc/clkbrdreg.h>
   47 
   48 #define CLKBRD_NREG     3
   49 
   50 #define CLKBRD_CF       0
   51 #define CLKBRD_CLK      1
   52 #define CLKBRD_CLKVER   2
   53 
   54 struct clkbrd_softc {
   55         struct device           *sc_dev;
   56         struct resource         *sc_res[CLKBRD_NREG];
   57         int                     sc_rid[CLKBRD_NREG];
   58         bus_space_tag_t         sc_bt[CLKBRD_NREG];
   59         bus_space_handle_t      sc_bh[CLKBRD_NREG];
   60         uint8_t                 sc_clk_ctrl;
   61         struct cdev             *sc_led_dev;
   62         int                     sc_flags;
   63 #define CLKBRD_HAS_CLKVER       (1 << 0)
   64 };
   65 
   66 static devclass_t clkbrd_devclass;
   67 
   68 static device_probe_t clkbrd_probe;
   69 static device_attach_t clkbrd_attach;
   70 static device_detach_t clkbrd_detach;
   71 
   72 static void clkbrd_free_resources(struct clkbrd_softc *);
   73 static void clkbrd_led_func(void *, int);
   74 
   75 static device_method_t clkbrd_methods[] = {
   76         /* Device interface */
   77         DEVMETHOD(device_probe,         clkbrd_probe),
   78         DEVMETHOD(device_attach,        clkbrd_attach),
   79         DEVMETHOD(device_detach,        clkbrd_detach),
   80 
   81         { 0, 0 }
   82 };
   83 
   84 static driver_t clkbrd_driver = {
   85         "clkbrd",
   86         clkbrd_methods,
   87         sizeof(struct clkbrd_softc),
   88 };
   89 
   90 DRIVER_MODULE(clkbrd, fhc, clkbrd_driver, clkbrd_devclass, 0, 0);
   91 
   92 static int
   93 clkbrd_probe(device_t dev)
   94 {
   95 
   96         if (strcmp(ofw_bus_get_name(dev), "clock-board") == 0) {
   97                 device_set_desc(dev, "Clock Board");
   98                 return (0);
   99         }
  100         return (ENXIO);
  101 }
  102 
  103 static int
  104 clkbrd_attach(device_t dev)
  105 {
  106         struct clkbrd_softc *sc;
  107         int i, slots;
  108         uint8_t r;
  109 
  110         sc = device_get_softc(dev);
  111         sc->sc_dev = dev;
  112 
  113         for (i = CLKBRD_CF; i <= CLKBRD_CLKVER; i++) {
  114                 sc->sc_rid[i] = i;
  115                 sc->sc_res[i] = bus_alloc_resource_any(sc->sc_dev,
  116                     SYS_RES_MEMORY, &sc->sc_rid[i], RF_ACTIVE);
  117                 if (sc->sc_res[i] == NULL) {
  118                         if (i != CLKBRD_CLKVER) {
  119                                 device_printf(sc->sc_dev,
  120                                     "could not allocate resource %d\n", i);
  121                                 goto fail;
  122                         }
  123                         continue;
  124                 }
  125                 sc->sc_bt[i] = rman_get_bustag(sc->sc_res[i]);
  126                 sc->sc_bh[i] = rman_get_bushandle(sc->sc_res[i]);
  127                 if (i == CLKBRD_CLKVER)
  128                         sc->sc_flags |= CLKBRD_HAS_CLKVER;
  129         }
  130 
  131         slots = 4;
  132         r = bus_space_read_1(sc->sc_bt[CLKBRD_CLK], sc->sc_bh[CLKBRD_CLK],
  133             CLK_STS1);
  134         switch (r & CLK_STS1_SLOTS_MASK) {
  135         case CLK_STS1_SLOTS_16:
  136                 slots = 16;
  137                 break;
  138         case CLK_STS1_SLOTS_8:
  139                 slots = 8;
  140                 break;
  141         case CLK_STS1_SLOTS_4:
  142                 if (sc->sc_flags & CLKBRD_HAS_CLKVER) {
  143                         r = bus_space_read_1(sc->sc_bt[CLKBRD_CLKVER],
  144                             sc->sc_bh[CLKBRD_CLKVER], CLKVER_SLOTS);
  145                         if (r != 0 &&
  146                             (r & CLKVER_SLOTS_MASK) == CLKVER_SLOTS_PLUS)
  147                                 slots = 5;
  148                 }
  149         }
  150 
  151         device_printf(sc->sc_dev, "Sun Enterprise Exx00 machine: %d slots\n",
  152             slots);
  153 
  154         sc->sc_clk_ctrl = bus_space_read_1(sc->sc_bt[CLKBRD_CLK],
  155             sc->sc_bh[CLKBRD_CLK], CLK_CTRL);
  156         sc->sc_led_dev = led_create(clkbrd_led_func, sc, "clockboard");
  157 
  158         return (0);
  159 
  160  fail:
  161         clkbrd_free_resources(sc);
  162 
  163         return (ENXIO);
  164 }
  165 
  166 static int
  167 clkbrd_detach(device_t dev)
  168 {
  169         struct clkbrd_softc *sc;
  170 
  171         sc = device_get_softc(dev);
  172 
  173         led_destroy(sc->sc_led_dev);
  174         bus_space_write_1(sc->sc_bt[CLKBRD_CLK], sc->sc_bh[CLKBRD_CLK],
  175             CLK_CTRL, sc->sc_clk_ctrl);
  176         bus_space_read_1(sc->sc_bt[CLKBRD_CLK], sc->sc_bh[CLKBRD_CLK],
  177             CLK_CTRL);
  178         clkbrd_free_resources(sc);
  179 
  180         return (0);
  181 }
  182 
  183 static void
  184 clkbrd_free_resources(struct clkbrd_softc *sc)
  185 {
  186         int i;
  187 
  188         for (i = CLKBRD_CF; i <= CLKBRD_CLKVER; i++)
  189                 if (sc->sc_res[i] != NULL)
  190                         bus_release_resource(sc->sc_dev, SYS_RES_MEMORY,
  191                             sc->sc_rid[i], sc->sc_res[i]);
  192 }
  193 
  194 static void
  195 clkbrd_led_func(void *arg, int onoff)
  196 {
  197         struct clkbrd_softc *sc;
  198         uint8_t r;
  199 
  200         sc = (struct clkbrd_softc *)arg;
  201 
  202         r = bus_space_read_1(sc->sc_bt[CLKBRD_CLK], sc->sc_bh[CLKBRD_CLK],
  203             CLK_CTRL);
  204         if (onoff)
  205                 r |= CLK_CTRL_RLED;
  206         else
  207                 r &= ~CLK_CTRL_RLED;
  208         bus_space_write_1(sc->sc_bt[CLKBRD_CLK], sc->sc_bh[CLKBRD_CLK],
  209             CLK_CTRL, r);
  210         bus_space_read_1(sc->sc_bt[CLKBRD_CLK], sc->sc_bh[CLKBRD_CLK],
  211             CLK_CTRL);
  212 }

Cache object: 34dd50146af6f772c46deb2fbe858246

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.

FreeBSD/Linux Kernel Cross Reference sys/sparc64/fhc/clkbrd.c

FreeBSD/Linux Kernel Cross Reference
sys/sparc64/fhc/clkbrd.c