1 files changed, 64 insertions, 0 deletions
diff --git a/src/features/proc.c b/src/features/proc.c
new file mode 100644
index 0000000..92e17f1
--- /dev/null
+++ b/src/features/proc.c
@@ -0,0 +1,64 @@
+// MIT License, Copyright (c) 2020 Marvin Borner
+
+#include <interrupts.h>
+#include <load.h>
+#include <mem.h>
+#include <print.h>
+#include <proc.h>
+#include <timer.h>
+
+u32 pid = 0;
+struct proc *root;
+struct proc *current;
+struct proc *last;
+
+void scheduler(struct regs *regs)
+{
+	printf(".");
+	memcpy(&current->regs, regs, sizeof(struct regs));
+
+	timer_handler();
+
+	if (!current->next)
+		current = root;
+	else
+		current = current->next;
+
+	while (current->state == PROC_ASLEEP)
+		if (!current->next)
+			current = root;
+		else
+			current = current->next;
+
+	memcpy(regs, &current->regs, sizeof(struct regs));
+}
+
+void proc_attach(struct proc *proc)
+{
+	if (!last->next) {
+		last->next = proc;
+	} else {
+		struct proc *save = last;
+		while (save->next)
+			save = save->next;
+		save->next = proc;
+	}
+}
+
+struct proc *proc_make()
+{
+	struct proc *proc = (struct proc *)malloc(sizeof(*proc));
+	proc->pid = pid++;
+	proc->state = PROC_RUNNING;
+	if (current)
+		proc_attach(proc);
+	last = proc;
+	return proc;
+}
+
+void proc_init()
+{
+	current = root = proc_make();
+	bin_load("/root", root);
+	irq_install_handler(0, scheduler);
+}