toaruos/kernel/sys/signal.c

/* vim: tabstop=4 shiftwidth=4 noexpandtab
 *
 * Signal Handling
 */

#include <system.h>
#include <signal.h>

void enter_signal_handler(uintptr_t location, int signum, uintptr_t stack) {
	IRQ_OFF;
	asm volatile(
			"mov %2, %%esp\n"
			"pushl %1\n"           /*          argument count   */
			"pushl $" STRSTR(SIGNAL_RETURN) "\n"
			"mov $0x23, %%ax\n"    /* Segment selector */
			"mov %%ax, %%ds\n"
			"mov %%ax, %%es\n"
			"mov %%ax, %%fs\n"
			"mov %%ax, %%gs\n"
			"mov %%esp, %%eax\n"   /* Stack -> EAX */
			"pushl $0x23\n"        /* Segment selector again */
			"pushl %%eax\n"
			"pushf\n"              /* Push flags */
			"popl %%eax\n"         /* Fix the Interrupt flag */
			"orl  $0x200, %%eax\n"
			"pushl %%eax\n"
			"pushl $0x1B\n"
			"pushl %0\n"           /* Push the entry point */
			"iret\n"
			: : "m"(location), "m"(signum), "r"(stack) : "%ax", "%esp", "%eax");

	kprintf("Failed to jump to signal handler!\n");
}

static uint8_t volatile lock;
static uint8_t volatile lock_b;

void handle_signal(process_t * proc, signal_t * sig) {
	uintptr_t handler = sig->handler;
	uintptr_t signum  = sig->signum;
	free(sig);

	if (proc->finished) {
		return;
	}

	if (signum == 0 || signum > NUMSIGNALS) {
		/* Ignore */
		return;
	}

	if (!handler) {
		kprintf("[debug] Process %d killed by unhandled signal (%d).\n", proc->id, signum);
		kexit(128 + signum);
		__builtin_unreachable();
		return;
	}

	if (handler == 1) /* Ignore */ {
		return;
	}

	uintptr_t stack = 0xFFFF0000;
	if (proc->syscall_registers->useresp < 0x10000100) {
		stack = proc->image.user_stack;
	} else {
		stack = proc->syscall_registers->useresp;
	}

	/* Not marked as ignored, must call signal */
	enter_signal_handler(handler, signum, stack);

}

list_t * rets_from_sig;

void return_from_signal_handler() {
#if 0
	kprintf("[debug] Return From Signal for process %d\n", current_process->id);
#endif

	if (__builtin_expect(!rets_from_sig, 0)) {
		rets_from_sig = list_create();
	}

	spin_lock(&lock);
	list_insert(rets_from_sig, (process_t *)current_process);
	spin_unlock(&lock);

	switch_next();
}

void fix_signal_stacks() {
	uint8_t redo_me = 0;
	if (rets_from_sig) {
		spin_lock(&lock_b);
		while (rets_from_sig->head) {
			spin_lock(&lock);
			node_t * n = list_dequeue(rets_from_sig);
			spin_unlock(&lock);
			if (!n) {
				continue;
			}
			process_t * p = n->value;
			free(n);
			if (p == current_process) {
				redo_me = 1;
				continue;
			}
			p->thread.esp = p->signal_state.esp;
			p->thread.eip = p->signal_state.eip;
			p->thread.ebp = p->signal_state.ebp;
			memcpy((void *)(p->image.stack - KERNEL_STACK_SIZE), p->signal_kstack, KERNEL_STACK_SIZE);
			free(p->signal_kstack);
			p->signal_kstack = NULL;
			make_process_ready(p);
		}
		spin_unlock(&lock_b);
	}
	if (redo_me) {
		spin_lock(&lock);
		list_insert(rets_from_sig, (process_t *)current_process);
		spin_unlock(&lock);
		switch_next();
	}
}