diff options
| -rw-r--r-- | sys/arch/amd64/tss.c | 74 | ||||
| -rw-r--r-- | sys/include/arch/amd64/tss.h | 14 |
2 files changed, 88 insertions, 0 deletions
diff --git a/sys/arch/amd64/tss.c b/sys/arch/amd64/tss.c index ba1b0f6..b1b5420 100644 --- a/sys/arch/amd64/tss.c +++ b/sys/arch/amd64/tss.c @@ -32,6 +32,8 @@ #include <lib/string.h> #include <vm/dynalloc.h> #include <sys/panic.h> +#include <sys/errno.h> +#include <assert.h> __MODULE_NAME("TSS"); __KERNEL_META("$Hyra$: tss.c, Ian Marco Moffett, " @@ -55,6 +57,78 @@ alloc_resources(struct cpu_info *cpu) } } +/* + * Update interrupt stack table entry `istno' with `stack' + * + * @stack: Interrupt stack. + * @istno: IST number, must be 1-based. + * + * Returns 0 on success. + */ +int +tss_update_ist(struct cpu_info *ci, union tss_stack stack, uint8_t istno) +{ + volatile struct tss_entry *tss = ci->tss; + + __assert(tss != NULL); + + switch (istno) { + case 1: + tss->ist1_lo = stack.top_lo; + tss->ist1_hi = stack.top_hi; + break; + case 2: + tss->ist2_lo = stack.top_lo; + tss->ist2_hi = stack.top_hi; + break; + case 3: + tss->ist3_lo = stack.top_lo; + tss->ist3_hi = stack.top_hi; + break; + case 4: + tss->ist4_lo = stack.top_lo; + tss->ist4_hi = stack.top_hi; + break; + case 5: + tss->ist5_lo = stack.top_lo; + tss->ist5_hi = stack.top_hi; + break; + case 6: + tss->ist6_lo = stack.top_lo; + tss->ist6_hi = stack.top_hi; + break; + case 7: + tss->ist7_lo = stack.top_lo; + tss->ist7_hi = stack.top_hi; + break; + default: + return -EXIT_FAILURE; + }; + + return 0; +} + +/* + * Allocates TSS stack. + * + * Returns 0 on success. + * + * @entry_out: Pointer to location where allocated entry + * will be sent. + */ +int +tss_alloc_stack(union tss_stack *entry_out, size_t size) +{ + uintptr_t base = (uintptr_t)dynalloc(size); + + if (base == 0) { + return -EXIT_FAILURE; + } + + entry_out->top = base + size; + return 0; +} + void write_tss(struct cpu_info *cpu, struct tss_desc *desc) { diff --git a/sys/include/arch/amd64/tss.h b/sys/include/arch/amd64/tss.h index 90f6289..bca572e 100644 --- a/sys/include/arch/amd64/tss.h +++ b/sys/include/arch/amd64/tss.h @@ -100,6 +100,20 @@ struct __packed tss_desc { uint32_t reserved; }; +/* + * Holds the address of the address pointing + * to the top of an interrupt stack. + */ +union tss_stack { + struct { + uint32_t top_lo; + uint32_t top_hi; + }; + uint64_t top; +}; + +int tss_alloc_stack(union tss_stack *entry_out, size_t size); +int tss_update_ist(struct cpu_info *ci, union tss_stack stack, uint8_t istno); void write_tss(struct cpu_info *cpu, struct tss_desc *desc); void tss_load(void); /* In tss.S */ |