Subversion Repositories HelenOS

/*

 * Copyright (C) 2001-2004 Jakub Jermar

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without

 * modification, are permitted provided that the following conditions

 * are met:

 *

 * - Redistributions of source code must retain the above copyright

 *   notice, this list of conditions and the following disclaimer.

 * - Redistributions in binary form must reproduce the above copyright

 *   notice, this list of conditions and the following disclaimer in the

 *   documentation and/or other materials provided with the distribution.

 * - The name of the author may not be used to endorse or promote products

 *   derived from this software without specific prior written permission.

 *

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR

 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES

 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.

 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,

 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT

 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,

 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY

 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT

 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF

 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 */

#include <proc/scheduler.h>

#include <proc/thread.h>

#include <proc/task.h>

#include <mm/heap.h>

#include <mm/frame.h>

#include <mm/page.h>

#include <arch/asm.h>

#include <arch.h>

#include <synch/synch.h>

#include <synch/spinlock.h>

#include <synch/waitq.h>

#include <synch/rwlock.h>

#include <cpu.h>

#include <func.h>

#include <context.h>

#include <list.h>

#include <typedefs.h>

#include <time/clock.h>

#include <list.h>

#include <config.h>

#ifdef __SMP__

#include <arch/interrupt.h>

#include <arch/apic.h>

#endif /* __SMP__ */

char *thread_states[] = {"Invalid", "Running", "Sleeping", "Ready", "Entering", "Exiting"};

spinlock_t threads_lock;

link_t threads_head;

static spinlock_t tidlock;

__u32 last_tid = 0;

/*

 * cushion() is provided to ensure that every thread

 * makes a call to thread_exit() when its implementing

 * function returns.

 *

 * cpu_priority_high()'d

 */

void cushion(void)

{

	void (*f)(void *) = the->thread->thread_code;

	void *arg = the->thread->thread_arg;

	/* this is where each thread wakes up after its creation */

	spinlock_unlock(&the->thread->lock);

	cpu_priority_low();

	f(arg);

	thread_exit();

	/* not reached */

}

void thread_init(void)

{

	the->thread = NULL;

	nrdy = 0;

	spinlock_initialize(&threads_lock);

	list_initialize(&threads_head);

}

void thread_ready(thread_t *t)

{

	cpu_t *cpu;

	runq_t *r;

	pri_t pri;

	int i, avg, send_ipi = 0;

	pri = cpu_priority_high();

	spinlock_lock(&t->lock);

	i = (t->pri < RQ_COUNT -1) ? ++t->pri : t->pri;

	cpu = the->cpu;

	if (t->flags & X_WIRED) {

		cpu = t->cpu;

	}

	spinlock_unlock(&t->lock);

        /*

	 * Append t to respective ready queue on respective processor.

	 */

	r = &cpu->rq[i];

	spinlock_lock(&r->lock);

	list_append(&t->rq_link, &r->rq_head);

	r->n++;

	spinlock_unlock(&r->lock);

	spinlock_lock(&nrdylock);

	avg = ++nrdy / config.cpu_active;

	spinlock_unlock(&nrdylock);

	spinlock_lock(&cpu->lock);

	if ((++cpu->nrdy) > avg && (config.cpu_active == config.cpu_count)) {

		/*

		 * If there are idle halted CPU's, this will wake them up.

		 */

		#ifdef __SMP__

		l_apic_broadcast_custom_ipi(VECTOR_WAKEUP_IPI);

		#endif /* __SMP__  */

	}	

	spinlock_unlock(&cpu->lock);

	cpu_priority_restore(pri);

}

thread_t *thread_create(void (* func)(void *), void *arg, task_t *task, int flags)

{

	thread_t *t;

	__address frame_ks, frame_us = NULL;

	t = (thread_t *) malloc(sizeof(thread_t));

	if (t) {

		pri_t pri;

		spinlock_initialize(&t->lock);

		frame_ks = frame_alloc(FRAME_KA);

		if (THREAD_USER_STACK & flags) {

			frame_us = frame_alloc(0);

		}

		pri = cpu_priority_high();

		spinlock_lock(&tidlock);

		t->tid = ++last_tid;

		spinlock_unlock(&tidlock);

		cpu_priority_restore(pri);

		memsetb(frame_ks, THREAD_STACK_SIZE, 0);

		link_initialize(&t->rq_link);

		link_initialize(&t->wq_link);

		link_initialize(&t->th_link);

		link_initialize(&t->threads_link);

		t->kstack = (__u8 *) frame_ks;

		t->ustack = (__u8 *) frame_us;

		context_save(&t->saved_context);

		t->saved_context.pc = (__address) cushion;

		t->saved_context.sp = (__address) &t->kstack[THREAD_STACK_SIZE-8];

		pri = cpu_priority_high();

		t->saved_context.pri = cpu_priority_read();

		cpu_priority_restore(pri);

		t->thread_code = func;

		t->thread_arg = arg;

		t->ticks = -1;

		t->pri = -1;		/* start in rq[0] */

		t->cpu = NULL;

		t->flags = 0;

		t->state = Entering;

		t->call_me = NULL;

		t->call_me_with = NULL;

		timeout_initialize(&t->sleep_timeout);

		t->sleep_queue = NULL;

		t->timeout_pending = 0;

		t->rwlock_holder_type = RWLOCK_NONE;

		t->task = task;

		/*

		 * Register this thread in the system-wide list.

		 */

		pri = cpu_priority_high();		

		spinlock_lock(&threads_lock);

		list_append(&t->threads_link, &threads_head);

		spinlock_unlock(&threads_lock);

		/*

		 * Attach to the containing task.

		 */

		spinlock_lock(&task->lock);

		list_append(&t->th_link, &task->th_head);

		spinlock_unlock(&task->lock);

		cpu_priority_restore(pri);

	}

	return t;

}

void thread_exit(void)

{

	pri_t pri;

restart:

	pri = cpu_priority_high();

	spinlock_lock(&the->thread->lock);

	if (the->thread->timeout_pending) { /* busy waiting for timeouts in progress */

		spinlock_unlock(&the->thread->lock);

		cpu_priority_restore(pri);

		goto restart;

	}

	the->thread->state = Exiting;

	spinlock_unlock(&the->thread->lock);

	scheduler();

}

void thread_sleep(__u32 sec)

{

        thread_usleep(sec*1000000);

}

/*

 * Suspend execution of current thread for usec microseconds.

 */

void thread_usleep(__u32 usec)

{

	waitq_t wq;

	waitq_initialize(&wq);

	(void) waitq_sleep_timeout(&wq, usec, SYNCH_NON_BLOCKING);

}

void thread_register_call_me(void (* call_me)(void *), void *call_me_with)

{

	pri_t pri;

	pri = cpu_priority_high();

	spinlock_lock(&the->thread->lock);

	the->thread->call_me = call_me;

	the->thread->call_me_with = call_me_with;

	spinlock_unlock(&the->thread->lock);

	cpu_priority_restore(pri);

}