[25] | 1 | /* |
---|
[234] | 2 | * hal_context.c - Implementation of Thread Context API for x86_64 |
---|
[25] | 3 | * |
---|
[234] | 4 | * Copyright (c) 2017 Maxime Villard |
---|
| 5 | * |
---|
[25] | 6 | * This file is part of ALMOS-MKH. |
---|
| 7 | * |
---|
[234] | 8 | * ALMOS-MKH is free software; you can redistribute it and/or modify it |
---|
[25] | 9 | * under the terms of the GNU General Public License as published by |
---|
| 10 | * the Free Software Foundation; version 2.0 of the License. |
---|
| 11 | * |
---|
[234] | 12 | * ALMOS-MKH is distributed in the hope that it will be useful, but |
---|
[25] | 13 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
---|
| 15 | * General Public License for more details. |
---|
| 16 | * |
---|
| 17 | * You should have received a copy of the GNU General Public License |
---|
[234] | 18 | * along with ALMOS-MKH; if not, write to the Free Software Foundation, |
---|
[25] | 19 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
---|
| 20 | */ |
---|
| 21 | |
---|
| 22 | #include <hal_types.h> |
---|
| 23 | #include <memcpy.h> |
---|
| 24 | #include <thread.h> |
---|
| 25 | #include <string.h> |
---|
| 26 | #include <process.h> |
---|
| 27 | #include <printk.h> |
---|
| 28 | #include <vmm.h> |
---|
| 29 | #include <core.h> |
---|
| 30 | #include <cluster.h> |
---|
| 31 | |
---|
| 32 | #include <hal_context.h> |
---|
[193] | 33 | #include <hal_kentry.h> |
---|
[48] | 34 | #include <hal_internal.h> |
---|
[193] | 35 | #include <hal_segmentation.h> |
---|
[48] | 36 | |
---|
[193] | 37 | error_t hal_cpu_context_create(struct thread_s *thread) |
---|
[25] | 38 | { |
---|
[335] | 39 | hal_trapframe_t *tf; |
---|
| 40 | hal_cpu_context_t *ctx; |
---|
[339] | 41 | uint64_t kstacktop; |
---|
[193] | 42 | kmem_req_t req; |
---|
| 43 | |
---|
[339] | 44 | kstacktop = (uint64_t)thread->k_stack_base + thread->k_stack_size; |
---|
| 45 | |
---|
[193] | 46 | /* allocate memory for cpu_context */ |
---|
| 47 | req.type = KMEM_CPU_CTX; |
---|
| 48 | req.size = sizeof(hal_cpu_context_t); |
---|
| 49 | req.flags = AF_KERNEL | AF_ZERO; |
---|
| 50 | |
---|
[335] | 51 | ctx = (hal_cpu_context_t *)kmem_alloc(&req); |
---|
| 52 | if (ctx == NULL) |
---|
[193] | 53 | return ENOMEM; |
---|
| 54 | |
---|
| 55 | /* set cpu context pointer in thread */ |
---|
[335] | 56 | thread->cpu_context = (void *)ctx; |
---|
[193] | 57 | |
---|
[335] | 58 | /* |
---|
| 59 | * Build the context |
---|
| 60 | */ |
---|
[339] | 61 | ctx->ctx_rsp0 = kstacktop & ~0xF; |
---|
| 62 | ctx->ctx_tf = (uint64_t)&ctx->ctx_hidden_tf; |
---|
[359] | 63 | ctx->ctx_intr = INTRS_ENABLED; |
---|
[193] | 64 | |
---|
[335] | 65 | /* |
---|
| 66 | * Build the trap frame |
---|
| 67 | */ |
---|
[339] | 68 | tf = &ctx->ctx_hidden_tf; |
---|
[335] | 69 | tf->tf_gs = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 70 | tf->tf_fs = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 71 | tf->tf_es = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 72 | tf->tf_ds = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 73 | tf->tf_rip = (uint64_t)thread->entry_func; |
---|
| 74 | tf->tf_rflags = PSL_USERSET; |
---|
| 75 | |
---|
[193] | 76 | if (thread->type == THREAD_USER) { |
---|
[335] | 77 | tf->tf_cs = GDT_FIXED_SEL(GDT_UCODE_SEL, SEL_UPL); |
---|
[342] | 78 | tf->tf_ss = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
[335] | 79 | tf->tf_rsp = ((uint64_t)thread->u_stack_base) + |
---|
[193] | 80 | thread->u_stack_size; |
---|
| 81 | } else { |
---|
[335] | 82 | tf->tf_cs = GDT_FIXED_SEL(GDT_KCODE_SEL, SEL_KPL); |
---|
[342] | 83 | tf->tf_ss = GDT_FIXED_SEL(GDT_KDATA_SEL, SEL_KPL); |
---|
[339] | 84 | tf->tf_rsp = kstacktop; |
---|
[193] | 85 | } |
---|
| 86 | |
---|
[48] | 87 | return 0; |
---|
[25] | 88 | } |
---|
| 89 | |
---|
[335] | 90 | error_t hal_cpu_context_copy(thread_t *dst, thread_t *src) |
---|
[25] | 91 | { |
---|
[48] | 92 | x86_panic((char *)__func__); |
---|
| 93 | return 0; |
---|
[25] | 94 | } |
---|
| 95 | |
---|
[335] | 96 | void hal_cpu_context_destroy(thread_t *thread) |
---|
[25] | 97 | { |
---|
[48] | 98 | x86_panic((char *)__func__); |
---|
[25] | 99 | } |
---|
| 100 | |
---|
[335] | 101 | void hal_cpu_context_switch(thread_t *old, thread_t *new) |
---|
[25] | 102 | { |
---|
[342] | 103 | curtls()->tls_thr = new; |
---|
[339] | 104 | |
---|
| 105 | /* Switch the VM space */ |
---|
| 106 | // TODO |
---|
| 107 | |
---|
| 108 | /* Switch the CPU context */ |
---|
| 109 | cpu_context_switch(old->cpu_context, new->cpu_context); |
---|
[25] | 110 | } |
---|
| 111 | |
---|
[335] | 112 | void hal_cpu_context_load( thread_t * thread ) |
---|
[25] | 113 | { |
---|
[48] | 114 | x86_panic((char *)__func__); |
---|
[25] | 115 | } |
---|
| 116 | |
---|
[335] | 117 | error_t hal_fpu_context_create( thread_t * thread ) |
---|
[25] | 118 | { |
---|
[48] | 119 | x86_panic((char *)__func__); |
---|
[335] | 120 | return 0; |
---|
[25] | 121 | } |
---|
| 122 | |
---|
[335] | 123 | error_t hal_fpu_context_copy( thread_t * dst, |
---|
| 124 | thread_t * src ) |
---|
[25] | 125 | { |
---|
[48] | 126 | x86_panic((char *)__func__); |
---|
[335] | 127 | return 0; |
---|
[48] | 128 | } |
---|
[25] | 129 | |
---|
[335] | 130 | void hal_fpu_context_destroy( thread_t * thread ) |
---|
[25] | 131 | { |
---|
[48] | 132 | x86_panic((char *)__func__); |
---|
[25] | 133 | } |
---|
| 134 | |
---|
| 135 | void hal_fpu_context_save( thread_t * thread ) |
---|
| 136 | { |
---|
[48] | 137 | x86_panic((char *)__func__); |
---|
[25] | 138 | } |
---|
| 139 | |
---|
| 140 | void hal_fpu_context_restore( thread_t * thread ) |
---|
| 141 | { |
---|
[48] | 142 | x86_panic((char *)__func__); |
---|
[25] | 143 | } |
---|
| 144 | |
---|
| 145 | void hal_fpu_context_dup( xptr_t dst, |
---|
| 146 | xptr_t src ) |
---|
| 147 | { |
---|
[48] | 148 | x86_panic((char *)__func__); |
---|
[25] | 149 | } |
---|
| 150 | |
---|