1 /* $NetBSD: hpet.c,v 1.4 2007/12/09 20:27:58 jmcneill 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 /* 32 * High Precision Event Timer. 33 */ 34 35 #include <sys/cdefs.h> 36 __KERNEL_RCSID(0, "$NetBSD: hpet.c,v 1.4 2007/12/09 20:27:58 jmcneill Exp $"); 37 38 #include <sys/systm.h> 39 #include <sys/device.h> 40 #include <sys/malloc.h> 41 42 #include <sys/time.h> 43 #include <sys/timetc.h> 44 45 #include <sys/bus.h> 46 47 #include <dev/ic/hpetreg.h> 48 #include <dev/ic/hpetvar.h> 49 50 static u_int hpet_get_timecount(struct timecounter *); 51 static bool hpet_resume(device_t); 52 53 void 54 hpet_attach_subr(struct hpet_softc *sc) { 55 struct timecounter *tc; 56 uint32_t val; 57 58 tc = &sc->sc_tc; 59 60 tc->tc_name = sc->sc_dev.dv_xname; 61 tc->tc_get_timecount = hpet_get_timecount; 62 tc->tc_quality = 2000; 63 64 tc->tc_counter_mask = 0xffffffff; 65 66 /* Get frequency */ 67 val = bus_space_read_4(sc->sc_memt, sc->sc_memh, HPET_PERIOD); 68 tc->tc_frequency = 1000000000000000ULL / val; 69 70 /* Enable timer */ 71 val = bus_space_read_4(sc->sc_memt, sc->sc_memh, HPET_CONFIG); 72 if ((val & HPET_CONFIG_ENABLE) == 0) { 73 val |= HPET_CONFIG_ENABLE; 74 bus_space_write_4(sc->sc_memt, sc->sc_memh, HPET_CONFIG, val); 75 } 76 77 tc->tc_priv = sc; 78 tc_init(tc); 79 80 if (!pmf_device_register(&sc->sc_dev, NULL, hpet_resume)) 81 aprint_error_dev(&sc->sc_dev, "couldn't establish power handler\n"); 82 } 83 84 static u_int 85 hpet_get_timecount(struct timecounter *tc) { 86 struct hpet_softc *sc = tc->tc_priv; 87 88 return bus_space_read_4(sc->sc_memt, sc->sc_memh, HPET_MCOUNT_LO); 89 } 90 91 static bool 92 hpet_resume(device_t dv) 93 { 94 struct hpet_softc *sc = device_private(dv); 95 uint32_t val; 96 97 val = bus_space_read_4(sc->sc_memt, sc->sc_memh, HPET_CONFIG); 98 val |= HPET_CONFIG_ENABLE; 99 bus_space_write_4(sc->sc_memt, sc->sc_memh, HPET_CONFIG, val); 100 101 return true; 102 } 103