becc_timer.c revision 1.14 1 1.14 joerg /* $NetBSD: becc_timer.c,v 1.14 2008/01/20 16:28:24 joerg Exp $ */
2 1.1 thorpej
3 1.1 thorpej /*
4 1.1 thorpej * Copyright (c) 2001, 2002 Wasabi Systems, Inc.
5 1.1 thorpej * All rights reserved.
6 1.1 thorpej *
7 1.1 thorpej * Written by Jason R. Thorpe for Wasabi Systems, Inc.
8 1.1 thorpej *
9 1.1 thorpej * Redistribution and use in source and binary forms, with or without
10 1.1 thorpej * modification, are permitted provided that the following conditions
11 1.1 thorpej * are met:
12 1.1 thorpej * 1. Redistributions of source code must retain the above copyright
13 1.1 thorpej * notice, this list of conditions and the following disclaimer.
14 1.1 thorpej * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 thorpej * notice, this list of conditions and the following disclaimer in the
16 1.1 thorpej * documentation and/or other materials provided with the distribution.
17 1.1 thorpej * 3. All advertising materials mentioning features or use of this software
18 1.1 thorpej * must display the following acknowledgement:
19 1.1 thorpej * This product includes software developed for the NetBSD Project by
20 1.1 thorpej * Wasabi Systems, Inc.
21 1.1 thorpej * 4. The name of Wasabi Systems, Inc. may not be used to endorse
22 1.1 thorpej * or promote products derived from this software without specific prior
23 1.1 thorpej * written permission.
24 1.1 thorpej *
25 1.1 thorpej * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
26 1.1 thorpej * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
27 1.1 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
28 1.1 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
29 1.1 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30 1.1 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31 1.1 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32 1.1 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33 1.1 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34 1.1 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
35 1.1 thorpej * POSSIBILITY OF SUCH DAMAGE.
36 1.1 thorpej */
37 1.1 thorpej
38 1.1 thorpej /*
39 1.1 thorpej * Timer/clock support for the ADI Engineering Big Endian Companion Chip.
40 1.1 thorpej */
41 1.3 lukem
42 1.3 lukem #include <sys/cdefs.h>
43 1.14 joerg __KERNEL_RCSID(0, "$NetBSD: becc_timer.c,v 1.14 2008/01/20 16:28:24 joerg Exp $");
44 1.1 thorpej
45 1.1 thorpej #include <sys/param.h>
46 1.1 thorpej #include <sys/systm.h>
47 1.1 thorpej #include <sys/kernel.h>
48 1.14 joerg #include <sys/atomic.h>
49 1.1 thorpej #include <sys/time.h>
50 1.14 joerg #include <sys/timetc.h>
51 1.1 thorpej
52 1.4 thorpej #include <dev/clock_subr.h>
53 1.4 thorpej
54 1.1 thorpej #include <machine/bus.h>
55 1.1 thorpej #include <arm/cpufunc.h>
56 1.1 thorpej
57 1.1 thorpej #include <arm/xscale/beccreg.h>
58 1.1 thorpej #include <arm/xscale/beccvar.h>
59 1.1 thorpej
60 1.1 thorpej void (*becc_hardclock_hook)(void);
61 1.1 thorpej
62 1.1 thorpej /*
63 1.1 thorpej * Note, since COUNTS_PER_USEC doesn't divide evenly, we round up.
64 1.1 thorpej */
65 1.1 thorpej #define COUNTS_PER_SEC BECC_PERIPH_CLOCK
66 1.1 thorpej #define COUNTS_PER_USEC ((COUNTS_PER_SEC / 1000000) + 1)
67 1.1 thorpej
68 1.1 thorpej static void *clock_ih;
69 1.1 thorpej
70 1.14 joerg static u_int becc_get_timecount(struct timecounter *);
71 1.14 joerg
72 1.14 joerg static struct timecounter becc_timecounter = {
73 1.14 joerg becc_get_timecount, /* get_timecount */
74 1.14 joerg 0, /* no poll_pps */
75 1.14 joerg 0xffffffff, /* counter_mask */
76 1.14 joerg COUNTS_PER_SEC, /* frequency */
77 1.14 joerg "becc", /* name */
78 1.14 joerg 100, /* quality */
79 1.14 joerg NULL, /* prev */
80 1.14 joerg NULL, /* next */
81 1.14 joerg };
82 1.14 joerg
83 1.14 joerg static volatile uint32_t becc_base;
84 1.14 joerg
85 1.1 thorpej /*
86 1.1 thorpej * Since the timer interrupts when the counter underflows, we need to
87 1.1 thorpej * subtract 1 from counts_per_hz when loading the preload register.
88 1.1 thorpej */
89 1.1 thorpej static uint32_t counts_per_hz;
90 1.1 thorpej
91 1.1 thorpej int clockhandler(void *);
92 1.1 thorpej
93 1.1 thorpej /*
94 1.1 thorpej * becc_calibrate_delay:
95 1.1 thorpej *
96 1.1 thorpej * Calibrate the delay loop.
97 1.1 thorpej */
98 1.1 thorpej void
99 1.1 thorpej becc_calibrate_delay(void)
100 1.1 thorpej {
101 1.1 thorpej
102 1.1 thorpej /*
103 1.1 thorpej * Just use hz=100 for now -- we'll adjust it, if necessary,
104 1.1 thorpej * in cpu_initclocks().
105 1.1 thorpej */
106 1.1 thorpej counts_per_hz = COUNTS_PER_SEC / 100;
107 1.1 thorpej
108 1.1 thorpej /* Stop both timers, clear interrupts. */
109 1.1 thorpej BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TIF);
110 1.1 thorpej BECC_CSR_WRITE(BECC_TSCRB, TSCRx_TIF);
111 1.1 thorpej
112 1.1 thorpej /* Set the timer preload value. */
113 1.1 thorpej BECC_CSR_WRITE(BECC_TPRA, counts_per_hz - 1);
114 1.1 thorpej
115 1.1 thorpej /* Start the timer. */
116 1.1 thorpej BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM);
117 1.1 thorpej }
118 1.1 thorpej
119 1.1 thorpej /*
120 1.1 thorpej * cpu_initclocks:
121 1.1 thorpej *
122 1.1 thorpej * Initialize the clock and get them going.
123 1.1 thorpej */
124 1.1 thorpej void
125 1.1 thorpej cpu_initclocks(void)
126 1.1 thorpej {
127 1.1 thorpej u_int oldirqstate;
128 1.1 thorpej
129 1.1 thorpej #if 0
130 1.1 thorpej if (hz < 50 || COUNTS_PER_SEC % hz) {
131 1.1 thorpej printf("Cannot get %d Hz clock; using 100 Hz\n", hz);
132 1.1 thorpej hz = 100;
133 1.1 thorpej }
134 1.1 thorpej #endif
135 1.1 thorpej
136 1.1 thorpej /*
137 1.1 thorpej * We only have one timer available; stathz and profhz are
138 1.1 thorpej * always left as 0 (the upper-layer clock code deals with
139 1.1 thorpej * this situation).
140 1.1 thorpej */
141 1.1 thorpej if (stathz != 0)
142 1.1 thorpej printf("Cannot get %d Hz statclock\n", stathz);
143 1.1 thorpej stathz = 0;
144 1.1 thorpej
145 1.1 thorpej if (profhz != 0)
146 1.1 thorpej printf("Cannot get %d Hz profclock\n", profhz);
147 1.1 thorpej profhz = 0;
148 1.1 thorpej
149 1.1 thorpej /* Report the clock frequency. */
150 1.2 briggs aprint_normal("clock: hz=%d stathz=%d profhz=%d\n", hz, stathz, profhz);
151 1.1 thorpej
152 1.1 thorpej oldirqstate = disable_interrupts(I32_bit);
153 1.1 thorpej
154 1.1 thorpej /* Hook up the clock interrupt handler. */
155 1.1 thorpej clock_ih = becc_intr_establish(ICU_TIMERA, IPL_CLOCK,
156 1.1 thorpej clockhandler, NULL);
157 1.1 thorpej if (clock_ih == NULL)
158 1.1 thorpej panic("cpu_initclocks: unable to register timer interrupt");
159 1.1 thorpej
160 1.1 thorpej /* Set up the new clock parameters. */
161 1.1 thorpej
162 1.1 thorpej /* Stop timer, clear interrupt */
163 1.1 thorpej BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TIF);
164 1.1 thorpej
165 1.1 thorpej counts_per_hz = COUNTS_PER_SEC / hz;
166 1.1 thorpej
167 1.1 thorpej /* Set the timer preload value. */
168 1.1 thorpej BECC_CSR_WRITE(BECC_TPRA, counts_per_hz - 1);
169 1.1 thorpej
170 1.1 thorpej /* ...and start it in motion. */
171 1.1 thorpej BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM);
172 1.1 thorpej
173 1.13 matt #ifdef __HAVE_FAST_SOFTINTS
174 1.1 thorpej /* register soft interrupt handler as well */
175 1.12 ad becc_intr_establish(ICU_SOFT, IPL_SOFTCLOCK, becc_softint, NULL);
176 1.13 matt #endif
177 1.1 thorpej
178 1.1 thorpej restore_interrupts(oldirqstate);
179 1.14 joerg
180 1.14 joerg tc_init(&becc_timecounter);
181 1.1 thorpej }
182 1.1 thorpej
183 1.1 thorpej /*
184 1.1 thorpej * setstatclockrate:
185 1.1 thorpej *
186 1.1 thorpej * Set the rate of the statistics clock.
187 1.1 thorpej *
188 1.1 thorpej * We assume that hz is either stathz or profhz, and that neither
189 1.1 thorpej * will change after being set by cpu_initclocks(). We could
190 1.1 thorpej * recalculate the intervals here, but that would be a pain.
191 1.1 thorpej */
192 1.1 thorpej void
193 1.7 rearnsha setstatclockrate(int new_hz)
194 1.1 thorpej {
195 1.1 thorpej
196 1.1 thorpej /*
197 1.1 thorpej * XXX Use TMR1?
198 1.1 thorpej */
199 1.1 thorpej }
200 1.1 thorpej
201 1.14 joerg static u_int
202 1.14 joerg becc_get_timecount(struct timecounter *tc)
203 1.1 thorpej {
204 1.14 joerg uint32_t counter, base;
205 1.1 thorpej u_int oldirqstate;
206 1.1 thorpej
207 1.1 thorpej oldirqstate = disable_interrupts(I32_bit);
208 1.14 joerg counter = BECC_CSR_READ(BECC_TCVRA);
209 1.14 joerg base = becc_base;
210 1.14 joerg restore_interrupts(oldirqstate);
211 1.1 thorpej
212 1.14 joerg return base - counter;
213 1.1 thorpej }
214 1.1 thorpej
215 1.1 thorpej /*
216 1.1 thorpej * delay:
217 1.1 thorpej *
218 1.1 thorpej * Delay for at least N microseconds.
219 1.1 thorpej */
220 1.1 thorpej void
221 1.1 thorpej delay(u_int n)
222 1.1 thorpej {
223 1.1 thorpej uint32_t cur, last, delta, usecs;
224 1.1 thorpej
225 1.1 thorpej /*
226 1.1 thorpej * This works by polling the timer and counting the
227 1.1 thorpej * number of microseconds that go by.
228 1.1 thorpej */
229 1.1 thorpej last = BECC_CSR_READ(BECC_TCVRA);
230 1.1 thorpej delta = usecs = 0;
231 1.1 thorpej
232 1.1 thorpej while (n > usecs) {
233 1.1 thorpej cur = BECC_CSR_READ(BECC_TCVRA);
234 1.1 thorpej
235 1.1 thorpej /* Check to see if the timer has wrapped around. */
236 1.1 thorpej if (last < cur)
237 1.1 thorpej delta += (last + (counts_per_hz - cur));
238 1.1 thorpej else
239 1.1 thorpej delta += (last - cur);
240 1.1 thorpej
241 1.1 thorpej last = cur;
242 1.1 thorpej
243 1.1 thorpej if (delta >= COUNTS_PER_USEC) {
244 1.1 thorpej usecs += delta / COUNTS_PER_USEC;
245 1.1 thorpej delta %= COUNTS_PER_USEC;
246 1.1 thorpej }
247 1.1 thorpej }
248 1.1 thorpej }
249 1.1 thorpej
250 1.1 thorpej /*
251 1.1 thorpej * clockhandler:
252 1.1 thorpej *
253 1.1 thorpej * Handle the hardclock interrupt.
254 1.1 thorpej */
255 1.1 thorpej int
256 1.1 thorpej clockhandler(void *arg)
257 1.1 thorpej {
258 1.1 thorpej struct clockframe *frame = arg;
259 1.1 thorpej
260 1.1 thorpej /* ACK the interrupt. */
261 1.1 thorpej BECC_CSR_WRITE(BECC_TSCRA, TSCRx_TE | TSCRx_CM | TSCRx_TIF);
262 1.1 thorpej
263 1.1 thorpej hardclock(frame);
264 1.1 thorpej
265 1.14 joerg atomic_add_32(&becc_base, counts_per_hz);
266 1.14 joerg
267 1.1 thorpej if (becc_hardclock_hook != NULL)
268 1.1 thorpej (*becc_hardclock_hook)();
269 1.1 thorpej
270 1.1 thorpej return (1);
271 1.1 thorpej }
272