sys/arch/i386/pci/geodecntr.c

   1 /*      $NetBSD: geodecntr.c,v 1.7 2008/05/05 11:49:40 xtraeme Exp $    */
   2
   3 /*-
   4  * Copyright (c) 2006 The NetBSD Foundation, Inc.
   5  * All rights reserved.
   6  *
   7  * This code is derived from software contributed to The NetBSD Foundation
   8  * by Frank Kardel inspired from the patches to FreeBSD by Poul Henning Kamp
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  * 1. Redistributions of source code must retain the above copyright
  14  *    notice, this list of conditions and the following disclaimer.
  15  * 2. Redistributions in binary form must reproduce the above copyright
  16  *    notice, this list of conditions and the following disclaimer in the
  17  *    documentation and/or other materials provided with the distribution.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
  20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
  23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  29  * POSSIBILITY OF SUCH DAMAGE.
  30  */
  31
  32 #include <sys/cdefs.h>
  33 __KERNEL_RCSID(0, "$NetBSD: geodecntr.c,v 1.7 2008/05/05 11:49:40 xtraeme Exp $");
  34
  35 #include <sys/param.h>
  36 #include <sys/systm.h>
  37 #include <sys/kernel.h>
  38 #include <sys/device.h>
  39 #include <machine/cpu.h>
  40 #include <sys/timetc.h>
  41 #include <machine/bus.h>
  42 #include <arch/i386/pci/geodevar.h>
  43 #include <arch/i386/pci/geodereg.h>
  44
  45 struct  geodecntr_softc {
  46         struct geode_gcb_softc *sc_gcb_dev;
  47         struct timecounter      sc_tc;
  48 };
  49
  50 static unsigned geode_get_timecount(struct timecounter *);
  51
  52 static int attached = 0;
  53
  54 static int
  55 geodecntr_match(device_t parent, cfdata_t match, void *aux)
  56 {
  57         return !attached;
  58 }
  59
  60 /*
  61  * attach time counter
  62  */
  63 static void
  64 geodecntr_attach(device_t parent, device_t self, void *aux)
  65 {
  66         struct geodecntr_softc *sc = device_private(self);
  67
  68         aprint_naive("\n");
  69         aprint_normal(": AMD Geode SC1100 27MHz Counter\n");
  70
  71         sc->sc_gcb_dev = device_private(parent);
  72
  73         /*
  74          * select 27MHz, no powerdown, no interrupt
  75          */
  76         bus_space_write_1(sc->sc_gcb_dev->sc_iot, sc->sc_gcb_dev->sc_ioh,
  77                           SC1100_GCB_TMCNFG_B, SC1100_TMCNFG_TMCLKSEL);
  78
  79         memset(&sc->sc_tc, 0, sizeof(sc->sc_tc));
  80
  81         sc->sc_tc.tc_get_timecount = geode_get_timecount;
  82         sc->sc_tc.tc_poll_pps      = NULL;
  83         sc->sc_tc.tc_counter_mask  = 0xffffffff;
  84         sc->sc_tc.tc_frequency     = 27000000;
  85         sc->sc_tc.tc_name          = "geodecounter";
  86         sc->sc_tc.tc_priv          = sc;
  87         sc->sc_tc.tc_quality       = 1000;
  88
  89         tc_init(&sc->sc_tc);
  90
  91         attached = 1;
  92 }
  93
  94 static int
  95 geodecntr_detach(device_t self, int flags)
  96 {
  97         struct geodecntr_softc *sc = device_private(self);
  98
  99         attached = 0;
 100         return tc_detach(&sc->sc_tc);
 101 }
 102
 103 /*
 104  * read counter
 105  */
 106 static unsigned geode_get_timecount(struct timecounter *tc)
 107 {
 108         struct geodecntr_softc *sc = (struct geodecntr_softc *)tc->tc_priv;
 109
 110         return bus_space_read_4(sc->sc_gcb_dev->sc_iot, sc->sc_gcb_dev->sc_ioh,
 111             SC1100_GCB_TMVALUE_L);
 112 }
 113
 114 CFATTACH_DECL_NEW(geodecntr, sizeof(struct geodecntr_softc),
 115               geodecntr_match, geodecntr_attach, geodecntr_detach, NULL);
 116