Rev 238 | Rev 243 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
120 | giacomo | 1 | /* Project: OSLib |
2 | * Description: The OS Construction Kit |
||
3 | * Date: 1.6.2000 |
||
4 | * Idea by: Luca Abeni & Gerardo Lamastra |
||
5 | * |
||
6 | * OSLib is an SO project aimed at developing a common, easy-to-use |
||
7 | * low-level infrastructure for developing OS kernels and Embedded |
||
8 | * Applications; it partially derives from the HARTIK project but it |
||
9 | * currently is independently developed. |
||
10 | * |
||
11 | * OSLib is distributed under GPL License, and some of its code has |
||
12 | * been derived from the Linux kernel source; also some important |
||
13 | * ideas come from studying the DJGPP go32 extender. |
||
14 | * |
||
15 | * We acknowledge the Linux Community, Free Software Foundation, |
||
16 | * D.J. Delorie and all the other developers who believe in the |
||
17 | * freedom of software and ideas. |
||
18 | * |
||
19 | * For legalese, check out the included GPL license. |
||
20 | */ |
||
21 | |||
22 | /* Advanced Timer Managment |
||
23 | * Author: Giacomo Guidi <giacomo@gandalf.sssup.it> |
||
24 | */ |
||
25 | |||
26 | #include <ll/i386/stdlib.h> |
||
27 | #include <ll/i386/error.h> |
||
28 | #include <ll/i386/advtimer.h> |
||
29 | #include <ll/sys/ll/ll-data.h> |
||
30 | #include <ll/sys/ll/ll-func.h> |
||
31 | #include <ll/i386/pic.h> |
||
32 | #include <ll/sys/ll/event.h> |
||
33 | #include <ll/sys/ll/time.h> |
||
34 | |||
130 | giacomo | 35 | unsigned char use_tsc = 1; //Enable the TSC counter mode |
120 | giacomo | 36 | unsigned char use_cmos = 0; //Enable the RTC correction |
37 | |||
126 | giacomo | 38 | //Max single delta_clk_per_msec increment = clk_per_msec / MAX_DIV_INK; |
39 | #define MAX_DIV_INK 30000 |
||
120 | giacomo | 40 | |
41 | signed long long init_tsc; |
||
194 | giacomo | 42 | signed long long * ptr_init_tsc = &init_tsc; |
43 | |||
238 | giacomo | 44 | signed long long init_nsec; //Wraparound 292 years |
194 | giacomo | 45 | signed long long * ptr_init_nsec = &init_nsec; |
46 | |||
120 | giacomo | 47 | signed long long clk_per_msec; |
194 | giacomo | 48 | signed long long * ptr_clk_per_msec = &clk_per_msec; |
120 | giacomo | 49 | |
50 | signed long last_delta_clk_per_msec; |
||
51 | signed long total_delta_clk_per_msec; |
||
52 | |||
53 | unsigned char save_CMOS_regA; |
||
54 | unsigned char save_CMOS_regB; |
||
55 | |||
242 | giacomo | 56 | //#define IRQ8_DEBUG |
57 | |||
120 | giacomo | 58 | void HandlerIRQ8(void *p) |
59 | { |
||
60 | |||
61 | unsigned char set; |
||
194 | giacomo | 62 | |
63 | static unsigned long Mconst = 1000000; |
||
120 | giacomo | 64 | |
65 | static unsigned long init_step = 0; |
||
66 | |||
126 | giacomo | 67 | signed long max_dcms = clk_per_msec / MAX_DIV_INK; |
120 | giacomo | 68 | |
194 | giacomo | 69 | static signed long long dn; |
70 | static signed long long * ptr_dn = &dn; |
||
120 | giacomo | 71 | signed long delta_clk_per_msec; |
126 | giacomo | 72 | |
120 | giacomo | 73 | cli(); |
242 | giacomo | 74 | |
75 | #ifdef IRQ8_DEBUG |
||
76 | message("(IRQ8"); |
||
77 | #endif |
||
78 | |||
120 | giacomo | 79 | CMOS_READ(0x0C,set); |
194 | giacomo | 80 | |
242 | giacomo | 81 | __asm__("xorl %%eax,%%eax\n\t" |
82 | "cpuid\n\t" |
||
83 | "rdtsc\n\t" |
||
194 | giacomo | 84 | "pushl %%eax\n\t" |
85 | "pushl %%edx\n\t" |
||
242 | giacomo | 86 | "pushl %%eax\n\t" |
87 | "pushl %%edx\n\t" |
||
88 | "xorl %%eax,%%eax\n\t" |
||
89 | "cpuid\n\t" |
||
90 | "popl %%edx\n\t" |
||
91 | "popl %%eax\n\t" |
||
194 | giacomo | 92 | "subl (%%edi),%%eax\n\t" |
93 | "sbbl 4(%%edi),%%edx\n\t" |
||
94 | "popl 4(%%edi)\n\t" |
||
95 | "popl (%%edi)\n\t" |
||
96 | "movl %%edx,%%ecx\n\t" |
||
97 | "mull %4\n\t" |
||
98 | "pushl %%eax\n\t" |
||
99 | "movl %%ecx,%%eax\n\t" |
||
100 | "movl %%edx,%%ecx\n\t" |
||
101 | "mull %4\n\t" |
||
102 | "addl %%ecx,%%eax\n\t" |
||
103 | "adcl $0,%%edx\n\t" |
||
242 | giacomo | 104 | "movl %7,%%ebx\n\t" |
194 | giacomo | 105 | "divl (%%ebx)\n\t" |
106 | "movl %%eax,4(%%esi)\n\t" |
||
107 | "popl %%eax\n\t" |
||
108 | "divl (%%ebx)\n\t" |
||
109 | "movl %%eax,(%%esi)\n\t" |
||
110 | |||
111 | : |
||
242 | giacomo | 112 | : "D" (ptr_init_tsc), "S" (ptr_dn), "b" (0), |
113 | "c" (0), "m" (Mconst), "a" (0), "d" (0), "m" (ptr_clk_per_msec)); |
||
120 | giacomo | 114 | |
115 | //Offset |
||
116 | init_nsec += dn; |
||
194 | giacomo | 117 | |
120 | giacomo | 118 | if (init_step < 5) { |
119 | init_step++; |
||
222 | giacomo | 120 | sti(); |
242 | giacomo | 121 | |
122 | #ifdef IRQ8_DEBUG |
||
123 | message(")"); |
||
124 | #endif |
||
125 | |||
120 | giacomo | 126 | return; |
127 | } |
||
128 | |||
129 | dn = dn % 1000000000 - 500000000; |
||
130 | |||
131 | //Delta clk/msec |
||
132 | delta_clk_per_msec = dn * clk_per_msec / (500000000 - dn); |
||
133 | |||
134 | //clk_per_msec adjustment |
||
135 | if (delta_clk_per_msec < 0) { |
||
136 | |||
126 | giacomo | 137 | if (delta_clk_per_msec > -max_dcms) |
120 | giacomo | 138 | clk_per_msec += delta_clk_per_msec; |
139 | else |
||
126 | giacomo | 140 | clk_per_msec -= max_dcms; |
120 | giacomo | 141 | } else { |
142 | |||
126 | giacomo | 143 | if (delta_clk_per_msec < max_dcms) |
120 | giacomo | 144 | clk_per_msec += delta_clk_per_msec; |
145 | else |
||
126 | giacomo | 146 | clk_per_msec += max_dcms; |
120 | giacomo | 147 | } |
148 | |||
149 | last_delta_clk_per_msec = delta_clk_per_msec; |
||
150 | total_delta_clk_per_msec += delta_clk_per_msec; |
||
151 | |||
242 | giacomo | 152 | #ifdef IRQ8_DEBUG |
153 | message(")"); |
||
154 | #endif |
||
155 | |||
120 | giacomo | 156 | sti(); |
157 | |||
158 | } |
||
159 | |||
160 | #ifdef CONFIG_MELAN |
||
161 | # define CLOCK_TICK_RATE 1189200 /* AMD Elan has different frequency! */ |
||
162 | #else |
||
163 | # define CLOCK_TICK_RATE 1193180 /* Underlying HZ */ |
||
164 | #endif |
||
165 | |||
242 | giacomo | 166 | #define COUNTER_END 1000 |
120 | giacomo | 167 | |
168 | //TSC Calibration (idea from the linux kernel code) |
||
169 | void ll_calibrate_tsc(void) |
||
170 | { |
||
171 | |||
172 | signed long long start; |
||
173 | signed long long end; |
||
174 | signed long long dtsc; |
||
175 | |||
176 | signed long start_8253, end_8253, delta_8253; |
||
177 | |||
178 | cli(); |
||
179 | |||
180 | /* Set the Gate high, disable speaker */ |
||
181 | outp(0x61, (inp(0x61) & ~0x02) | 0x01); |
||
182 | |||
183 | outp(0x43,0xB0); /* binary, mode 0, LSB/MSB, Ch 2 */ |
||
238 | giacomo | 184 | outp(0x42,0xFF); /* LSB of count */ |
185 | outp(0x42,0xFF); /* MSB of count */ |
||
242 | giacomo | 186 | |
187 | rdtscll(start); |
||
188 | outp(0x43,0x00); |
||
120 | giacomo | 189 | start_8253 = inp(0x42); |
190 | start_8253 |= inp(0x42) << 8; |
||
242 | giacomo | 191 | rdtscll(start); |
192 | |||
120 | giacomo | 193 | do { |
194 | |||
195 | outp(0x43,0x00); |
||
196 | end_8253 = inp(0x42); |
||
197 | end_8253 |= inp(0x42) << 8; |
||
198 | |||
165 | giacomo | 199 | } while (end_8253 > COUNTER_END); |
120 | giacomo | 200 | |
242 | giacomo | 201 | do { |
202 | |||
203 | outp(0x43,0x00); |
||
204 | end_8253 = inp(0x42); |
||
205 | end_8253 |= inp(0x42) << 8; |
||
206 | |||
207 | } while (end_8253 < COUNTER_END); |
||
238 | giacomo | 208 | |
242 | giacomo | 209 | do { |
210 | |||
211 | outp(0x43,0x00); |
||
212 | end_8253 = inp(0x42); |
||
213 | end_8253 |= inp(0x42) << 8; |
||
214 | |||
215 | } while (end_8253 > COUNTER_END); |
||
238 | giacomo | 216 | |
242 | giacomo | 217 | rdtscll(end); |
238 | giacomo | 218 | outp(0x43,0x00); |
219 | end_8253 = inp(0x42); |
||
220 | end_8253 |= inp(0x42) << 8; |
||
242 | giacomo | 221 | rdtscll(end); |
238 | giacomo | 222 | |
120 | giacomo | 223 | //Delta TSC |
224 | dtsc = end - start; |
||
225 | |||
226 | //Delta PIT |
||
242 | giacomo | 227 | delta_8253 = start_8253 - end_8253 + 0x10001; |
120 | giacomo | 228 | |
242 | giacomo | 229 | if (delta_8253 > 0x20000) { |
120 | giacomo | 230 | message("Error calculating Delta PIT\n"); |
231 | ll_abort(10); |
||
232 | } |
||
233 | |||
234 | message("Delta TSC = %10ld\n",(long)dtsc); |
||
235 | |||
236 | message("Delta PIT = %10ld\n",(long)delta_8253); |
||
237 | |||
242 | giacomo | 238 | clk_per_msec = dtsc * CLOCK_TICK_RATE / delta_8253 * 100002 / 100000000; |
120 | giacomo | 239 | |
240 | message("Calibrated Clk_per_msec = %10ld\n",(long)clk_per_msec); |
||
241 | |||
242 | sti(); |
||
243 | |||
244 | } |
||
245 | |||
246 | //Low level time read function |
||
131 | giacomo | 247 | void ll_read_timespec(struct timespec *tspec) |
120 | giacomo | 248 | { |
249 | |||
194 | giacomo | 250 | static unsigned long Gconst = 1000000000; |
251 | static unsigned long Mconst = 1000000; |
||
120 | giacomo | 252 | |
124 | giacomo | 253 | if (clk_per_msec <= 0) { |
254 | NULL_TIMESPEC(tspec); |
||
255 | return; |
||
256 | } |
||
257 | |||
242 | giacomo | 258 | __asm__("xorl %%eax,%%eax\n\t" |
259 | "cpuid\n\t" |
||
260 | "rdtsc\n\t" |
||
261 | "pushl %%eax\n\t" |
||
262 | "pushl %%edx\n\t" |
||
263 | "xorl %%eax,%%eax\n\t" |
||
264 | "cpuid\n\t" |
||
265 | "popl %%edx\n\t" |
||
266 | "popl %%eax\n\t" |
||
267 | "subl (%%edi),%%eax\n\t" |
||
194 | giacomo | 268 | "sbbl 4(%%edi),%%edx\n\t" |
269 | "movl %%edx,%%ecx\n\t" |
||
270 | "mull %6\n\t" |
||
271 | "pushl %%eax\n\t" |
||
272 | "movl %%ecx,%%eax\n\t" |
||
273 | "movl %%edx,%%ecx\n\t" |
||
274 | "mull %6\n\t" |
||
275 | "addl %%ecx,%%eax\n\t" |
||
276 | "adcl $0,%%edx\n\t" |
||
242 | giacomo | 277 | "movl %8,%%ebx\n\t" |
194 | giacomo | 278 | "divl (%%ebx)\n\t" |
279 | "movl %%eax,%%ecx\n\t" |
||
280 | "popl %%eax\n\t" |
||
281 | "divl (%%ebx)\n\t" |
||
282 | "movl %%ecx,%%edx\n\t" |
||
283 | "addl (%%esi),%%eax\n\t" |
||
284 | "adcl 4(%%esi),%%edx\n\t" |
||
285 | "divl %7\n\t" |
||
286 | |||
287 | : "=a" (tspec->tv_sec), "=d" (tspec->tv_nsec) |
||
242 | giacomo | 288 | : "D" (ptr_init_tsc), "S" (ptr_init_nsec), "b" (0), |
289 | "c" (0), "m" (Mconst), "m" (Gconst), "m" (ptr_clk_per_msec)); |
||
194 | giacomo | 290 | |
120 | giacomo | 291 | } |
292 | |||
293 | void ll_init_advtimer() |
||
294 | { |
||
295 | |||
296 | if (use_tsc) { |
||
297 | |||
298 | ll_calibrate_tsc(); |
||
299 | |||
300 | last_delta_clk_per_msec = 0; |
||
301 | total_delta_clk_per_msec = 0; |
||
302 | |||
303 | rdtscll(init_tsc); // Read start TSC |
||
304 | init_nsec = 0; |
||
305 | |||
306 | if (use_cmos) { |
||
307 | |||
131 | giacomo | 308 | message("CMOS adjustement enabled\n"); |
120 | giacomo | 309 | |
310 | cli(); |
||
311 | |||
312 | irq_bind(8, HandlerIRQ8, INT_FORCE); |
||
313 | |||
314 | CMOS_READ(0x0A,save_CMOS_regA); |
||
315 | CMOS_READ(0x0B,save_CMOS_regB); |
||
316 | |||
317 | CMOS_WRITE(0x0A,0x2F); // Set 2 Hz Periodic Interrupt |
||
318 | CMOS_WRITE(0x0B,0x42); // Enable Interrupt |
||
319 | |||
320 | irq_unmask(8); |
||
321 | |||
322 | sti(); |
||
323 | |||
324 | } |
||
325 | |||
326 | } else { |
||
327 | |||
328 | use_cmos = 0; |
||
329 | |||
330 | } |
||
331 | |||
332 | } |
||
333 | |||
131 | giacomo | 334 | void ll_restore_CMOS() |
120 | giacomo | 335 | { |
336 | if (use_cmos) { |
||
337 | cli(); |
||
338 | |||
339 | irq_mask(8); |
||
340 | |||
341 | CMOS_WRITE(0x0A,save_CMOS_regA); |
||
342 | CMOS_WRITE(0x0B,save_CMOS_regB); |
||
343 | |||
344 | sti(); |
||
345 | } |
||
346 | } |