Home | History | Annotate | Line # | Download | only in pci
amdpcib_hpet.c revision 1.5 
      1 /* $NetBSD: amdpcib_hpet.c,v 1.5 2011/06/15 04:20:47 jruoho Exp $ */
      2 
      3 /*
      4  * Copyright (c) 2006 Nicolas Joly
      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.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. The name of the author may not be used to endorse or promote products
     16  *    derived from this software without specific prior written permission.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS
     19  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     20  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     21  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     22  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     28  * POSSIBILITY OF SUCH DAMAGE.
     29  */
     30 
     31 #include <sys/cdefs.h>
     32 __KERNEL_RCSID(0, "$NetBSD: amdpcib_hpet.c,v 1.5 2011/06/15 04:20:47 jruoho Exp $");
     33 
     34 #include <sys/systm.h>
     35 #include <sys/device.h>
     36 
     37 #include <sys/time.h>
     38 #include <sys/timetc.h>
     39 
     40 #include <machine/bus.h>
     41 
     42 #include <dev/pci/pcivar.h>
     43 #include <dev/pci/pcireg.h>
     44 #include <dev/pci/pcidevs.h>
     45 
     46 #include <dev/ic/hpetvar.h>
     47 
     48 static int	amdpcib_hpet_match(device_t , cfdata_t , void *);
     49 static void	amdpcib_hpet_attach(device_t, device_t, void *);
     50 static int	amdpcib_hpet_detach(device_t, int);
     51 
     52 CFATTACH_DECL_NEW(amdpcib_hpet, sizeof(struct hpet_softc),
     53     amdpcib_hpet_match, amdpcib_hpet_attach, amdpcib_hpet_detach, NULL);
     54 
     55 static int
     56 amdpcib_hpet_match(device_t parent, cfdata_t match, void *aux)
     57 {
     58 	return 1;
     59 }
     60 
     61 static void
     62 amdpcib_hpet_attach(device_t parent, device_t self, void *aux)
     63 {
     64 	struct hpet_softc *sc = device_private(self);
     65 	struct pci_attach_args *pa = aux;
     66 	pcireg_t conf, addr;
     67 
     68 	aprint_naive("\n");
     69 	aprint_normal(": HPET timer\n");
     70 
     71 	sc->sc_mapped = false;
     72 	conf = pci_conf_read(pa->pa_pc, pa->pa_tag, 0xa0);
     73 
     74 	if ((conf & 1) == 0) {
     75 		aprint_normal_dev(self, "HPET timer is disabled\n");
     76 		return;
     77 	}
     78 
     79 	sc->sc_mems = 1024;
     80 	sc->sc_memt = pa->pa_memt;
     81 
     82 	addr = conf & 0xfffffc00;
     83 
     84 	if (bus_space_map(sc->sc_memt, addr, sc->sc_mems, 0, &sc->sc_memh)) {
     85 		aprint_error_dev(self, "failed to map mem space\n");
     86 		return;
     87 	}
     88 
     89 	sc->sc_mapped = true;
     90 	hpet_attach_subr(self);
     91 }
     92 
     93 static int
     94 amdpcib_hpet_detach(device_t self, int flags)
     95 {
     96 	struct hpet_softc *sc = device_private(self);
     97 	int rv;
     98 
     99 	if (sc->sc_mapped != true)
    100 		return 0;
    101 
    102 	rv = hpet_detach(self, flags);
    103 
    104 	if (rv != 0)
    105 		return rv;
    106 
    107 	bus_space_unmap(sc->sc_memt, sc->sc_memh, sc->sc_mems);
    108 
    109 	return 0;
    110 }
    111