imxclock.c revision 1.7.28.1
1 1.7.28.1 martin /* $NetBSD: imxclock.c,v 1.7.28.1 2020/04/13 08:03:35 martin Exp $ */ 2 1.3 bsh /* 3 1.3 bsh * Copyright (c) 2009, 2010 Genetec corp. All rights reserved. 4 1.3 bsh * Written by Hashimoto Kenichi for Genetec corp. 5 1.3 bsh * 6 1.3 bsh * Redistribution and use in source and binary forms, with or without 7 1.3 bsh * modification, are permitted provided that the following conditions 8 1.3 bsh * are met: 9 1.3 bsh * 1. Redistributions of source code must retain the above copyright 10 1.3 bsh * notice, this list of conditions and the following disclaimer. 11 1.3 bsh * 2. Redistributions in binary form must reproduce the above copyright 12 1.3 bsh * notice, this list of conditions and the following disclaimer in the 13 1.3 bsh * documentation and/or other materials provided with the distribution. 14 1.3 bsh * 15 1.3 bsh * THIS SOFTWARE IS PROVIDED BY GENETEC CORP. ``AS IS'' AND 16 1.3 bsh * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 17 1.3 bsh * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 18 1.3 bsh * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL GENETEC CORP. 19 1.3 bsh * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 20 1.3 bsh * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 21 1.3 bsh * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 22 1.3 bsh * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 23 1.3 bsh * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 24 1.3 bsh * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25 1.3 bsh * POSSIBILITY OF SUCH DAMAGE. 26 1.3 bsh */ 27 1.3 bsh 28 1.3 bsh /* 29 1.3 bsh * common part for i.MX31 and i.MX51 30 1.3 bsh */ 31 1.3 bsh 32 1.7 hkenken #include <sys/cdefs.h> 33 1.7 hkenken __KERNEL_RCSID(0, "$NetBSD: imxclock.c,v 1.7.28.1 2020/04/13 08:03:35 martin Exp $"); 34 1.7 hkenken 35 1.7 hkenken #include "opt_imx.h" 36 1.7 hkenken 37 1.3 bsh #include <sys/param.h> 38 1.3 bsh #include <sys/systm.h> 39 1.3 bsh #include <sys/kernel.h> 40 1.3 bsh #include <sys/evcnt.h> 41 1.3 bsh #include <sys/atomic.h> 42 1.3 bsh #include <sys/time.h> 43 1.3 bsh #include <sys/timetc.h> 44 1.3 bsh 45 1.2 matt #include <sys/types.h> 46 1.3 bsh #include <sys/device.h> 47 1.3 bsh 48 1.3 bsh #include <machine/intr.h> 49 1.4 dyoung #include <sys/bus.h> 50 1.3 bsh 51 1.3 bsh #include <arm/cpu.h> 52 1.3 bsh #include <arm/armreg.h> 53 1.3 bsh #include <arm/cpufunc.h> 54 1.3 bsh 55 1.3 bsh #include <arm/imx/imxclockvar.h> 56 1.3 bsh #include <arm/imx/imxepitreg.h> 57 1.3 bsh 58 1.3 bsh static u_int imx_epit_get_timecount(struct timecounter *); 59 1.3 bsh static int imxclock_intr(void *); 60 1.3 bsh 61 1.3 bsh static struct timecounter imx_epit_timecounter = { 62 1.3 bsh imx_epit_get_timecount, /* get_timecount */ 63 1.3 bsh 0, /* no poll_pps */ 64 1.3 bsh 0xffffffff, /* counter_mask */ 65 1.3 bsh 0, /* frequency */ 66 1.3 bsh "epit", /* name */ 67 1.3 bsh 100, /* quality */ 68 1.3 bsh NULL, /* prev */ 69 1.3 bsh NULL, /* next */ 70 1.3 bsh }; 71 1.3 bsh 72 1.3 bsh static volatile uint32_t imxclock_base; 73 1.7 hkenken struct imxclock_softc *imxclock = NULL; 74 1.2 matt 75 1.2 matt void 76 1.2 matt cpu_initclocks(void) 77 1.2 matt { 78 1.3 bsh uint32_t reg; 79 1.5 bsh u_int freq; 80 1.3 bsh 81 1.7 hkenken if (epit1_sc != NULL) 82 1.7 hkenken imxclock = epit1_sc; 83 1.7 hkenken else if (epit2_sc != NULL) 84 1.7 hkenken imxclock = epit2_sc; 85 1.7 hkenken else 86 1.3 bsh panic("%s: driver has not been initialized!", __FUNCTION__); 87 1.3 bsh 88 1.7 hkenken freq = imxclock_get_timerfreq(imxclock); 89 1.3 bsh imx_epit_timecounter.tc_frequency = freq; 90 1.3 bsh tc_init(&imx_epit_timecounter); 91 1.3 bsh 92 1.7 hkenken aprint_verbose_dev(imxclock->sc_dev, 93 1.7 hkenken "timer clock frequency %d\n", freq); 94 1.5 bsh 95 1.7 hkenken imxclock->sc_reload_value = freq / hz - 1; 96 1.3 bsh 97 1.7 hkenken /* stop timers */ 98 1.7 hkenken bus_space_write_4(imxclock->sc_iot, imxclock->sc_ioh, EPIT_EPITCR, 0); 99 1.3 bsh 100 1.3 bsh aprint_normal("clock: hz=%d stathz = %d\n", hz, stathz); 101 1.3 bsh 102 1.7 hkenken bus_space_write_4(imxclock->sc_iot, imxclock->sc_ioh, EPIT_EPITLR, 103 1.7 hkenken imxclock->sc_reload_value); 104 1.7 hkenken bus_space_write_4(imxclock->sc_iot, imxclock->sc_ioh, EPIT_EPITCMPR, 0); 105 1.3 bsh 106 1.7 hkenken reg = EPITCR_ENMOD | EPITCR_IOVW | EPITCR_RLD | imxclock->sc_clksrc; 107 1.7 hkenken bus_space_write_4(imxclock->sc_iot, imxclock->sc_ioh, 108 1.5 bsh EPIT_EPITCR, reg); 109 1.5 bsh reg |= EPITCR_EN | EPITCR_OCIEN | EPITCR_WAITEN | EPITCR_DOZEN | 110 1.5 bsh EPITCR_STOPEN; 111 1.7 hkenken bus_space_write_4(imxclock->sc_iot, imxclock->sc_ioh, 112 1.5 bsh EPIT_EPITCR, reg); 113 1.3 bsh 114 1.7.28.1 martin imxclock->sc_ih = intr_establish(imxclock->sc_intr, IPL_CLOCK, 115 1.6 matt IST_LEVEL, imxclock_intr, NULL); 116 1.2 matt } 117 1.2 matt 118 1.2 matt void 119 1.2 matt setstatclockrate(int schz) 120 1.2 matt { 121 1.2 matt } 122 1.3 bsh 123 1.3 bsh static int 124 1.3 bsh imxclock_intr(void *arg) 125 1.3 bsh { 126 1.7 hkenken struct imxclock_softc *sc = imxclock; 127 1.3 bsh 128 1.3 bsh bus_space_write_4(sc->sc_iot, sc->sc_ioh, EPIT_EPITSR, 1); 129 1.3 bsh atomic_add_32(&imxclock_base, sc->sc_reload_value); 130 1.3 bsh 131 1.3 bsh hardclock((struct clockframe *)arg); 132 1.3 bsh 133 1.3 bsh return 1; 134 1.3 bsh } 135 1.3 bsh 136 1.3 bsh u_int 137 1.3 bsh imx_epit_get_timecount(struct timecounter *tc) 138 1.3 bsh { 139 1.3 bsh uint32_t counter; 140 1.3 bsh uint32_t base; 141 1.3 bsh u_int oldirqstate; 142 1.3 bsh 143 1.3 bsh oldirqstate = disable_interrupts(I32_bit); 144 1.7 hkenken counter = bus_space_read_4(imxclock->sc_iot, imxclock->sc_ioh, EPIT_EPITCNT); 145 1.3 bsh base = imxclock_base; 146 1.3 bsh restore_interrupts(oldirqstate); 147 1.3 bsh 148 1.3 bsh return base - counter; 149 1.3 bsh } 150
Indexes created Tue Sep 30 06:09:59 GMT 2025