123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167 |
- #ifndef __GATE_H__
- #define __GATE_H__
- #include "../common/kprint.h"
- struct desc_struct
- {
- unsigned char x[8];
- };
- struct gate_struct
- {
- unsigned char x[16];
- };
- extern struct desc_struct GDT_Table[];
- extern struct gate_struct IDT_Table[];
- extern unsigned int TSS64_Table[26];
- void set_gate(ul *gate_selector_addr, ul attr, unsigned char ist, ul *code_addr)
- {
- ul __d0 = 0, __d1 = 0;
- ul tmp_code_addr = *code_addr;
- __d0 = attr << 40;
- __d0 |= ((ul)(ist) << 32);
- __d0 |= 8 << 16;
- __d0 |= (0xffff & tmp_code_addr);
- tmp_code_addr >>= 16;
- __d0 |= (0xffff & tmp_code_addr) << 48;
- tmp_code_addr >>= 16;
- __d1 = (0xffffffff & tmp_code_addr);
- *gate_selector_addr = __d0;
- *(gate_selector_addr + 1) = __d1;
- }
- #define _set_gate(gate_selector_addr, attr, ist, code_addr) \
- do \
- { \
- unsigned long __d0, __d1; \
- __asm__ __volatile__("movw %%dx, %%ax \n\t" \
- "andq $0x7, %%rcx \n\t" \
- "addq %4, %%rcx \n\t" \
- "shlq $32, %%rcx \n\t" \
- "addq %%rcx, %%rax \n\t" \
- "xorq %%rcx, %%rcx \n\t" \
- "movl %%edx, %%ecx \n\t" \
- "shrq $16, %%rcx \n\t" \
- "shlq $48, %%rcx \n\t" \
- "addq %%rcx, %%rax \n\t" \
- "movq %%rax, %0 \n\t" \
- "shrq $32, %%rdx \n\t" \
- "movq %%rdx, %1 \n\t" \
- : "=m"(*((unsigned long *)(gate_selector_addr))), \
- "=m"(*(1 + (unsigned long *)(gate_selector_addr))), "=&a"(__d0), "=&d"(__d1) \
- : "i"(attr << 8), \
- "3"((unsigned long *)(code_addr)), "2"(0x8 << 16), "c"(ist) \
- : "memory"); \
- } while (0)
- void set_tss_descriptor(unsigned int n, void *addr)
- {
- unsigned long limit = 103;
- *(unsigned long *)(&GDT_Table[n]) = (limit & 0xffff) | (((unsigned long)addr & 0xffff) << 16) | ((((unsigned long)addr >> 16) & 0xff) << 32) | ((unsigned long)0x89 << 40) | ((limit >> 16 & 0xf) << 48) | (((unsigned long)addr >> 24 & 0xff) << 56);
- *(unsigned long *)(&GDT_Table[n + 1]) = (((unsigned long)addr >> 32) & 0xffffffff) | 0;
- }
- #define load_TR(n) \
- do \
- { \
- __asm__ __volatile__("ltr %%ax" ::"a"((n) << 3)); \
- } while (0)
- void set_intr_gate(unsigned int n, unsigned char ist, void *addr)
- {
- _set_gate((IDT_Table + n), 0x8E, ist, addr);
-
- }
- void set_trap_gate(unsigned int n, unsigned char ist, void *addr)
- {
-
-
- _set_gate((IDT_Table + n), 0x8F, ist, addr);
- }
- void set_system_trap_gate(unsigned int n, unsigned char ist, void *addr)
- {
-
-
- _set_gate((IDT_Table + n), 0xEF, ist, addr);
- }
- void set_tss64(unsigned int * Table,unsigned long rsp0,unsigned long rsp1,unsigned long rsp2,unsigned long ist1,unsigned long ist2,unsigned long ist3,
- unsigned long ist4,unsigned long ist5,unsigned long ist6,unsigned long ist7)
- {
- *(unsigned long *)(Table+1) = rsp0;
- *(unsigned long *)(Table+3) = rsp1;
- *(unsigned long *)(Table+5) = rsp2;
- *(unsigned long *)(Table+9) = ist1;
- *(unsigned long *)(Table+11) = ist2;
- *(unsigned long *)(Table+13) = ist3;
- *(unsigned long *)(Table+15) = ist4;
- *(unsigned long *)(Table+17) = ist5;
- *(unsigned long *)(Table+19) = ist6;
- *(unsigned long *)(Table+21) = ist7;
- }
- #endif
|