i80321_timer.c revision 1.1.2.2
1 1.1.2.2 nathanw /* $NetBSD: i80321_timer.c,v 1.1.2.2 2002/04/01 07:39:16 nathanw Exp $ */ 2 1.1.2.2 nathanw 3 1.1.2.2 nathanw /* 4 1.1.2.2 nathanw * Copyright (c) 2001, 2002 Wasabi Systems, Inc. 5 1.1.2.2 nathanw * All rights reserved. 6 1.1.2.2 nathanw * 7 1.1.2.2 nathanw * Written by Jason R. Thorpe for Wasabi Systems, Inc. 8 1.1.2.2 nathanw * 9 1.1.2.2 nathanw * Redistribution and use in source and binary forms, with or without 10 1.1.2.2 nathanw * modification, are permitted provided that the following conditions 11 1.1.2.2 nathanw * are met: 12 1.1.2.2 nathanw * 1. Redistributions of source code must retain the above copyright 13 1.1.2.2 nathanw * notice, this list of conditions and the following disclaimer. 14 1.1.2.2 nathanw * 2. Redistributions in binary form must reproduce the above copyright 15 1.1.2.2 nathanw * notice, this list of conditions and the following disclaimer in the 16 1.1.2.2 nathanw * documentation and/or other materials provided with the distribution. 17 1.1.2.2 nathanw * 3. All advertising materials mentioning features or use of this software 18 1.1.2.2 nathanw * must display the following acknowledgement: 19 1.1.2.2 nathanw * This product includes software developed for the NetBSD Project by 20 1.1.2.2 nathanw * Wasabi Systems, Inc. 21 1.1.2.2 nathanw * 4. The name of Wasabi Systems, Inc. may not be used to endorse 22 1.1.2.2 nathanw * or promote products derived from this software without specific prior 23 1.1.2.2 nathanw * written permission. 24 1.1.2.2 nathanw * 25 1.1.2.2 nathanw * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 26 1.1.2.2 nathanw * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 27 1.1.2.2 nathanw * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 28 1.1.2.2 nathanw * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 29 1.1.2.2 nathanw * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 30 1.1.2.2 nathanw * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 31 1.1.2.2 nathanw * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 32 1.1.2.2 nathanw * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 33 1.1.2.2 nathanw * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 34 1.1.2.2 nathanw * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 35 1.1.2.2 nathanw * POSSIBILITY OF SUCH DAMAGE. 36 1.1.2.2 nathanw */ 37 1.1.2.2 nathanw 38 1.1.2.2 nathanw /* 39 1.1.2.2 nathanw * Timer/clock support for the Intel i80321 I/O processor. 40 1.1.2.2 nathanw */ 41 1.1.2.2 nathanw 42 1.1.2.2 nathanw #include <sys/param.h> 43 1.1.2.2 nathanw #include <sys/systm.h> 44 1.1.2.2 nathanw #include <sys/kernel.h> 45 1.1.2.2 nathanw #include <sys/time.h> 46 1.1.2.2 nathanw 47 1.1.2.2 nathanw #include <machine/bus.h> 48 1.1.2.2 nathanw #include <arm/cpufunc.h> 49 1.1.2.2 nathanw 50 1.1.2.2 nathanw #include <arm/xscale/i80321reg.h> 51 1.1.2.2 nathanw #include <arm/xscale/i80321var.h> 52 1.1.2.2 nathanw 53 1.1.2.2 nathanw void (*i80321_hardclock_hook)(void); 54 1.1.2.2 nathanw 55 1.1.2.2 nathanw #define COUNTS_PER_SEC 200000000 /* 200MHz */ 56 1.1.2.2 nathanw #define COUNTS_PER_USEC (COUNTS_PER_SEC / 1000000) 57 1.1.2.2 nathanw 58 1.1.2.2 nathanw static void *clock_ih; 59 1.1.2.2 nathanw 60 1.1.2.2 nathanw static uint32_t counts_per_hz; 61 1.1.2.2 nathanw 62 1.1.2.2 nathanw int clockhandler(void *); 63 1.1.2.2 nathanw 64 1.1.2.2 nathanw static __inline uint32_t 65 1.1.2.2 nathanw tmr0_read(void) 66 1.1.2.2 nathanw { 67 1.1.2.2 nathanw uint32_t rv; 68 1.1.2.2 nathanw 69 1.1.2.2 nathanw __asm __volatile("mrc p6, 0, %0, c0, c1, 0" 70 1.1.2.2 nathanw : "=r" (rv)); 71 1.1.2.2 nathanw return (rv); 72 1.1.2.2 nathanw } 73 1.1.2.2 nathanw 74 1.1.2.2 nathanw static __inline void 75 1.1.2.2 nathanw tmr0_write(uint32_t val) 76 1.1.2.2 nathanw { 77 1.1.2.2 nathanw 78 1.1.2.2 nathanw __asm __volatile("mcr p6, 0, %0, c0, c1, 0" 79 1.1.2.2 nathanw : 80 1.1.2.2 nathanw : "r" (val)); 81 1.1.2.2 nathanw } 82 1.1.2.2 nathanw 83 1.1.2.2 nathanw static __inline uint32_t 84 1.1.2.2 nathanw tcr0_read(void) 85 1.1.2.2 nathanw { 86 1.1.2.2 nathanw uint32_t rv; 87 1.1.2.2 nathanw 88 1.1.2.2 nathanw __asm __volatile("mrc p6, 0, %0, c2, c1, 0" 89 1.1.2.2 nathanw : "=r" (rv)); 90 1.1.2.2 nathanw return (rv); 91 1.1.2.2 nathanw } 92 1.1.2.2 nathanw 93 1.1.2.2 nathanw static __inline void 94 1.1.2.2 nathanw tcr0_write(uint32_t val) 95 1.1.2.2 nathanw { 96 1.1.2.2 nathanw 97 1.1.2.2 nathanw __asm __volatile("mcr p6, 0, %0, c2, c1, 0" 98 1.1.2.2 nathanw : 99 1.1.2.2 nathanw : "r" (val)); 100 1.1.2.2 nathanw } 101 1.1.2.2 nathanw 102 1.1.2.2 nathanw static __inline void 103 1.1.2.2 nathanw trr0_write(uint32_t val) 104 1.1.2.2 nathanw { 105 1.1.2.2 nathanw 106 1.1.2.2 nathanw __asm __volatile("mcr p6, 0, %0, c4, c1, 0" 107 1.1.2.2 nathanw : 108 1.1.2.2 nathanw : "r" (val)); 109 1.1.2.2 nathanw } 110 1.1.2.2 nathanw 111 1.1.2.2 nathanw static __inline void 112 1.1.2.2 nathanw tisr_write(uint32_t val) 113 1.1.2.2 nathanw { 114 1.1.2.2 nathanw 115 1.1.2.2 nathanw __asm __volatile("mcr p6, 0, %0, c6, c1, 0" 116 1.1.2.2 nathanw : 117 1.1.2.2 nathanw : "r" (val)); 118 1.1.2.2 nathanw } 119 1.1.2.2 nathanw 120 1.1.2.2 nathanw /* 121 1.1.2.2 nathanw * i80321_calibrate_delay: 122 1.1.2.2 nathanw * 123 1.1.2.2 nathanw * Calibrate the delay loop. 124 1.1.2.2 nathanw */ 125 1.1.2.2 nathanw void 126 1.1.2.2 nathanw i80321_calibrate_delay(void) 127 1.1.2.2 nathanw { 128 1.1.2.2 nathanw 129 1.1.2.2 nathanw /* 130 1.1.2.2 nathanw * Just use hz=100 for now -- we'll adjust it, if necessary, 131 1.1.2.2 nathanw * in cpu_initclocks(). 132 1.1.2.2 nathanw */ 133 1.1.2.2 nathanw counts_per_hz = COUNTS_PER_SEC / 100; 134 1.1.2.2 nathanw 135 1.1.2.2 nathanw tmr0_write(0); /* stop timer */ 136 1.1.2.2 nathanw tisr_write(TISR_TMR0); /* clear interrupt */ 137 1.1.2.2 nathanw trr0_write(counts_per_hz); /* reload value */ 138 1.1.2.2 nathanw tcr0_write(counts_per_hz); /* current value */ 139 1.1.2.2 nathanw 140 1.1.2.2 nathanw tmr0_write(TMRx_ENABLE|TMRx_RELOAD|TMRx_CSEL_CORE); 141 1.1.2.2 nathanw } 142 1.1.2.2 nathanw 143 1.1.2.2 nathanw /* 144 1.1.2.2 nathanw * cpu_initclocks: 145 1.1.2.2 nathanw * 146 1.1.2.2 nathanw * Initialize the clock and get them going. 147 1.1.2.2 nathanw */ 148 1.1.2.2 nathanw void 149 1.1.2.2 nathanw cpu_initclocks(void) 150 1.1.2.2 nathanw { 151 1.1.2.2 nathanw u_int oldirqstate; 152 1.1.2.2 nathanw 153 1.1.2.2 nathanw if (hz < 50 || COUNTS_PER_SEC % hz) { 154 1.1.2.2 nathanw printf("Cannot get %d Hz clock; using 100 Hz\n", hz); 155 1.1.2.2 nathanw hz = 100; 156 1.1.2.2 nathanw } 157 1.1.2.2 nathanw tick = 1000000 / hz; /* number of microseconds between interrupts */ 158 1.1.2.2 nathanw tickfix = 1000000 - (hz * tick); 159 1.1.2.2 nathanw if (tickfix) { 160 1.1.2.2 nathanw int ftp; 161 1.1.2.2 nathanw 162 1.1.2.2 nathanw ftp = min(ffs(tickfix), ffs(hz)); 163 1.1.2.2 nathanw tickfix >>= (ftp - 1); 164 1.1.2.2 nathanw tickfixinterval = hz >> (ftp - 1); 165 1.1.2.2 nathanw } 166 1.1.2.2 nathanw 167 1.1.2.2 nathanw /* 168 1.1.2.2 nathanw * We only have one timer available; stathz and profhz are 169 1.1.2.2 nathanw * always left as 0 (the upper-layer clock code deals with 170 1.1.2.2 nathanw * this situation). 171 1.1.2.2 nathanw */ 172 1.1.2.2 nathanw if (stathz != 0) 173 1.1.2.2 nathanw printf("Cannot get %d Hz statclock\n", stathz); 174 1.1.2.2 nathanw stathz = 0; 175 1.1.2.2 nathanw 176 1.1.2.2 nathanw if (profhz != 0) 177 1.1.2.2 nathanw printf("Cannot get %d Hz profclock\n", profhz); 178 1.1.2.2 nathanw profhz = 0; 179 1.1.2.2 nathanw 180 1.1.2.2 nathanw /* Report the clock frequency. */ 181 1.1.2.2 nathanw printf("clock: hz=%d stathz=%d profhz=%d\n", hz, stathz, profhz); 182 1.1.2.2 nathanw 183 1.1.2.2 nathanw oldirqstate = disable_interrupts(I32_bit); 184 1.1.2.2 nathanw 185 1.1.2.2 nathanw /* Hook up the clock interrupt handler. */ 186 1.1.2.2 nathanw clock_ih = i80321_intr_establish(ICU_INT_TMR0, IPL_CLOCK, 187 1.1.2.2 nathanw clockhandler, NULL); 188 1.1.2.2 nathanw if (clock_ih == NULL) 189 1.1.2.2 nathanw panic("cpu_initclocks: unable to register timer interrupt"); 190 1.1.2.2 nathanw 191 1.1.2.2 nathanw /* Set up the new clock parameters. */ 192 1.1.2.2 nathanw 193 1.1.2.2 nathanw tmr0_write(0); /* stop timer */ 194 1.1.2.2 nathanw tisr_write(TISR_TMR0); /* clear interrupt */ 195 1.1.2.2 nathanw 196 1.1.2.2 nathanw counts_per_hz = COUNTS_PER_SEC / hz; 197 1.1.2.2 nathanw 198 1.1.2.2 nathanw trr0_write(counts_per_hz); /* reload value */ 199 1.1.2.2 nathanw tcr0_write(counts_per_hz); /* current value */ 200 1.1.2.2 nathanw 201 1.1.2.2 nathanw tmr0_write(TMRx_ENABLE|TMRx_RELOAD|TMRx_CSEL_CORE); 202 1.1.2.2 nathanw 203 1.1.2.2 nathanw restore_interrupts(oldirqstate); 204 1.1.2.2 nathanw } 205 1.1.2.2 nathanw 206 1.1.2.2 nathanw /* 207 1.1.2.2 nathanw * setstatclockrate: 208 1.1.2.2 nathanw * 209 1.1.2.2 nathanw * Set the rate of the statistics clock. 210 1.1.2.2 nathanw * 211 1.1.2.2 nathanw * We assume that hz is either stathz or profhz, and that neither 212 1.1.2.2 nathanw * will change after being set by cpu_initclocks(). We could 213 1.1.2.2 nathanw * recalculate the intervals here, but that would be a pain. 214 1.1.2.2 nathanw */ 215 1.1.2.2 nathanw void 216 1.1.2.2 nathanw setstatclockrate(int hz) 217 1.1.2.2 nathanw { 218 1.1.2.2 nathanw 219 1.1.2.2 nathanw /* 220 1.1.2.2 nathanw * XXX Use TMR1? 221 1.1.2.2 nathanw */ 222 1.1.2.2 nathanw } 223 1.1.2.2 nathanw 224 1.1.2.2 nathanw /* 225 1.1.2.2 nathanw * microtime: 226 1.1.2.2 nathanw * 227 1.1.2.2 nathanw * Fill in the specified timeval struct with the current time 228 1.1.2.2 nathanw * accurate to the microsecond. 229 1.1.2.2 nathanw */ 230 1.1.2.2 nathanw void 231 1.1.2.2 nathanw microtime(struct timeval *tvp) 232 1.1.2.2 nathanw { 233 1.1.2.2 nathanw static struct timeval lasttv; 234 1.1.2.2 nathanw u_int oldirqstate; 235 1.1.2.2 nathanw uint32_t counts; 236 1.1.2.2 nathanw 237 1.1.2.2 nathanw oldirqstate = disable_interrupts(I32_bit); 238 1.1.2.2 nathanw 239 1.1.2.2 nathanw counts = counts_per_hz - tcr0_read(); 240 1.1.2.2 nathanw 241 1.1.2.2 nathanw /* Fill in the timeval struct. */ 242 1.1.2.2 nathanw *tvp = time; 243 1.1.2.2 nathanw tvp->tv_usec += (counts / COUNTS_PER_USEC); 244 1.1.2.2 nathanw 245 1.1.2.2 nathanw /* Make sure microseconds doesn't overflow. */ 246 1.1.2.2 nathanw while (tvp->tv_usec >= 1000000) { 247 1.1.2.2 nathanw tvp->tv_usec -= 1000000; 248 1.1.2.2 nathanw tvp->tv_sec++; 249 1.1.2.2 nathanw } 250 1.1.2.2 nathanw 251 1.1.2.2 nathanw /* Make sure the time has advanced. */ 252 1.1.2.2 nathanw if (tvp->tv_sec == lasttv.tv_sec && 253 1.1.2.2 nathanw tvp->tv_usec <= lasttv.tv_usec) { 254 1.1.2.2 nathanw tvp->tv_usec = lasttv.tv_usec + 1; 255 1.1.2.2 nathanw if (tvp->tv_usec >= 1000000) { 256 1.1.2.2 nathanw tvp->tv_usec -= 1000000; 257 1.1.2.2 nathanw tvp->tv_sec++; 258 1.1.2.2 nathanw } 259 1.1.2.2 nathanw } 260 1.1.2.2 nathanw 261 1.1.2.2 nathanw lasttv = *tvp; 262 1.1.2.2 nathanw 263 1.1.2.2 nathanw restore_interrupts(oldirqstate); 264 1.1.2.2 nathanw } 265 1.1.2.2 nathanw 266 1.1.2.2 nathanw /* 267 1.1.2.2 nathanw * delay: 268 1.1.2.2 nathanw * 269 1.1.2.2 nathanw * Delay for at least N microseconds. 270 1.1.2.2 nathanw */ 271 1.1.2.2 nathanw void 272 1.1.2.2 nathanw delay(u_int n) 273 1.1.2.2 nathanw { 274 1.1.2.2 nathanw uint32_t cur, last, delta, usecs; 275 1.1.2.2 nathanw 276 1.1.2.2 nathanw /* 277 1.1.2.2 nathanw * This works by polling the timer and counting the 278 1.1.2.2 nathanw * number of microseconds that go by. 279 1.1.2.2 nathanw */ 280 1.1.2.2 nathanw last = tcr0_read(); 281 1.1.2.2 nathanw delta = usecs = 0; 282 1.1.2.2 nathanw 283 1.1.2.2 nathanw while (n > usecs) { 284 1.1.2.2 nathanw cur = tcr0_read(); 285 1.1.2.2 nathanw 286 1.1.2.2 nathanw /* Check to see if the timer has wrapped around. */ 287 1.1.2.2 nathanw if (last < cur) 288 1.1.2.2 nathanw delta += (last + (counts_per_hz - cur)); 289 1.1.2.2 nathanw else 290 1.1.2.2 nathanw delta += (last - cur); 291 1.1.2.2 nathanw 292 1.1.2.2 nathanw last = cur; 293 1.1.2.2 nathanw 294 1.1.2.2 nathanw if (delta >= COUNTS_PER_USEC) { 295 1.1.2.2 nathanw usecs += delta / COUNTS_PER_USEC; 296 1.1.2.2 nathanw delta %= COUNTS_PER_USEC; 297 1.1.2.2 nathanw } 298 1.1.2.2 nathanw } 299 1.1.2.2 nathanw } 300 1.1.2.2 nathanw 301 1.1.2.2 nathanw /* 302 1.1.2.2 nathanw * inittodr: 303 1.1.2.2 nathanw * 304 1.1.2.2 nathanw * Initialize time from the time-of-day register. 305 1.1.2.2 nathanw */ 306 1.1.2.2 nathanw void 307 1.1.2.2 nathanw inittodr(time_t base) 308 1.1.2.2 nathanw { 309 1.1.2.2 nathanw 310 1.1.2.2 nathanw time.tv_sec = base; 311 1.1.2.2 nathanw time.tv_usec = 0; 312 1.1.2.2 nathanw } 313 1.1.2.2 nathanw 314 1.1.2.2 nathanw /* 315 1.1.2.2 nathanw * resettodr: 316 1.1.2.2 nathanw * 317 1.1.2.2 nathanw * Reset the time-of-day register with the current time. 318 1.1.2.2 nathanw */ 319 1.1.2.2 nathanw void 320 1.1.2.2 nathanw resettodr(void) 321 1.1.2.2 nathanw { 322 1.1.2.2 nathanw } 323 1.1.2.2 nathanw 324 1.1.2.2 nathanw /* 325 1.1.2.2 nathanw * clockhandler: 326 1.1.2.2 nathanw * 327 1.1.2.2 nathanw * Handle the hardclock interrupt. 328 1.1.2.2 nathanw */ 329 1.1.2.2 nathanw int 330 1.1.2.2 nathanw clockhandler(void *arg) 331 1.1.2.2 nathanw { 332 1.1.2.2 nathanw struct clockframe *frame = arg; 333 1.1.2.2 nathanw 334 1.1.2.2 nathanw tisr_write(TISR_TMR0); 335 1.1.2.2 nathanw 336 1.1.2.2 nathanw hardclock(frame); 337 1.1.2.2 nathanw 338 1.1.2.2 nathanw if (i80321_hardclock_hook != NULL) 339 1.1.2.2 nathanw (*i80321_hardclock_hook)(); 340 1.1.2.2 nathanw 341 1.1.2.2 nathanw return (1); 342 1.1.2.2 nathanw } 343
Indexes created Thu Oct 02 14:10:14 GMT 2025