summaryrefslogtreecommitdiff
path: root/src/kernel/task/sched.cpp
blob: 36f67837ec22a52cd2fdf43981b83942053e9748 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
#include "sched.h"
#include <core/sys.h>
#include <mem/mem.h>
#include <ui/vt.h>

// Lower priority numbers have high priority. Priorities must start at 0.
#define PRIORITIES 3		// we have 3 priority levels
#define PRIORITY(t) (t->process->privilege)		//get priority for a thread

extern thread *idle_thread;

static thread *queue[PRIORITIES] = {0}, *last[PRIORITIES] = {0};

/*	For internal use only. Enqueues specified thread in specified priority queue. */
static void sched_enqueueIn(thread *t, int qid) {
	t->queue_next = 0;
	if (queue[qid] == 0) {
		queue[qid] = last[qid] = t;
	} else {
		last[qid]->queue_next = t;
		last[qid] = t;
	}
}

/*	For internal use only. Pops a thread from specified queue, if available. */
static thread *sched_dequeueFrom(int qid) {
	if (queue[qid] == 0) return 0;
	thread *it = queue[qid];
	ASSERT((it->queue_next == 0 && it == last[qid]) || it != last[qid]);
	queue[qid] = it->queue_next;
	if (queue[qid] == 0) last[qid] = 0;
	return it;
}

/*	Used by task.c. Enqueus a thread in the corresponding priority queue. */
void sched_enqueue(thread *t) {
	if (t == idle_thread) return;
	sched_enqueueIn(t, PRIORITY(t));
}

/*	Used by task.c. Pops a thread from the lowest priority non-empty queue. */
thread *sched_dequeue() {
	thread *it = 0;
	int i;
	for (i = 0; i < PRIORITIES; i++) {
		it = sched_dequeueFrom(i);
		if (it != 0) break;
	}
	if (it == 0) return idle_thread;
	return it;
}

/*	Used by task.c. Removes specified thread from any queue it is in. */
void sched_remove(thread *t) {
	for (int i = 0; i < PRIORITIES; i++) {
		if (queue[i] == t) {
			queue[i] = t->queue_next;
		} else if (queue[i] != 0) {
			thread *it = queue[i];
			while (it->queue_next != 0) {
				if (it->queue_next == t) {
					it->queue_next = t->queue_next;
					break;
				}
				it = it->queue_next;
			}
		}
	}
}