/* $NetBSD: sa11x0_ost.c,v 1.32.8.1 2019/11/16 16:35:00 martin Exp $ */ /* * Copyright (c) 1997 Mark Brinicombe. * Copyright (c) 1997 Causality Limited. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by IWAMOTO Toshihiro and Ichiro FUKUHARA. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the NetBSD * Foundation, Inc. and its contributors. * 4. Neither the name of The NetBSD Foundation nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include __KERNEL_RCSID(0, "$NetBSD: sa11x0_ost.c,v 1.32.8.1 2019/11/16 16:35:00 martin Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include static int saost_match(device_t, cfdata_t, void *); static void saost_attach(device_t, device_t, void *); static void saost_tc_init(void); static uint32_t gettick(void); static int clockintr(void *); static int statintr(void *); struct saost_softc { device_t sc_dev; bus_space_tag_t sc_iot; bus_space_handle_t sc_ioh; uint32_t sc_clock_count; uint32_t sc_statclock_count; uint32_t sc_statclock_step; }; static struct saost_softc *saost_sc = NULL; #define PXA270_OST_FREQ 3250000 /* PXA270 uses 3.25MHz */ #define SAOST_FREQ 3686400 /* Others use 3.6864MHz */ #define SAOST_MAXFREQ SAOST_FREQ #if defined(CPU_XSCALE_PXA270) && defined(CPU_XSCALE_PXA250) /* * On dynamic configuration, assume fastest frequency for early delay(9) * before tc_init(9), because longer delay(9) is almost harmless during * device probe and initialization. */ #include static uint32_t saost_freq = SAOST_MAXFREQ; #define TIMER_FREQUENCY saost_freq #elif defined(CPU_XSCALE_PXA270) #define TIMER_FREQUENCY PXA270_OST_FREQ #else #define TIMER_FREQUENCY SAOST_FREQ #endif #ifndef STATHZ #define STATHZ 64 #endif CFATTACH_DECL_NEW(saost, sizeof(struct saost_softc), saost_match, saost_attach, NULL, NULL); static int saost_match(device_t parent, cfdata_t match, void *aux) { struct sa11x0_attach_args *sa = aux; if (strcmp(sa->sa_name, match->cf_name) != 0) return 0; return 1; } static void saost_attach(device_t parent, device_t self, void *aux) { struct saost_softc *sc = device_private(self); struct sa11x0_attach_args *sa = aux; aprint_normal("\n"); sc->sc_dev = self; sc->sc_iot = sa->sa_iot; saost_sc = sc; if (bus_space_map(sa->sa_iot, sa->sa_addr, sa->sa_size, 0, &sc->sc_ioh)) panic("%s: Cannot map registers", device_xname(self)); /* disable all channel and clear interrupt status */ bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_IR, 0); bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_SR, 0xf); aprint_normal_dev(self, "SA-11x0 OS Timer\n"); } static int clockintr(void *arg) { struct saost_softc *sc = saost_sc; struct clockframe *frame = arg; uint32_t oscr, nextmatch, oldmatch; int s; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_SR, 1); /* schedule next clock intr */ oldmatch = sc->sc_clock_count; nextmatch = oldmatch + TIMER_FREQUENCY / hz; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR0, nextmatch); oscr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); if ((nextmatch > oldmatch && (oscr > nextmatch || oscr < oldmatch)) || (nextmatch < oldmatch && oscr > nextmatch && oscr < oldmatch)) { /* * we couldn't set the matching register in time. * just set it to some value so that next interrupt happens. * XXX is it possible to compensate lost interrupts? */ s = splhigh(); oscr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); nextmatch = oscr + 10; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR0, nextmatch); splx(s); } sc->sc_clock_count = nextmatch; hardclock(frame); return 1; } static int statintr(void *arg) { struct saost_softc *sc = saost_sc; struct clockframe *frame = arg; uint32_t oscr, nextmatch, oldmatch; int s; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_SR, 2); /* schedule next clock intr */ oldmatch = sc->sc_statclock_count; nextmatch = oldmatch + sc->sc_statclock_step; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR1, nextmatch); oscr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); if ((nextmatch > oldmatch && (oscr > nextmatch || oscr < oldmatch)) || (nextmatch < oldmatch && oscr > nextmatch && oscr < oldmatch)) { /* * we couldn't set the matching register in time. * just set it to some value so that next interrupt happens. * XXX is it possible to compensate lost interrupts? */ s = splhigh(); oscr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); nextmatch = oscr + 10; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR1, nextmatch); splx(s); } sc->sc_statclock_count = nextmatch; statclock(frame); return 1; } void setstatclockrate(int schz) { struct saost_softc *sc = saost_sc; uint32_t count; sc->sc_statclock_step = TIMER_FREQUENCY / schz; count = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); count += sc->sc_statclock_step; sc->sc_statclock_count = count; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR1, count); } void cpu_initclocks(void) { struct saost_softc *sc = saost_sc; stathz = STATHZ; profhz = stathz; #if defined(CPU_XSCALE_PXA270) && defined(CPU_XSCALE_PXA250) TIMER_FREQUENCY = (CPU_IS_PXA270) ? PXA270_OST_FREQ : SAOST_FREQ; #endif sc->sc_statclock_step = TIMER_FREQUENCY / stathz; aprint_normal("clock: hz=%d stathz=%d\n", hz, stathz); /* Use the channels 0 and 1 for hardclock and statclock, respectively */ sc->sc_clock_count = TIMER_FREQUENCY / hz; sc->sc_statclock_count = TIMER_FREQUENCY / stathz; sa11x0_intr_establish(0, 26, 1, IPL_CLOCK, clockintr, 0); sa11x0_intr_establish(0, 27, 1, IPL_CLOCK, statintr, 0); bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_SR, 0xf); bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_IR, 3); bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR0, sc->sc_clock_count); bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR1, sc->sc_statclock_count); /* Zero the counter value */ bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_CR, 0); saost_tc_init(); } static u_int saost_tc_get_timecount(struct timecounter *tc) { return (u_int)gettick(); } static void saost_tc_init(void) { static struct timecounter saost_tc = { .tc_get_timecount = saost_tc_get_timecount, .tc_counter_mask = ~0, .tc_name = "saost_count", #if !(defined(CPU_XSCALE_PXA270) && defined(CPU_XSCALE_PXA250)) .tc_frequency = TIMER_FREQUENCY, #endif .tc_quality = 100, }; #if defined(CPU_XSCALE_PXA270) && defined(CPU_XSCALE_PXA250) saost_tc.tc_frequency = TIMER_FREQUENCY; #endif tc_init(&saost_tc); } static uint32_t gettick(void) { struct saost_softc *sc = saost_sc; uint32_t counter; u_int saved_ints; saved_ints = disable_interrupts(I32_bit); counter = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); restore_interrupts(saved_ints); return counter; } void delay(u_int usecs) { uint32_t xtick, otick, delta; int csec, usec; csec = usecs / 10000; usec = usecs % 10000; usecs = (TIMER_FREQUENCY / 100) * csec + (TIMER_FREQUENCY / 100) * usec / 10000; if (saost_sc == NULL) { volatile int k = 0; int j; /* clock isn't initialized yet */ for (; usecs > 0; usecs--) for (j = 100; j > 0; j--, k--) continue; return; } otick = gettick(); while (1) { xtick = gettick(); delta = xtick - otick; if (delta > usecs) break; usecs -= delta; otick = xtick; } } void saost_reset(void) { struct saost_softc *sc = saost_sc; uint32_t counter; uint32_t saved_ints; saved_ints = disable_interrupts(I32_bit|F32_bit); counter = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SAOST_CR); counter += TIMER_FREQUENCY; bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_MR3, counter); /* Enable watchdog */ bus_space_write_4(sc->sc_iot, sc->sc_ioh, SAOST_WR, 1); delay(1 * 1000 * 1000); restore_interrupts(saved_ints); }