rev |
line source |
nuclear@33
|
1 #include <stdio.h>
|
nuclear@37
|
2 #include <time.h>
|
nuclear@33
|
3 #include "intr.h"
|
nuclear@33
|
4 #include "asmops.h"
|
nuclear@34
|
5 #include "timer.h"
|
nuclear@51
|
6 #include "proc.h"
|
nuclear@51
|
7 #include "sched.h"
|
nuclear@33
|
8 #include "config.h"
|
nuclear@33
|
9
|
nuclear@33
|
10 /* frequency of the oscillator driving the 8254 timer */
|
nuclear@33
|
11 #define OSC_FREQ_HZ 1193182
|
nuclear@33
|
12
|
nuclear@33
|
13 /* macro to divide and round to the nearest integer */
|
nuclear@33
|
14 #define DIV_ROUND(a, b) ((a) / (b) + ((a) % (b)) / ((b) / 2))
|
nuclear@33
|
15
|
nuclear@33
|
16 /* I/O ports connected to the 8254 */
|
nuclear@33
|
17 #define PORT_DATA0 0x40
|
nuclear@33
|
18 #define PORT_DATA1 0x41
|
nuclear@33
|
19 #define PORT_DATA2 0x42
|
nuclear@33
|
20 #define PORT_CMD 0x43
|
nuclear@33
|
21
|
nuclear@33
|
22 /* command bits */
|
nuclear@33
|
23 #define CMD_CHAN0 0
|
nuclear@33
|
24 #define CMD_CHAN1 (1 << 6)
|
nuclear@33
|
25 #define CMD_CHAN2 (2 << 6)
|
nuclear@33
|
26 #define CMD_RDBACK (3 << 6)
|
nuclear@33
|
27
|
nuclear@33
|
28 #define CMD_LATCH 0
|
nuclear@33
|
29 #define CMD_ACCESS_LOW (1 << 4)
|
nuclear@33
|
30 #define CMD_ACCESS_HIGH (2 << 4)
|
nuclear@33
|
31 #define CMD_ACCESS_BOTH (3 << 4)
|
nuclear@33
|
32
|
nuclear@33
|
33 #define CMD_OP_INT_TERM 0
|
nuclear@33
|
34 #define CMD_OP_ONESHOT (1 << 1)
|
nuclear@33
|
35 #define CMD_OP_RATE (2 << 1)
|
nuclear@33
|
36 #define CMD_OP_SQWAVE (3 << 1)
|
nuclear@33
|
37 #define CMD_OP_SOFT_STROBE (4 << 1)
|
nuclear@33
|
38 #define CMD_OP_HW_STROBE (5 << 1)
|
nuclear@33
|
39
|
nuclear@33
|
40 #define CMD_MODE_BIN 0
|
nuclear@33
|
41 #define CMD_MODE_BCD 1
|
nuclear@33
|
42
|
nuclear@33
|
43
|
nuclear@51
|
44 #define MSEC_TO_TICKS(ms) ((ms) * TICK_FREQ_HZ / 1000)
|
nuclear@51
|
45
|
nuclear@51
|
46 struct timer_event {
|
nuclear@51
|
47 int dt; /* remaining ticks delta from the previous event */
|
nuclear@51
|
48 struct timer_event *next;
|
nuclear@51
|
49 };
|
nuclear@51
|
50
|
nuclear@51
|
51
|
nuclear@63
|
52 static void timer_handler();
|
nuclear@33
|
53
|
nuclear@33
|
54
|
nuclear@51
|
55 static struct timer_event *evlist;
|
nuclear@51
|
56
|
nuclear@51
|
57
|
nuclear@33
|
58 void init_timer(void)
|
nuclear@33
|
59 {
|
nuclear@34
|
60 /* calculate the reload count: round(osc / freq) */
|
nuclear@34
|
61 int reload_count = DIV_ROUND(OSC_FREQ_HZ, TICK_FREQ_HZ);
|
nuclear@33
|
62
|
nuclear@33
|
63 /* set the mode to square wave for channel 0, both low
|
nuclear@34
|
64 * and high reload count bytes will follow...
|
nuclear@33
|
65 */
|
nuclear@33
|
66 outb(CMD_CHAN0 | CMD_ACCESS_BOTH | CMD_OP_SQWAVE, PORT_CMD);
|
nuclear@33
|
67
|
nuclear@34
|
68 /* write the low and high bytes of the reload count to the
|
nuclear@33
|
69 * port for channel 0
|
nuclear@33
|
70 */
|
nuclear@34
|
71 outb(reload_count & 0xff, PORT_DATA0);
|
nuclear@34
|
72 outb((reload_count >> 8) & 0xff, PORT_DATA0);
|
nuclear@33
|
73
|
nuclear@33
|
74 /* set the timer interrupt handler */
|
nuclear@63
|
75 interrupt(IRQ_TO_INTR(0), timer_handler);
|
nuclear@33
|
76 }
|
nuclear@33
|
77
|
nuclear@72
|
78 int sys_sleep(int sec)
|
nuclear@72
|
79 {
|
nuclear@72
|
80 printf("process %d will sleep for %d seconds\n", get_current_pid(), sec);
|
nuclear@72
|
81 sleep(sec * 1000); /* timer.c */
|
nuclear@72
|
82
|
nuclear@72
|
83 /* TODO if interrupted, return the remaining seconds */
|
nuclear@72
|
84 return 0;
|
nuclear@72
|
85 }
|
nuclear@72
|
86
|
nuclear@55
|
87 void sleep(unsigned long msec)
|
nuclear@51
|
88 {
|
nuclear@51
|
89 int ticks, tsum, istate;
|
nuclear@51
|
90 struct timer_event *ev, *node;
|
nuclear@51
|
91
|
nuclear@51
|
92 if((ticks = MSEC_TO_TICKS(msec)) <= 0) {
|
nuclear@55
|
93 return;
|
nuclear@51
|
94 }
|
nuclear@51
|
95
|
nuclear@51
|
96 if(!(ev = malloc(sizeof *ev))) {
|
nuclear@55
|
97 printf("sleep: failed to allocate timer_event structure\n");
|
nuclear@55
|
98 return;
|
nuclear@51
|
99 }
|
nuclear@51
|
100
|
nuclear@51
|
101 istate = get_intr_state();
|
nuclear@51
|
102 disable_intr();
|
nuclear@51
|
103
|
nuclear@51
|
104 /* insert at the beginning */
|
nuclear@51
|
105 if(!evlist || ticks <= evlist->dt) {
|
nuclear@51
|
106 ev->next = evlist;
|
nuclear@51
|
107 evlist = ev;
|
nuclear@51
|
108
|
nuclear@51
|
109 ev->dt = ticks;
|
nuclear@51
|
110 if(ev->next) {
|
nuclear@51
|
111 ev->next->dt -= ticks;
|
nuclear@51
|
112 }
|
nuclear@55
|
113 } else {
|
nuclear@51
|
114
|
nuclear@55
|
115 tsum = evlist->dt;
|
nuclear@55
|
116 node = evlist;
|
nuclear@51
|
117
|
nuclear@55
|
118 while(node->next && ticks > tsum + node->next->dt) {
|
nuclear@55
|
119 tsum += node->next->dt;
|
nuclear@55
|
120 node = node->next;
|
nuclear@55
|
121 }
|
nuclear@51
|
122
|
nuclear@55
|
123 ev->next = node->next;
|
nuclear@55
|
124 node->next = ev;
|
nuclear@51
|
125
|
nuclear@55
|
126 /* fix the relative times */
|
nuclear@55
|
127 ev->dt = ticks - tsum;
|
nuclear@55
|
128 if(ev->next) {
|
nuclear@55
|
129 ev->next->dt -= ev->dt;
|
nuclear@55
|
130 }
|
nuclear@51
|
131 }
|
nuclear@51
|
132
|
nuclear@51
|
133 set_intr_state(istate);
|
nuclear@55
|
134
|
nuclear@55
|
135 /* wait on the address of this timer event */
|
nuclear@55
|
136 wait(ev);
|
nuclear@51
|
137 }
|
nuclear@51
|
138
|
nuclear@33
|
139 /* This will be called by the interrupt dispatcher approximately
|
nuclear@33
|
140 * every 1/250th of a second, so it must be extremely fast.
|
nuclear@33
|
141 * For now, just increasing a tick counter will suffice.
|
nuclear@33
|
142 */
|
nuclear@63
|
143 static void timer_handler(int inum)
|
nuclear@33
|
144 {
|
nuclear@51
|
145 int istate;
|
nuclear@57
|
146 struct process *p;
|
nuclear@51
|
147
|
nuclear@33
|
148 nticks++;
|
nuclear@51
|
149
|
nuclear@56
|
150 /*printf("TICKS: %d\n", nticks);*/
|
nuclear@51
|
151
|
nuclear@51
|
152 istate = get_intr_state();
|
nuclear@51
|
153 disable_intr();
|
nuclear@51
|
154
|
nuclear@51
|
155 /* find out if there are any timers that have to go off */
|
nuclear@51
|
156 if(evlist) {
|
nuclear@51
|
157 evlist->dt--;
|
nuclear@51
|
158
|
nuclear@56
|
159 while(evlist && evlist->dt <= 0) {
|
nuclear@51
|
160 struct timer_event *ev = evlist;
|
nuclear@51
|
161 evlist = evlist->next;
|
nuclear@51
|
162
|
nuclear@51
|
163 printf("timer going off!!!\n");
|
nuclear@55
|
164 /* wake up all processes waiting on this address */
|
nuclear@55
|
165 wakeup(ev);
|
nuclear@51
|
166 free(ev);
|
nuclear@51
|
167 }
|
nuclear@51
|
168 }
|
nuclear@51
|
169
|
nuclear@57
|
170 /* decrement the process' ticks_left and call the scheduler to decide if
|
nuclear@57
|
171 * it's time to switch processes
|
nuclear@57
|
172 */
|
nuclear@57
|
173 if((p = get_current_proc())) {
|
nuclear@57
|
174 p->ticks_left--;
|
nuclear@57
|
175 }
|
nuclear@56
|
176 schedule();
|
nuclear@51
|
177
|
nuclear@51
|
178 set_intr_state(istate);
|
nuclear@33
|
179 }
|