Make sure loops_per_tick doesn't overflow to zero.
[pintos-anon] / src / devices / timer.c
1 #include "devices/timer.h"
2 #include <debug.h>
3 #include <inttypes.h>
4 #include <round.h>
5 #include <stdio.h>
6 #include "threads/interrupt.h"
7 #include "threads/io.h"
8 #include "threads/thread.h"
9   
10 /* See [8254] for hardware details of the 8254 timer chip. */
11
12 #if TIMER_FREQ < 19
13 #error 8254 timer requires TIMER_FREQ >= 19
14 #endif
15 #if TIMER_FREQ > 1000
16 #error TIMER_FREQ <= 1000 recommended
17 #endif
18
19 /* Number of timer ticks since OS booted. */
20 static volatile int64_t ticks;
21
22 /* Number of loops per timer tick.
23    Initialized by timer_calibrate(). */
24 static unsigned loops_per_tick;
25
26 static intr_handler_func timer_interrupt;
27 static bool too_many_loops (unsigned loops);
28 static void busy_wait (int64_t loops);
29 static void real_time_sleep (int64_t num, int32_t denom);
30
31 /* Sets up the 8254 Programmable Interval Timer (PIT) to
32    interrupt PIT_FREQ times per second, and registers the
33    corresponding interrupt. */
34 void
35 timer_init (void) 
36 {
37   /* 8254 input frequency divided by TIMER_FREQ, rounded to
38      nearest. */
39   uint16_t count = (1193180 + TIMER_FREQ / 2) / TIMER_FREQ;
40
41   outb (0x43, 0x34);    /* CW: counter 0, LSB then MSB, mode 2, binary. */
42   outb (0x40, count & 0xff);
43   outb (0x40, count >> 8);
44
45   intr_register_ext (0x20, timer_interrupt, "8254 Timer");
46 }
47
48 /* Calibrates loops_per_tick, used to implement brief delays. */
49 void
50 timer_calibrate (void) 
51 {
52   unsigned high_bit, test_bit;
53
54   ASSERT (intr_get_level () == INTR_ON);
55   printf ("Calibrating timer...  ");
56
57   /* Approximate loops_per_tick as the largest power-of-two
58      still less than one timer tick. */
59   loops_per_tick = 1u << 10;
60   while (!too_many_loops (loops_per_tick << 1)) 
61     {
62       loops_per_tick <<= 1;
63       ASSERT (loops_per_tick != 0);
64     }
65
66   /* Refine the next 8 bits of loops_per_tick. */
67   high_bit = loops_per_tick;
68   for (test_bit = high_bit >> 1; test_bit != high_bit >> 10; test_bit >>= 1)
69     if (!too_many_loops (high_bit | test_bit))
70       loops_per_tick |= test_bit;
71
72   printf ("%'"PRIu64" loops/s.\n", (uint64_t) loops_per_tick * TIMER_FREQ);
73 }
74
75 /* Returns the number of timer ticks since the OS booted. */
76 int64_t
77 timer_ticks (void) 
78 {
79   enum intr_level old_level = intr_disable ();
80   int64_t t = ticks;
81   intr_set_level (old_level);
82   return t;
83 }
84
85 /* Returns the number of timer ticks elapsed since THEN, which
86    should be a value once returned by timer_ticks(). */
87 int64_t
88 timer_elapsed (int64_t then) 
89 {
90   return timer_ticks () - then;
91 }
92
93 /* Suspends execution for approximately TICKS timer ticks. */
94 void
95 timer_sleep (int64_t ticks) 
96 {
97   int64_t start = timer_ticks ();
98
99   ASSERT (intr_get_level () == INTR_ON);
100   while (timer_elapsed (start) < ticks) 
101     thread_yield ();
102 }
103
104 /* Suspends execution for approximately MS milliseconds. */
105 void
106 timer_msleep (int64_t ms) 
107 {
108   real_time_sleep (ms, 1000);
109 }
110
111 /* Suspends execution for approximately US microseconds. */
112 void
113 timer_usleep (int64_t us) 
114 {
115   real_time_sleep (us, 1000 * 1000);
116 }
117
118 /* Suspends execution for approximately NS nanoseconds. */
119 void
120 timer_nsleep (int64_t ns) 
121 {
122   real_time_sleep (ns, 1000 * 1000 * 1000);
123 }
124
125 /* Prints timer statistics. */
126 void
127 timer_print_stats (void) 
128 {
129   printf ("Timer: %"PRId64" ticks\n", timer_ticks ());
130 }
131 \f
132 /* Timer interrupt handler. */
133 static void
134 timer_interrupt (struct intr_frame *args UNUSED)
135 {
136   ticks++;
137   thread_tick ();
138 }
139
140 /* Returns true if LOOPS iterations waits for more than one timer
141    tick, otherwise false. */
142 static bool
143 too_many_loops (unsigned loops) 
144 {
145   int64_t start;
146
147   /* Wait for a timer tick. */
148   start = ticks;
149   while (ticks == start)
150     continue;
151
152   /* Run LOOPS loops. */
153   start = ticks;
154   busy_wait (loops);
155
156   /* If the tick count changed, we iterated too long. */
157   return start != ticks;
158 }
159
160 /* Iterates through a simple loop LOOPS times, for implementing
161    brief delays.
162
163    Marked NO_INLINE because code alignment can significantly
164    affect timings, so that if this function was inlined
165    differently in different places the results would be difficult
166    to predict. */
167 static void NO_INLINE
168 busy_wait (volatile int64_t loops) 
169 {
170   while (loops-- > 0)
171     continue;
172 }
173
174 /* Sleep for approximately NUM/DENOM seconds. */
175 static void
176 real_time_sleep (int64_t num, int32_t denom) 
177 {
178   /* Convert NUM/DENOM seconds into timer ticks, rounding down.
179           
180         (NUM / DENOM) s          
181      ---------------------- = NUM * TIMER_FREQ / DENOM ticks. 
182      1 s / TIMER_FREQ ticks
183   */
184   int64_t ticks = num * TIMER_FREQ / denom;
185
186   ASSERT (intr_get_level () == INTR_ON);
187   if (ticks > 0)
188     {
189       /* We're waiting for at least one full timer tick.  Use
190          timer_sleep() because it will yield the CPU to other
191          processes. */                
192       timer_sleep (ticks); 
193     }
194   else 
195     {
196       /* Otherwise, use a busy-wait loop for more accurate
197          sub-tick timing.  We scale the numerator and denominator
198          down by 1000 to avoid the possibility of overflow. */
199       ASSERT (denom % 1000 == 0);
200       busy_wait (loops_per_tick * num / 1000 * TIMER_FREQ / (denom / 1000)); 
201     }
202 }
203