Kthreads stop zeroing the current_tf
[akaros.git] / kern / src / kthread.c
1 /* Copyright (c) 2010 The Regents of the University of California
2  * Barret Rhoden <brho@cs.berkeley.edu>
3  * See LICENSE for details.
4  *
5  * Kernel threading.  These are for blocking within the kernel for whatever
6  * reason, usually during blocking IO operations. */
7
8 #include <kthread.h>
9 #include <slab.h>
10 #include <page_alloc.h>
11 #include <pmap.h>
12 #include <smp.h>
13 #include <schedule.h>
14
15 struct kmem_cache *kthread_kcache;
16
17 void kthread_init(void)
18 {
19         kthread_kcache = kmem_cache_create("kthread", sizeof(struct kthread),
20                                            __alignof__(struct kthread), 0, 0, 0);
21 }
22
23 /* This downs the semaphore and suspends the current kernel context on its
24  * waitqueue if there are no pending signals.  Note that the case where the
25  * signal is already there is not optimized. */
26 void sleep_on(struct semaphore *sem)
27 {
28         volatile bool blocking = TRUE;  /* signal to short circuit when restarting*/
29         struct kthread *kthread;
30         struct page *page;                              /* assumption here that stacks are PGSIZE */
31         register uintptr_t new_stacktop;
32         int8_t irq_state = 0;
33         struct per_cpu_info *pcpui = &per_cpu_info[core_id()];
34
35         /* interrups would be messy here */
36         disable_irqsave(&irq_state);
37         /* Try to down the semaphore.  If there is a signal there, we can skip all
38          * of the sleep prep and just return. */
39         spin_lock(&sem->lock);  /* no need for irqsave, since we disabled ints */
40         if (sem->nr_signals > 0) {
41                 sem->nr_signals--;
42                 spin_unlock(&sem->lock);
43                 goto block_return_path;
44         }
45         /* we're probably going to sleep, so get ready.  We'll check again later. */
46         spin_unlock(&sem->lock);
47         /* Try to get the spare first.  If there is one, we'll use it (o/w, we'll
48          * get a fresh kthread.  Why we need this is more clear when we try to
49          * restart kthreads.  Having them also ought to cut down on contention.
50          * Note we do this with interrupts disabled (which protects us from
51          * concurrent modifications). */
52         if (pcpui->spare) {
53                 kthread = pcpui->spare;
54                 /* we're using the spare, so we use the page the spare held */
55                 new_stacktop = kthread->stacktop;
56                 pcpui->spare = 0;
57         } else {
58                 kthread = kmem_cache_alloc(kthread_kcache, 0);
59                 assert(kthread);
60                 assert(!kpage_alloc(&page));    /* decref'd when the kthread is freed */
61                 new_stacktop = (uintptr_t)page2kva(page) + PGSIZE;
62         }
63         /* This is the stacktop we are currently on and wish to save */
64         kthread->stacktop = get_stack_top();
65         /* Set the core's new default stack */
66         set_stack_top(new_stacktop);
67         /* The kthread needs to stay in the process context (if there is one), but
68          * we want the core (which could be a vcore) to stay in the context too.  If
69          * we want to leave, we'll need to do that in smp_idle() or elsewhere in the
70          * code. */
71         kthread->proc = current;
72         /* kthread tracks the syscall it is working on, which implies errno */
73         if (pcpui->syscalls)
74                 kthread->sysc = pcpui->syscalls - 1;    // TODO: 2 sysc
75         else
76                 kthread->sysc = 0;
77         if (kthread->proc)
78                 kref_get(&kthread->proc->kref, 1);
79         /* Save the context, toggle blocking for the reactivation */
80         save_kernel_tf(&kthread->context);
81         if (!blocking)
82                 goto block_return_path;
83         blocking = FALSE;                                       /* for when it starts back up */
84         /* Down the semaphore.  We need this to be inline.  If we're sleeping, once
85          * we unlock the kthread could be started up again and can return and start
86          * trashing this function's stack, hence the weird control flow. */
87         spin_lock(&sem->lock);  /* no need for irqsave, since we disabled ints */
88         if (sem->nr_signals-- <= 0)
89                 TAILQ_INSERT_TAIL(&sem->waiters, kthread, link);
90         else                                                            /* we didn't sleep */
91                 goto unwind_sleep_prep;
92         spin_unlock(&sem->lock);
93         /* Switch to the core's default stack.  After this, don't use local
94          * variables.  TODO: we shouldn't be using new_stacktop either, can't always
95          * trust the register keyword (AFAIK). */
96         set_stack_pointer(new_stacktop);
97         smp_idle();
98         /* smp_idle never returns */
99         assert(0);
100 unwind_sleep_prep:
101         /* We get here if we should not sleep on sem (the signal beat the sleep).
102          * Note we are not optimizing for cases where the signal won. */
103         spin_unlock(&sem->lock);
104         printd("Didn't sleep, unwinding...\n");
105         /* Restore the core's current and default stacktop */
106         current = kthread->proc;                        /* arguably unnecessary */
107         if (kthread->proc)
108                 kref_put(&kthread->proc->kref);
109         set_stack_top(kthread->stacktop);
110         /* Save the allocs as the spare */
111         assert(!pcpui->spare);
112         pcpui->spare = kthread;
113         /* save the "freshly alloc'd" stack/page, not the one we came in on */
114         kthread->stacktop = new_stacktop;
115 block_return_path:
116         printd("Returning from being 'blocked'!\n");
117         enable_irqsave(&irq_state);
118         return;
119 }
120
121 /* Starts kthread on the calling core.  This does not return, and will handle
122  * the details of cleaning up whatever is currently running (freeing its stack,
123  * etc). */
124 void restart_kthread(struct kthread *kthread)
125 {
126         struct per_cpu_info *pcpui = &per_cpu_info[core_id()];
127         uintptr_t current_stacktop;
128         /* Avoid messy complications.  The kthread will enable_irqsave() when it
129          * comes back up. */
130         disable_irq();
131         /* Free any spare, since we need ours to become the spare (since we can't
132          * free our current kthread *before* popping it, nor can we free the current
133          * stack until we pop to the kthread's stack). */
134         if (pcpui->spare) {
135                 page_decref(kva2page((void*)kthread->stacktop - PGSIZE));
136                 kmem_cache_free(kthread_kcache, pcpui->spare);
137         }
138         current_stacktop = get_stack_top();
139         /* When a kthread runs, its stack is the default kernel stack */
140         set_stack_top(kthread->stacktop);
141         /* Set the spare stuff (current kthread, current (not kthread) stacktop) */
142         pcpui->spare = kthread;
143         kthread->stacktop = current_stacktop;
144         if (current) {
145                 /* __launch_kthread() should have abandoned if it was diff */
146                 assert(current == kthread->proc);
147                 /* no longer need this ref, current holds it */
148                 kref_put(&kthread->proc->kref);
149
150         } else {
151                 /* ref gets transfered (or it was 0 (no ref held)) */
152                 current = kthread->proc;
153                 if (kthread->proc)
154                         lcr3(kthread->proc->env_cr3);
155         }
156         // TODO: 2 sysc (set the syscall in progress to kthread->sysc */
157         if (kthread->sysc)
158                 pcpui->errno_loc = &kthread->sysc->err;
159         /* Finally, restart our thread */
160         pop_kernel_tf(&kthread->context);
161 }
162
163 /* Call this when a kthread becomes runnable/unblocked.  We don't do anything
164  * particularly smart yet, but when we do, we can put it here. */
165 void kthread_runnable(struct kthread *kthread)
166 {
167         /* For lack of anything better, send it to ourselves. (TODO: KSCHED) */
168         send_kernel_message(core_id(), __launch_kthread, (void*)kthread, 0, 0,
169                             KMSG_ROUTINE);
170 }
171
172 /* Kmsg handler to launch/run a kthread.  This must be a routine message, since
173  * it does not return.  Furthermore, like all routine kmsgs that don't return,
174  * this needs to handle the fact that it won't return to the given TF (which is
175  * a proc's TF, since this was routine). */
176 void __launch_kthread(struct trapframe *tf, uint32_t srcid, void *a0, void *a1,
177                           void *a2)
178 {
179         struct kthread *kthread = (struct kthread*)a0;
180         struct proc *cur_proc = current;
181         /* If there is no proc running, don't worry about not returning. */
182         if (cur_proc) {
183                 /* If we're dying, we have a message incoming that we need to deal with,
184                  * so we send this message to ourselves (at the end of the queue).  This
185                  * is a bit ghetto, and a lot of this will need work. */
186                 if (cur_proc->state == PROC_DYING) {
187                         /* We could fake it and send it manually, but this is fine */
188                         send_kernel_message(core_id(), __launch_kthread, (void*)kthread,
189                                             0, 0, KMSG_ROUTINE);
190                         return;
191                 }
192                 if (cur_proc != kthread->proc) {
193                         /* we're running the kthread from a different proc.  For now, we
194                          * can't be _M, since that would be taking away someone's vcore to
195                          * process another process's work. */
196                         assert(cur_proc->state == PROC_RUNNING_S);
197                         spin_lock(&cur_proc->proc_lock);
198                         /* Wrap up / yield the current _S proc, which calls schedule_proc */
199                         __proc_yield_s(cur_proc, tf);
200                         spin_unlock(&cur_proc->proc_lock);
201                         abandon_core();
202                 } else {
203                         /* possible to get here if there is only one _S proc that blocked */
204                         //assert(cur_proc->state == PROC_RUNNING_M);
205                         /* TODO: might need to do something here, though it will depend on
206                          * how we handle async local calls. */
207                 }
208
209         }
210         restart_kthread(kthread);
211         assert(0);
212 }