mvsoctmr.c revision 1.1.2.2
1 1.1.2.2 yamt /* $NetBSD: mvsoctmr.c,v 1.1.2.2 2010/10/09 03:31:40 yamt Exp $ */ 2 1.1.2.2 yamt /* 3 1.1.2.2 yamt * Copyright (c) 2007, 2008 KIYOHARA Takashi 4 1.1.2.2 yamt * All rights reserved. 5 1.1.2.2 yamt * 6 1.1.2.2 yamt * Redistribution and use in source and binary forms, with or without 7 1.1.2.2 yamt * modification, are permitted provided that the following conditions 8 1.1.2.2 yamt * are met: 9 1.1.2.2 yamt * 1. Redistributions of source code must retain the above copyright 10 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer. 11 1.1.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 12 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer in the 13 1.1.2.2 yamt * documentation and/or other materials provided with the distribution. 14 1.1.2.2 yamt * 15 1.1.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 1.1.2.2 yamt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 17 1.1.2.2 yamt * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 1.1.2.2 yamt * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 19 1.1.2.2 yamt * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 20 1.1.2.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 21 1.1.2.2 yamt * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 1.1.2.2 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 23 1.1.2.2 yamt * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 24 1.1.2.2 yamt * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25 1.1.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 26 1.1.2.2 yamt */ 27 1.1.2.2 yamt #include <sys/cdefs.h> 28 1.1.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: mvsoctmr.c,v 1.1.2.2 2010/10/09 03:31:40 yamt Exp $"); 29 1.1.2.2 yamt 30 1.1.2.2 yamt #include <sys/param.h> 31 1.1.2.2 yamt #include <sys/atomic.h> 32 1.1.2.2 yamt #include <sys/bus.h> 33 1.1.2.2 yamt #include <sys/device.h> 34 1.1.2.2 yamt #include <sys/errno.h> 35 1.1.2.2 yamt #include <sys/kernel.h> 36 1.1.2.2 yamt #include <sys/time.h> 37 1.1.2.2 yamt #include <sys/timetc.h> 38 1.1.2.2 yamt #include <sys/systm.h> 39 1.1.2.2 yamt 40 1.1.2.2 yamt #include <machine/intr.h> 41 1.1.2.2 yamt 42 1.1.2.2 yamt #include <arm/cpufunc.h> 43 1.1.2.2 yamt 44 1.1.2.2 yamt #include <arm/marvell/mvsocreg.h> 45 1.1.2.2 yamt #include <arm/marvell/mvsocvar.h> 46 1.1.2.2 yamt #include <arm/marvell/mvsoctmrreg.h> 47 1.1.2.2 yamt 48 1.1.2.2 yamt #include <dev/marvell/marvellvar.h> 49 1.1.2.2 yamt 50 1.1.2.2 yamt 51 1.1.2.2 yamt struct mvsoctmr_softc { 52 1.1.2.2 yamt device_t sc_dev; 53 1.1.2.2 yamt 54 1.1.2.2 yamt bus_space_tag_t sc_iot; 55 1.1.2.2 yamt bus_space_handle_t sc_ioh; 56 1.1.2.2 yamt }; 57 1.1.2.2 yamt 58 1.1.2.2 yamt 59 1.1.2.2 yamt static int mvsoctmr_match(device_t, struct cfdata *, void *); 60 1.1.2.2 yamt static void mvsoctmr_attach(device_t, device_t, void *); 61 1.1.2.2 yamt 62 1.1.2.2 yamt static int clockhandler(void *); 63 1.1.2.2 yamt static int statclockhandler(void *); 64 1.1.2.2 yamt 65 1.1.2.2 yamt static u_int mvsoctmr_get_timecount(struct timecounter *); 66 1.1.2.2 yamt 67 1.1.2.2 yamt static void mvsoctmr_cntl(struct mvsoctmr_softc *, int, u_int, int, int); 68 1.1.2.2 yamt 69 1.1.2.2 yamt #ifndef STATHZ 70 1.1.2.2 yamt #define STATHZ 64 71 1.1.2.2 yamt #endif 72 1.1.2.2 yamt 73 1.1.2.2 yamt static struct mvsoctmr_softc *mvsoctmr_sc; 74 1.1.2.2 yamt static uint32_t clock_ticks, statclock_ticks; 75 1.1.2.2 yamt static struct timecounter mvsoctmr_timecounter = { 76 1.1.2.2 yamt mvsoctmr_get_timecount, /* get_timecount */ 77 1.1.2.2 yamt 0, /* no poll_pps */ 78 1.1.2.2 yamt ~0u, /* counter_mask */ 79 1.1.2.2 yamt 0, /* frequency (set by cpu_initclocks()) */ 80 1.1.2.2 yamt "mvsoctmr", /* name */ 81 1.1.2.2 yamt 100, /* quality */ 82 1.1.2.2 yamt NULL, /* prev */ 83 1.1.2.2 yamt NULL, /* next */ 84 1.1.2.2 yamt }; 85 1.1.2.2 yamt static volatile uint32_t mvsoctmr_base; 86 1.1.2.2 yamt 87 1.1.2.2 yamt CFATTACH_DECL_NEW(mvsoctmr, sizeof(struct mvsoctmr_softc), 88 1.1.2.2 yamt mvsoctmr_match, mvsoctmr_attach, NULL, NULL); 89 1.1.2.2 yamt 90 1.1.2.2 yamt 91 1.1.2.2 yamt /* ARGSUSED */ 92 1.1.2.2 yamt static int 93 1.1.2.2 yamt mvsoctmr_match(device_t parent, struct cfdata *match, void *aux) 94 1.1.2.2 yamt { 95 1.1.2.2 yamt struct marvell_attach_args *mva = aux; 96 1.1.2.2 yamt 97 1.1.2.2 yamt if (strcmp(mva->mva_name, match->cf_name) != 0) 98 1.1.2.2 yamt return 0; 99 1.1.2.2 yamt if (mva->mva_offset == MVA_OFFSET_DEFAULT) 100 1.1.2.2 yamt return 0; 101 1.1.2.2 yamt 102 1.1.2.2 yamt mva->mva_size = MVSOCTMR_SIZE; 103 1.1.2.2 yamt return 1; 104 1.1.2.2 yamt } 105 1.1.2.2 yamt 106 1.1.2.2 yamt /* ARGSUSED */ 107 1.1.2.2 yamt static void 108 1.1.2.2 yamt mvsoctmr_attach(device_t parent, device_t self, void *aux) 109 1.1.2.2 yamt { 110 1.1.2.2 yamt struct mvsoctmr_softc *sc = device_private(self); 111 1.1.2.2 yamt struct marvell_attach_args *mva = aux; 112 1.1.2.2 yamt 113 1.1.2.2 yamt aprint_naive("\n"); 114 1.1.2.2 yamt aprint_normal(": Marvell SoC Timer\n"); 115 1.1.2.2 yamt 116 1.1.2.2 yamt if (mvsoctmr_sc == NULL) 117 1.1.2.2 yamt mvsoctmr_sc = sc; 118 1.1.2.2 yamt 119 1.1.2.2 yamt sc->sc_dev = self; 120 1.1.2.2 yamt sc->sc_iot = mva->mva_iot; 121 1.1.2.2 yamt if (bus_space_subregion(mva->mva_iot, mva->mva_ioh, 122 1.1.2.2 yamt mva->mva_offset, mva->mva_size, &sc->sc_ioh)) 123 1.1.2.2 yamt panic("%s: Cannot map registers", device_xname(self)); 124 1.1.2.2 yamt } 125 1.1.2.2 yamt 126 1.1.2.2 yamt /* 127 1.1.2.2 yamt * clockhandler: 128 1.1.2.2 yamt * 129 1.1.2.2 yamt * Handle the hardclock interrupt. 130 1.1.2.2 yamt */ 131 1.1.2.2 yamt static int 132 1.1.2.2 yamt clockhandler(void *arg) 133 1.1.2.2 yamt { 134 1.1.2.2 yamt struct clockframe *frame = arg; 135 1.1.2.2 yamt 136 1.1.2.2 yamt atomic_add_32(&mvsoctmr_base, clock_ticks); 137 1.1.2.2 yamt 138 1.1.2.2 yamt hardclock(frame); 139 1.1.2.2 yamt 140 1.1.2.2 yamt return 1; 141 1.1.2.2 yamt } 142 1.1.2.2 yamt 143 1.1.2.2 yamt /* 144 1.1.2.2 yamt * statclockhandler: 145 1.1.2.2 yamt * 146 1.1.2.2 yamt * Handle the statclock interrupt. 147 1.1.2.2 yamt */ 148 1.1.2.2 yamt static int 149 1.1.2.2 yamt statclockhandler(void *arg) 150 1.1.2.2 yamt { 151 1.1.2.2 yamt struct clockframe *frame = arg; 152 1.1.2.2 yamt 153 1.1.2.2 yamt statclock(frame); 154 1.1.2.2 yamt 155 1.1.2.2 yamt return 1; 156 1.1.2.2 yamt } 157 1.1.2.2 yamt 158 1.1.2.2 yamt 159 1.1.2.2 yamt /* 160 1.1.2.2 yamt * setstatclockrate: 161 1.1.2.2 yamt * 162 1.1.2.2 yamt * Set the rate of the statistics clock. 163 1.1.2.2 yamt * 164 1.1.2.2 yamt * We assume that hz is either stathz or profhz, and that neither 165 1.1.2.2 yamt * will change after being set by cpu_initclocks(). We could 166 1.1.2.2 yamt * recalculate the intervals here, but that would be a pain. 167 1.1.2.2 yamt */ 168 1.1.2.2 yamt /* ARGSUSED */ 169 1.1.2.2 yamt void 170 1.1.2.2 yamt setstatclockrate(int newhz) 171 1.1.2.2 yamt { 172 1.1.2.2 yamt struct mvsoctmr_softc *sc = mvsoctmr_sc; 173 1.1.2.2 yamt const int en = 1, autoen = 1; 174 1.1.2.2 yamt 175 1.1.2.2 yamt statclock_ticks = mvTclk / newhz; 176 1.1.2.2 yamt 177 1.1.2.2 yamt mvsoctmr_cntl(sc, MVSOCTMR_TIMER1, statclock_ticks, en, autoen); 178 1.1.2.2 yamt } 179 1.1.2.2 yamt 180 1.1.2.2 yamt /* 181 1.1.2.2 yamt * cpu_initclocks: 182 1.1.2.2 yamt * 183 1.1.2.2 yamt * Initialize the clock and get them going. 184 1.1.2.2 yamt */ 185 1.1.2.2 yamt void 186 1.1.2.2 yamt cpu_initclocks() 187 1.1.2.2 yamt { 188 1.1.2.2 yamt struct mvsoctmr_softc *sc; 189 1.1.2.2 yamt void *clock_ih; 190 1.1.2.2 yamt const int en = 1, autoen = 1; 191 1.1.2.2 yamt 192 1.1.2.2 yamt sc = mvsoctmr_sc; 193 1.1.2.2 yamt if (sc == NULL) 194 1.1.2.2 yamt panic("cpu_initclocks: mvsoctmr not found"); 195 1.1.2.2 yamt 196 1.1.2.2 yamt stathz = profhz = STATHZ; 197 1.1.2.2 yamt mvsoctmr_timecounter.tc_frequency = mvTclk; 198 1.1.2.2 yamt clock_ticks = mvTclk / hz; 199 1.1.2.2 yamt 200 1.1.2.2 yamt mvsoctmr_cntl(sc, MVSOCTMR_TIMER0, clock_ticks, en, autoen); 201 1.1.2.2 yamt 202 1.1.2.2 yamt clock_ih = mvsoc_bridge_intr_establish(MVSOC_MLMB_MLMBI_CPUTIMER0INTREQ, 203 1.1.2.2 yamt IPL_CLOCK, clockhandler, NULL); 204 1.1.2.2 yamt if (clock_ih == NULL) 205 1.1.2.2 yamt panic("cpu_initclocks: unable to register timer interrupt"); 206 1.1.2.2 yamt 207 1.1.2.2 yamt if (stathz) { 208 1.1.2.2 yamt setstatclockrate(stathz); 209 1.1.2.2 yamt clock_ih = mvsoc_bridge_intr_establish( 210 1.1.2.2 yamt MVSOC_MLMB_MLMBI_CPUTIMER1INTREQ, IPL_HIGH, 211 1.1.2.2 yamt statclockhandler, NULL); 212 1.1.2.2 yamt if (clock_ih == NULL) 213 1.1.2.2 yamt panic("cpu_initclocks:" 214 1.1.2.2 yamt " unable to register statclock timer interrupt"); 215 1.1.2.2 yamt } 216 1.1.2.2 yamt 217 1.1.2.2 yamt tc_init(&mvsoctmr_timecounter); 218 1.1.2.2 yamt } 219 1.1.2.2 yamt 220 1.1.2.2 yamt void 221 1.1.2.2 yamt delay(unsigned int n) 222 1.1.2.2 yamt { 223 1.1.2.2 yamt struct mvsoctmr_softc *sc; 224 1.1.2.2 yamt unsigned int cur_tick, initial_tick; 225 1.1.2.2 yamt int remaining; 226 1.1.2.2 yamt 227 1.1.2.2 yamt sc = mvsoctmr_sc; 228 1.1.2.2 yamt #ifdef DEBUG 229 1.1.2.2 yamt if (sc == NULL) { 230 1.1.2.2 yamt printf("%s: called before start mvsoctmr\n", __func__); 231 1.1.2.2 yamt return; 232 1.1.2.2 yamt } 233 1.1.2.2 yamt #endif 234 1.1.2.2 yamt 235 1.1.2.2 yamt /* 236 1.1.2.2 yamt * Read the counter first, so that the rest of the setup overhead is 237 1.1.2.2 yamt * counted. 238 1.1.2.2 yamt */ 239 1.1.2.2 yamt initial_tick = bus_space_read_4(sc->sc_iot, sc->sc_ioh, 240 1.1.2.2 yamt MVSOCTMR_TIMER(MVSOCTMR_TIMER0)); 241 1.1.2.2 yamt 242 1.1.2.2 yamt if (n <= UINT_MAX / mvTclk) { 243 1.1.2.2 yamt /* 244 1.1.2.2 yamt * For unsigned arithmetic, division can be replaced with 245 1.1.2.2 yamt * multiplication with the inverse and a shift. 246 1.1.2.2 yamt */ 247 1.1.2.2 yamt remaining = n * mvTclk / 1000000; 248 1.1.2.2 yamt } else { 249 1.1.2.2 yamt /* 250 1.1.2.2 yamt * This is a very long delay. 251 1.1.2.2 yamt * Being slow here doesn't matter. 252 1.1.2.2 yamt */ 253 1.1.2.2 yamt remaining = (unsigned long long) n * mvTclk / 1000000; 254 1.1.2.2 yamt } 255 1.1.2.2 yamt 256 1.1.2.2 yamt while (remaining > 0) { 257 1.1.2.2 yamt cur_tick = bus_space_read_4(sc->sc_iot, sc->sc_ioh, 258 1.1.2.2 yamt MVSOCTMR_TIMER(MVSOCTMR_TIMER0)); 259 1.1.2.2 yamt if (cur_tick > initial_tick) 260 1.1.2.2 yamt remaining -= clock_ticks - cur_tick + initial_tick; 261 1.1.2.2 yamt else 262 1.1.2.2 yamt remaining -= (initial_tick - cur_tick); 263 1.1.2.2 yamt initial_tick = cur_tick; 264 1.1.2.2 yamt } 265 1.1.2.2 yamt } 266 1.1.2.2 yamt 267 1.1.2.2 yamt static u_int 268 1.1.2.2 yamt mvsoctmr_get_timecount(struct timecounter *tc) 269 1.1.2.2 yamt { 270 1.1.2.2 yamt struct mvsoctmr_softc *sc = mvsoctmr_sc; 271 1.1.2.2 yamt uint32_t counter, base; 272 1.1.2.2 yamt u_int intrstat; 273 1.1.2.2 yamt 274 1.1.2.2 yamt intrstat = disable_interrupts(I32_bit); 275 1.1.2.2 yamt base = mvsoctmr_base; 276 1.1.2.2 yamt counter = bus_space_read_4(sc->sc_iot, sc->sc_ioh, 277 1.1.2.2 yamt MVSOCTMR_TIMER(MVSOCTMR_TIMER0)); 278 1.1.2.2 yamt restore_interrupts(intrstat); 279 1.1.2.2 yamt 280 1.1.2.2 yamt return base - counter; 281 1.1.2.2 yamt } 282 1.1.2.2 yamt 283 1.1.2.2 yamt 284 1.1.2.2 yamt static void 285 1.1.2.2 yamt mvsoctmr_cntl(struct mvsoctmr_softc *sc, int num, u_int ticks, int en, 286 1.1.2.2 yamt int autoen) 287 1.1.2.2 yamt { 288 1.1.2.2 yamt uint32_t ctrl; 289 1.1.2.2 yamt 290 1.1.2.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVSOCTMR_RELOAD(num), 291 1.1.2.2 yamt ticks); 292 1.1.2.2 yamt 293 1.1.2.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVSOCTMR_TIMER(num), ticks); 294 1.1.2.2 yamt 295 1.1.2.2 yamt ctrl = bus_space_read_4(sc->sc_iot, sc->sc_ioh, MVSOCTMR_CTCR); 296 1.1.2.2 yamt if (en) 297 1.1.2.2 yamt ctrl |= MVSOCTMR_CTCR_CPUTIMEREN(num); 298 1.1.2.2 yamt else 299 1.1.2.2 yamt ctrl &= ~MVSOCTMR_CTCR_CPUTIMEREN(num); 300 1.1.2.2 yamt if (autoen) 301 1.1.2.2 yamt ctrl |= MVSOCTMR_CTCR_CPUTIMERAUTO(num); 302 1.1.2.2 yamt else 303 1.1.2.2 yamt ctrl &= ~MVSOCTMR_CTCR_CPUTIMERAUTO(num); 304 1.1.2.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVSOCTMR_CTCR, ctrl); 305 1.1.2.2 yamt } 306
Indexes created Tue Sep 30 07:10:03 GMT 2025