[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; |
---|
[193] | 63 | |
---|
[335] | 64 | /* |
---|
| 65 | * Build the trap frame |
---|
| 66 | */ |
---|
[339] | 67 | tf = &ctx->ctx_hidden_tf; |
---|
[335] | 68 | tf->tf_gs = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 69 | tf->tf_fs = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 70 | tf->tf_es = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 71 | tf->tf_ds = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
| 72 | tf->tf_rip = (uint64_t)thread->entry_func; |
---|
| 73 | tf->tf_rflags = PSL_USERSET; |
---|
| 74 | |
---|
[193] | 75 | if (thread->type == THREAD_USER) { |
---|
[335] | 76 | tf->tf_cs = GDT_FIXED_SEL(GDT_UCODE_SEL, SEL_UPL); |
---|
[342] | 77 | tf->tf_ss = GDT_FIXED_SEL(GDT_UDATA_SEL, SEL_UPL); |
---|
[335] | 78 | tf->tf_rsp = ((uint64_t)thread->u_stack_base) + |
---|
[193] | 79 | thread->u_stack_size; |
---|
| 80 | } else { |
---|
[335] | 81 | tf->tf_cs = GDT_FIXED_SEL(GDT_KCODE_SEL, SEL_KPL); |
---|
[342] | 82 | tf->tf_ss = GDT_FIXED_SEL(GDT_KDATA_SEL, SEL_KPL); |
---|
[339] | 83 | tf->tf_rsp = kstacktop; |
---|
[193] | 84 | } |
---|
| 85 | |
---|
[48] | 86 | return 0; |
---|
[25] | 87 | } |
---|
| 88 | |
---|
[335] | 89 | error_t hal_cpu_context_copy(thread_t *dst, thread_t *src) |
---|
[25] | 90 | { |
---|
[48] | 91 | x86_panic((char *)__func__); |
---|
| 92 | return 0; |
---|
[25] | 93 | } |
---|
| 94 | |
---|
[335] | 95 | void hal_cpu_context_destroy(thread_t *thread) |
---|
[25] | 96 | { |
---|
[48] | 97 | x86_panic((char *)__func__); |
---|
[25] | 98 | } |
---|
| 99 | |
---|
[335] | 100 | void hal_cpu_context_switch(thread_t *old, thread_t *new) |
---|
[25] | 101 | { |
---|
[342] | 102 | curtls()->tls_thr = new; |
---|
[339] | 103 | |
---|
| 104 | /* Switch the VM space */ |
---|
| 105 | // TODO |
---|
| 106 | |
---|
| 107 | /* Switch the CPU context */ |
---|
| 108 | cpu_context_switch(old->cpu_context, new->cpu_context); |
---|
[25] | 109 | } |
---|
| 110 | |
---|
[335] | 111 | void hal_cpu_context_load( thread_t * thread ) |
---|
[25] | 112 | { |
---|
[48] | 113 | x86_panic((char *)__func__); |
---|
[25] | 114 | } |
---|
| 115 | |
---|
[335] | 116 | error_t hal_fpu_context_create( thread_t * thread ) |
---|
[25] | 117 | { |
---|
[48] | 118 | x86_panic((char *)__func__); |
---|
[335] | 119 | return 0; |
---|
[25] | 120 | } |
---|
| 121 | |
---|
[335] | 122 | error_t hal_fpu_context_copy( thread_t * dst, |
---|
| 123 | thread_t * src ) |
---|
[25] | 124 | { |
---|
[48] | 125 | x86_panic((char *)__func__); |
---|
[335] | 126 | return 0; |
---|
[48] | 127 | } |
---|
[25] | 128 | |
---|
[335] | 129 | void hal_fpu_context_destroy( thread_t * thread ) |
---|
[25] | 130 | { |
---|
[48] | 131 | x86_panic((char *)__func__); |
---|
[25] | 132 | } |
---|
| 133 | |
---|
| 134 | void hal_fpu_context_save( thread_t * thread ) |
---|
| 135 | { |
---|
[48] | 136 | x86_panic((char *)__func__); |
---|
[25] | 137 | } |
---|
| 138 | |
---|
| 139 | void hal_fpu_context_restore( thread_t * thread ) |
---|
| 140 | { |
---|
[48] | 141 | x86_panic((char *)__func__); |
---|
[25] | 142 | } |
---|
| 143 | |
---|
| 144 | void hal_fpu_context_dup( xptr_t dst, |
---|
| 145 | xptr_t src ) |
---|
| 146 | { |
---|
[48] | 147 | x86_panic((char *)__func__); |
---|
[25] | 148 | } |
---|
| 149 | |
---|