1 | /* This file contains code for initialization of protected mode, to initialize
|
---|
2 | * code and data segment descriptors, and to initialize global descriptors
|
---|
3 | * for local descriptors in the process table.
|
---|
4 | */
|
---|
5 |
|
---|
6 | #include "kernel.h"
|
---|
7 | #include "proc.h"
|
---|
8 | #include "protect.h"
|
---|
9 |
|
---|
10 | #define INT_GATE_TYPE (INT_286_GATE | DESC_386_BIT)
|
---|
11 | #define TSS_TYPE (AVL_286_TSS | DESC_386_BIT)
|
---|
12 |
|
---|
13 | struct desctableptr_s {
|
---|
14 | char limit[sizeof(u16_t)];
|
---|
15 | char base[sizeof(u32_t)]; /* really u24_t + pad for 286 */
|
---|
16 | };
|
---|
17 |
|
---|
18 | struct gatedesc_s {
|
---|
19 | u16_t offset_low;
|
---|
20 | u16_t selector;
|
---|
21 | u8_t pad; /* |000|XXXXX| ig & trpg, |XXXXXXXX| task g */
|
---|
22 | u8_t p_dpl_type; /* |P|DL|0|TYPE| */
|
---|
23 | u16_t offset_high;
|
---|
24 | };
|
---|
25 |
|
---|
26 | struct tss_s {
|
---|
27 | reg_t backlink;
|
---|
28 | reg_t sp0; /* stack pointer to use during interrupt */
|
---|
29 | reg_t ss0; /* " segment " " " " */
|
---|
30 | reg_t sp1;
|
---|
31 | reg_t ss1;
|
---|
32 | reg_t sp2;
|
---|
33 | reg_t ss2;
|
---|
34 | reg_t cr3;
|
---|
35 | reg_t ip;
|
---|
36 | reg_t flags;
|
---|
37 | reg_t ax;
|
---|
38 | reg_t cx;
|
---|
39 | reg_t dx;
|
---|
40 | reg_t bx;
|
---|
41 | reg_t sp;
|
---|
42 | reg_t bp;
|
---|
43 | reg_t si;
|
---|
44 | reg_t di;
|
---|
45 | reg_t es;
|
---|
46 | reg_t cs;
|
---|
47 | reg_t ss;
|
---|
48 | reg_t ds;
|
---|
49 | reg_t fs;
|
---|
50 | reg_t gs;
|
---|
51 | reg_t ldt;
|
---|
52 | u16_t trap;
|
---|
53 | u16_t iobase;
|
---|
54 | /* u8_t iomap[0]; */
|
---|
55 | };
|
---|
56 |
|
---|
57 | PUBLIC struct segdesc_s gdt[GDT_SIZE]; /* used in klib.s and mpx.s */
|
---|
58 | PRIVATE struct gatedesc_s idt[IDT_SIZE]; /* zero-init so none present */
|
---|
59 | PUBLIC struct tss_s tss; /* zero init */
|
---|
60 |
|
---|
61 | FORWARD _PROTOTYPE( void int_gate, (unsigned vec_nr, vir_bytes offset,
|
---|
62 | unsigned dpl_type) );
|
---|
63 | FORWARD _PROTOTYPE( void sdesc, (struct segdesc_s *segdp, phys_bytes base,
|
---|
64 | vir_bytes size) );
|
---|
65 |
|
---|
66 | /*===========================================================================*
|
---|
67 | * prot_init *
|
---|
68 | *===========================================================================*/
|
---|
69 | PUBLIC void prot_init()
|
---|
70 | {
|
---|
71 | /* Set up tables for protected mode.
|
---|
72 | * All GDT slots are allocated at compile time.
|
---|
73 | */
|
---|
74 | struct gate_table_s *gtp;
|
---|
75 | struct desctableptr_s *dtp;
|
---|
76 | unsigned ldt_index;
|
---|
77 | register struct proc *rp;
|
---|
78 |
|
---|
79 | static struct gate_table_s {
|
---|
80 | _PROTOTYPE( void (*gate), (void) );
|
---|
81 | unsigned char vec_nr;
|
---|
82 | unsigned char privilege;
|
---|
83 | }
|
---|
84 | gate_table[] = {
|
---|
85 | { divide_error, DIVIDE_VECTOR, INTR_PRIVILEGE },
|
---|
86 | { single_step_exception, DEBUG_VECTOR, INTR_PRIVILEGE },
|
---|
87 | { nmi, NMI_VECTOR, INTR_PRIVILEGE },
|
---|
88 | { breakpoint_exception, BREAKPOINT_VECTOR, USER_PRIVILEGE },
|
---|
89 | { overflow, OVERFLOW_VECTOR, USER_PRIVILEGE },
|
---|
90 | { bounds_check, BOUNDS_VECTOR, INTR_PRIVILEGE },
|
---|
91 | { inval_opcode, INVAL_OP_VECTOR, INTR_PRIVILEGE },
|
---|
92 | { copr_not_available, COPROC_NOT_VECTOR, INTR_PRIVILEGE },
|
---|
93 | { double_fault, DOUBLE_FAULT_VECTOR, INTR_PRIVILEGE },
|
---|
94 | { copr_seg_overrun, COPROC_SEG_VECTOR, INTR_PRIVILEGE },
|
---|
95 | { inval_tss, INVAL_TSS_VECTOR, INTR_PRIVILEGE },
|
---|
96 | { segment_not_present, SEG_NOT_VECTOR, INTR_PRIVILEGE },
|
---|
97 | { stack_exception, STACK_FAULT_VECTOR, INTR_PRIVILEGE },
|
---|
98 | { general_protection, PROTECTION_VECTOR, INTR_PRIVILEGE },
|
---|
99 | { page_fault, PAGE_FAULT_VECTOR, INTR_PRIVILEGE },
|
---|
100 | { copr_error, COPROC_ERR_VECTOR, INTR_PRIVILEGE },
|
---|
101 | { hwint00, VECTOR( 0), INTR_PRIVILEGE },
|
---|
102 | { hwint01, VECTOR( 1), INTR_PRIVILEGE },
|
---|
103 | { hwint02, VECTOR( 2), INTR_PRIVILEGE },
|
---|
104 | { hwint03, VECTOR( 3), INTR_PRIVILEGE },
|
---|
105 | { hwint04, VECTOR( 4), INTR_PRIVILEGE },
|
---|
106 | { hwint05, VECTOR( 5), INTR_PRIVILEGE },
|
---|
107 | { hwint06, VECTOR( 6), INTR_PRIVILEGE },
|
---|
108 | { hwint07, VECTOR( 7), INTR_PRIVILEGE },
|
---|
109 | { hwint08, VECTOR( 8), INTR_PRIVILEGE },
|
---|
110 | { hwint09, VECTOR( 9), INTR_PRIVILEGE },
|
---|
111 | { hwint10, VECTOR(10), INTR_PRIVILEGE },
|
---|
112 | { hwint11, VECTOR(11), INTR_PRIVILEGE },
|
---|
113 | { hwint12, VECTOR(12), INTR_PRIVILEGE },
|
---|
114 | { hwint13, VECTOR(13), INTR_PRIVILEGE },
|
---|
115 | { hwint14, VECTOR(14), INTR_PRIVILEGE },
|
---|
116 | { hwint15, VECTOR(15), INTR_PRIVILEGE },
|
---|
117 | { s_call, SYS386_VECTOR, USER_PRIVILEGE }, /* 386 system call */
|
---|
118 | { level0_call, LEVEL0_VECTOR, TASK_PRIVILEGE },
|
---|
119 | };
|
---|
120 |
|
---|
121 | /* Build gdt and idt pointers in GDT where the BIOS expects them. */
|
---|
122 | dtp= (struct desctableptr_s *) &gdt[GDT_INDEX];
|
---|
123 | * (u16_t *) dtp->limit = (sizeof gdt) - 1;
|
---|
124 | * (u32_t *) dtp->base = vir2phys(gdt);
|
---|
125 |
|
---|
126 | dtp= (struct desctableptr_s *) &gdt[IDT_INDEX];
|
---|
127 | * (u16_t *) dtp->limit = (sizeof idt) - 1;
|
---|
128 | * (u32_t *) dtp->base = vir2phys(idt);
|
---|
129 |
|
---|
130 | /* Build segment descriptors for tasks and interrupt handlers. */
|
---|
131 | init_codeseg(&gdt[CS_INDEX],
|
---|
132 | kinfo.code_base, kinfo.code_size, INTR_PRIVILEGE);
|
---|
133 | init_dataseg(&gdt[DS_INDEX],
|
---|
134 | kinfo.data_base, kinfo.data_size, INTR_PRIVILEGE);
|
---|
135 | init_dataseg(&gdt[ES_INDEX], 0L, 0, TASK_PRIVILEGE);
|
---|
136 |
|
---|
137 | /* Build scratch descriptors for functions in klib88. */
|
---|
138 | init_dataseg(&gdt[DS_286_INDEX], 0L, 0, TASK_PRIVILEGE);
|
---|
139 | init_dataseg(&gdt[ES_286_INDEX], 0L, 0, TASK_PRIVILEGE);
|
---|
140 |
|
---|
141 | /* Build local descriptors in GDT for LDT's in process table.
|
---|
142 | * The LDT's are allocated at compile time in the process table, and
|
---|
143 | * initialized whenever a process' map is initialized or changed.
|
---|
144 | */
|
---|
145 | for (rp = BEG_PROC_ADDR, ldt_index = FIRST_LDT_INDEX;
|
---|
146 | rp < END_PROC_ADDR; ++rp, ldt_index++) {
|
---|
147 | init_dataseg(&gdt[ldt_index], vir2phys(rp->p_ldt),
|
---|
148 | sizeof(rp->p_ldt), INTR_PRIVILEGE);
|
---|
149 | gdt[ldt_index].access = PRESENT | LDT;
|
---|
150 | rp->p_ldt_sel = ldt_index * DESC_SIZE;
|
---|
151 | }
|
---|
152 |
|
---|
153 | /* Build main TSS.
|
---|
154 | * This is used only to record the stack pointer to be used after an
|
---|
155 | * interrupt.
|
---|
156 | * The pointer is set up so that an interrupt automatically saves the
|
---|
157 | * current process's registers ip:cs:f:sp:ss in the correct slots in the
|
---|
158 | * process table.
|
---|
159 | */
|
---|
160 | tss.ss0 = DS_SELECTOR;
|
---|
161 | init_dataseg(&gdt[TSS_INDEX], vir2phys(&tss), sizeof(tss), INTR_PRIVILEGE);
|
---|
162 | gdt[TSS_INDEX].access = PRESENT | (INTR_PRIVILEGE << DPL_SHIFT) | TSS_TYPE;
|
---|
163 |
|
---|
164 | /* Build descriptors for interrupt gates in IDT. */
|
---|
165 | for (gtp = &gate_table[0];
|
---|
166 | gtp < &gate_table[sizeof gate_table / sizeof gate_table[0]]; ++gtp) {
|
---|
167 | int_gate(gtp->vec_nr, (vir_bytes) gtp->gate,
|
---|
168 | PRESENT | INT_GATE_TYPE | (gtp->privilege << DPL_SHIFT));
|
---|
169 | }
|
---|
170 |
|
---|
171 | /* Complete building of main TSS. */
|
---|
172 | tss.iobase = sizeof tss; /* empty i/o permissions map */
|
---|
173 | }
|
---|
174 |
|
---|
175 | /*===========================================================================*
|
---|
176 | * init_codeseg *
|
---|
177 | *===========================================================================*/
|
---|
178 | PUBLIC void init_codeseg(segdp, base, size, privilege)
|
---|
179 | register struct segdesc_s *segdp;
|
---|
180 | phys_bytes base;
|
---|
181 | vir_bytes size;
|
---|
182 | int privilege;
|
---|
183 | {
|
---|
184 | /* Build descriptor for a code segment. */
|
---|
185 | sdesc(segdp, base, size);
|
---|
186 | segdp->access = (privilege << DPL_SHIFT)
|
---|
187 | | (PRESENT | SEGMENT | EXECUTABLE | READABLE);
|
---|
188 | /* CONFORMING = 0, ACCESSED = 0 */
|
---|
189 | }
|
---|
190 |
|
---|
191 | /*===========================================================================*
|
---|
192 | * init_dataseg *
|
---|
193 | *===========================================================================*/
|
---|
194 | PUBLIC void init_dataseg(segdp, base, size, privilege)
|
---|
195 | register struct segdesc_s *segdp;
|
---|
196 | phys_bytes base;
|
---|
197 | vir_bytes size;
|
---|
198 | int privilege;
|
---|
199 | {
|
---|
200 | /* Build descriptor for a data segment. */
|
---|
201 | sdesc(segdp, base, size);
|
---|
202 | segdp->access = (privilege << DPL_SHIFT) | (PRESENT | SEGMENT | WRITEABLE);
|
---|
203 | /* EXECUTABLE = 0, EXPAND_DOWN = 0, ACCESSED = 0 */
|
---|
204 | }
|
---|
205 |
|
---|
206 | /*===========================================================================*
|
---|
207 | * sdesc *
|
---|
208 | *===========================================================================*/
|
---|
209 | PRIVATE void sdesc(segdp, base, size)
|
---|
210 | register struct segdesc_s *segdp;
|
---|
211 | phys_bytes base;
|
---|
212 | vir_bytes size;
|
---|
213 | {
|
---|
214 | /* Fill in the size fields (base, limit and granularity) of a descriptor. */
|
---|
215 | segdp->base_low = base;
|
---|
216 | segdp->base_middle = base >> BASE_MIDDLE_SHIFT;
|
---|
217 | segdp->base_high = base >> BASE_HIGH_SHIFT;
|
---|
218 |
|
---|
219 | --size; /* convert to a limit, 0 size means 4G */
|
---|
220 | if (size > BYTE_GRAN_MAX) {
|
---|
221 | segdp->limit_low = size >> PAGE_GRAN_SHIFT;
|
---|
222 | segdp->granularity = GRANULAR | (size >>
|
---|
223 | (PAGE_GRAN_SHIFT + GRANULARITY_SHIFT));
|
---|
224 | } else {
|
---|
225 | segdp->limit_low = size;
|
---|
226 | segdp->granularity = size >> GRANULARITY_SHIFT;
|
---|
227 | }
|
---|
228 | segdp->granularity |= DEFAULT; /* means BIG for data seg */
|
---|
229 | }
|
---|
230 |
|
---|
231 | /*===========================================================================*
|
---|
232 | * seg2phys *
|
---|
233 | *===========================================================================*/
|
---|
234 | PUBLIC phys_bytes seg2phys(seg)
|
---|
235 | U16_t seg;
|
---|
236 | {
|
---|
237 | /* Return the base address of a segment, with seg being either a 8086 segment
|
---|
238 | * register, or a 286/386 segment selector.
|
---|
239 | */
|
---|
240 | phys_bytes base;
|
---|
241 | struct segdesc_s *segdp;
|
---|
242 |
|
---|
243 | if (! machine.protected) {
|
---|
244 | base = hclick_to_physb(seg);
|
---|
245 | } else {
|
---|
246 | segdp = &gdt[seg >> 3];
|
---|
247 | base = ((u32_t) segdp->base_low << 0)
|
---|
248 | | ((u32_t) segdp->base_middle << 16)
|
---|
249 | | ((u32_t) segdp->base_high << 24);
|
---|
250 | }
|
---|
251 | return base;
|
---|
252 | }
|
---|
253 |
|
---|
254 | /*===========================================================================*
|
---|
255 | * phys2seg *
|
---|
256 | *===========================================================================*/
|
---|
257 | PUBLIC void phys2seg(seg, off, phys)
|
---|
258 | u16_t *seg;
|
---|
259 | vir_bytes *off;
|
---|
260 | phys_bytes phys;
|
---|
261 | {
|
---|
262 | /* Return a segment selector and offset that can be used to reach a physical
|
---|
263 | * address, for use by a driver doing memory I/O in the A0000 - DFFFF range.
|
---|
264 | */
|
---|
265 | *seg = FLAT_DS_SELECTOR;
|
---|
266 | *off = phys;
|
---|
267 | }
|
---|
268 |
|
---|
269 | /*===========================================================================*
|
---|
270 | * int_gate *
|
---|
271 | *===========================================================================*/
|
---|
272 | PRIVATE void int_gate(vec_nr, offset, dpl_type)
|
---|
273 | unsigned vec_nr;
|
---|
274 | vir_bytes offset;
|
---|
275 | unsigned dpl_type;
|
---|
276 | {
|
---|
277 | /* Build descriptor for an interrupt gate. */
|
---|
278 | register struct gatedesc_s *idp;
|
---|
279 |
|
---|
280 | idp = &idt[vec_nr];
|
---|
281 | idp->offset_low = offset;
|
---|
282 | idp->selector = CS_SELECTOR;
|
---|
283 | idp->p_dpl_type = dpl_type;
|
---|
284 | idp->offset_high = offset >> OFFSET_HIGH_SHIFT;
|
---|
285 | }
|
---|
286 |
|
---|
287 | /*===========================================================================*
|
---|
288 | * enable_iop *
|
---|
289 | *===========================================================================*/
|
---|
290 | PUBLIC void enable_iop(pp)
|
---|
291 | struct proc *pp;
|
---|
292 | {
|
---|
293 | /* Allow a user process to use I/O instructions. Change the I/O Permission
|
---|
294 | * Level bits in the psw. These specify least-privileged Current Permission
|
---|
295 | * Level allowed to execute I/O instructions. Users and servers have CPL 3.
|
---|
296 | * You can't have less privilege than that. Kernel has CPL 0, tasks CPL 1.
|
---|
297 | */
|
---|
298 | pp->p_reg.psw |= 0x3000;
|
---|
299 | }
|
---|
300 |
|
---|
301 | /*===========================================================================*
|
---|
302 | * alloc_segments *
|
---|
303 | *===========================================================================*/
|
---|
304 | PUBLIC void alloc_segments(rp)
|
---|
305 | register struct proc *rp;
|
---|
306 | {
|
---|
307 | /* This is called at system initialization from main() and by do_newmap().
|
---|
308 | * The code has a separate function because of all hardware-dependencies.
|
---|
309 | * Note that IDLE is part of the kernel and gets TASK_PRIVILEGE here.
|
---|
310 | */
|
---|
311 | phys_bytes code_bytes;
|
---|
312 | phys_bytes data_bytes;
|
---|
313 | int privilege;
|
---|
314 |
|
---|
315 | if (machine.protected) {
|
---|
316 | data_bytes = (phys_bytes) (rp->p_memmap[S].mem_vir +
|
---|
317 | rp->p_memmap[S].mem_len) << CLICK_SHIFT;
|
---|
318 | if (rp->p_memmap[T].mem_len == 0)
|
---|
319 | code_bytes = data_bytes; /* common I&D, poor protect */
|
---|
320 | else
|
---|
321 | code_bytes = (phys_bytes) rp->p_memmap[T].mem_len << CLICK_SHIFT;
|
---|
322 | privilege = (iskernelp(rp)) ? TASK_PRIVILEGE : USER_PRIVILEGE;
|
---|
323 | init_codeseg(&rp->p_ldt[CS_LDT_INDEX],
|
---|
324 | (phys_bytes) rp->p_memmap[T].mem_phys << CLICK_SHIFT,
|
---|
325 | code_bytes, privilege);
|
---|
326 | init_dataseg(&rp->p_ldt[DS_LDT_INDEX],
|
---|
327 | (phys_bytes) rp->p_memmap[D].mem_phys << CLICK_SHIFT,
|
---|
328 | data_bytes, privilege);
|
---|
329 | rp->p_reg.cs = (CS_LDT_INDEX * DESC_SIZE) | TI | privilege;
|
---|
330 | rp->p_reg.gs =
|
---|
331 | rp->p_reg.fs =
|
---|
332 | rp->p_reg.ss =
|
---|
333 | rp->p_reg.es =
|
---|
334 | rp->p_reg.ds = (DS_LDT_INDEX*DESC_SIZE) | TI | privilege;
|
---|
335 | } else {
|
---|
336 | rp->p_reg.cs = click_to_hclick(rp->p_memmap[T].mem_phys);
|
---|
337 | rp->p_reg.ss =
|
---|
338 | rp->p_reg.es =
|
---|
339 | rp->p_reg.ds = click_to_hclick(rp->p_memmap[D].mem_phys);
|
---|
340 | }
|
---|
341 | }
|
---|
342 |
|
---|