Subversion Repositories HelenOS-historic

/*

/*

 * Copyright (C) 2001-2004 Jakub Jermar

 * Copyright (C) 2001-2004 Jakub Jermar

 * All rights reserved.

 * All rights reserved.

 *

 *

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

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

 * modification, are permitted provided that the following conditions

 * modification, are permitted provided that the following conditions

 * are met:

 * are met:

 *

 *

 * - Redistributions of source code must retain the above copyright

 * - Redistributions of source code must retain the above copyright

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

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

 * - Redistributions in binary form must reproduce the above copyright

 * - Redistributions in binary form must reproduce the above copyright

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

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

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

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

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

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

 *   derived from this software without specific prior written permission.

 *   derived from this software without specific prior written permission.

 *

 *

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

 */

 */

#include <synch/waitq.h>

#include <synch/waitq.h>

#include <synch/synch.h>

#include <synch/synch.h>

#include <synch/spinlock.h>

#include <synch/spinlock.h>

#include <proc/thread.h>

#include <proc/thread.h>

#include <proc/scheduler.h>

#include <proc/scheduler.h>

#include <arch/asm.h>

#include <arch/asm.h>

#include <arch/types.h>

#include <arch/types.h>

#include <typedefs.h>

#include <typedefs.h>

#include <time/timeout.h>

#include <time/timeout.h>

#include <arch.h>

#include <arch.h>

#include <context.h>

#include <context.h>

#include <adt/list.h>

#include <adt/list.h>

static void waitq_timeouted_sleep(void *data);

static void waitq_timeouted_sleep(void *data);

/** Initialize wait queue

/** Initialize wait queue

 *

 *

 * Initialize wait queue.

 * Initialize wait queue.

 *

 *

 * @param wq Pointer to wait queue to be initialized.

 * @param wq Pointer to wait queue to be initialized.

 */

 */

void waitq_initialize(waitq_t *wq)

void waitq_initialize(waitq_t *wq)

{

{

    spinlock_initialize(&wq->lock, "waitq_lock");

    spinlock_initialize(&wq->lock, "waitq_lock");

    list_initialize(&wq->head);

    list_initialize(&wq->head);

    wq->missed_wakeups = 0;

    wq->missed_wakeups = 0;

}

}

/** Handle timeout during waitq_sleep_timeout() call

/** Handle timeout during waitq_sleep_timeout() call

 *

 *

 * This routine is called when waitq_sleep_timeout() timeouts.

 * This routine is called when waitq_sleep_timeout() timeouts.

 * Interrupts are disabled.

 * Interrupts are disabled.

 *

 *

 * It is supposed to try to remove 'its' thread from the wait queue;

 * It is supposed to try to remove 'its' thread from the wait queue;

 * it can eventually fail to achieve this goal when these two events

 * it can eventually fail to achieve this goal when these two events

 * overlap. In that case it behaves just as though there was no

 * overlap. In that case it behaves just as though there was no

 * timeout at all.

 * timeout at all.

 *

 *

 * @param data Pointer to the thread that called waitq_sleep_timeout().

 * @param data Pointer to the thread that called waitq_sleep_timeout().

 */

 */

void waitq_timeouted_sleep(void *data)

void waitq_timeouted_sleep(void *data)

{

{

    thread_t *t = (thread_t *) data;

    thread_t *t = (thread_t *) data;

    waitq_t *wq;

    waitq_t *wq;

    bool do_wakeup = false;

    bool do_wakeup = false;

    spinlock_lock(&threads_lock);

    spinlock_lock(&threads_lock);

    if (!thread_exists(t))

    if (!thread_exists(t))

        goto out;

        goto out;

grab_locks:

grab_locks:

    spinlock_lock(&t->lock);

    spinlock_lock(&t->lock);

    if ((wq = t->sleep_queue)) {        /* assignment */

    if ((wq = t->sleep_queue)) {        /* assignment */

        if (!spinlock_trylock(&wq->lock)) {

        if (!spinlock_trylock(&wq->lock)) {

            spinlock_unlock(&t->lock);

            spinlock_unlock(&t->lock);

            goto grab_locks;    /* avoid deadlock */

            goto grab_locks;    /* avoid deadlock */

        }

        }

        list_remove(&t->wq_link);

        list_remove(&t->wq_link);

        t->saved_context = t->sleep_timeout_context;

        t->saved_context = t->sleep_timeout_context;

        do_wakeup = true;

        do_wakeup = true;

        spinlock_unlock(&wq->lock);

        spinlock_unlock(&wq->lock);

        t->sleep_queue = NULL;

        t->sleep_queue = NULL;

    }

    }

    t->timeout_pending = false;

    t->timeout_pending = false;

    spinlock_unlock(&t->lock);

    spinlock_unlock(&t->lock);

    if (do_wakeup)

    if (do_wakeup)

        thread_ready(t);

        thread_ready(t);

out:

out:

    spinlock_unlock(&threads_lock);

    spinlock_unlock(&threads_lock);

}

}

/** Interrupt sleeping thread.

/** Interrupt sleeping thread.

 *

 *

 * This routine attempts to interrupt a thread from its sleep in a waitqueue.

 * This routine attempts to interrupt a thread from its sleep in a waitqueue.

 * If the thread is not found sleeping, no action is taken.

 * If the thread is not found sleeping, no action is taken.

 *

 *

 * @param t Thread to be interrupted.

 * @param t Thread to be interrupted.

 */

 */

void waitq_interrupt_sleep(thread_t *t)

void waitq_interrupt_sleep(thread_t *t)

{

{

    waitq_t *wq;

    waitq_t *wq;

    bool do_wakeup = false;

    bool do_wakeup = false;

    ipl_t ipl;

    ipl_t ipl;

    ipl = interrupts_disable();

    ipl = interrupts_disable();

    spinlock_lock(&threads_lock);

    spinlock_lock(&threads_lock);

    if (!thread_exists(t))

    if (!thread_exists(t))

        goto out;

        goto out;

grab_locks:

grab_locks:

    spinlock_lock(&t->lock);

    spinlock_lock(&t->lock);

    if ((wq = t->sleep_queue)) {        /* assignment */

    if ((wq = t->sleep_queue)) {        /* assignment */

        if (!spinlock_trylock(&wq->lock)) {

        if (!spinlock_trylock(&wq->lock)) {

            spinlock_unlock(&t->lock);

            spinlock_unlock(&t->lock);

            goto grab_locks;    /* avoid deadlock */

            goto grab_locks;    /* avoid deadlock */

        }

        }

        list_remove(&t->wq_link);

        list_remove(&t->wq_link);

        t->saved_context = t->sleep_interruption_context;

        t->saved_context = t->sleep_interruption_context;

        do_wakeup = true;

        do_wakeup = true;

        spinlock_unlock(&wq->lock);

        spinlock_unlock(&wq->lock);

        t->sleep_queue = NULL;

        t->sleep_queue = NULL;

    }

    }

    spinlock_unlock(&t->lock);

    spinlock_unlock(&t->lock);

    if (do_wakeup)

    if (do_wakeup)

        thread_ready(t);

        thread_ready(t);

out:

out:

    spinlock_unlock(&threads_lock);

    spinlock_unlock(&threads_lock);

    interrupts_restore(ipl);

    interrupts_restore(ipl);

}

}

/** Sleep until either wakeup, timeout or interruption occurs

/** Sleep until either wakeup, timeout or interruption occurs

 *

 *

 * This is a sleep implementation which allows itself to be

 * This is a sleep implementation which allows itself to be

 * interrupted from the sleep, restoring a failover context.

 * interrupted from the sleep, restoring a failover context.

 *

 *

 * Sleepers are organised in FIFO fashion in a structure called wait queue.

 * Sleepers are organised in FIFO fashion in a structure called wait queue.

 *

 *

 * This function is really basic in that other functions as waitq_sleep()

 * This function is really basic in that other functions as waitq_sleep()

 * and all the *_timeout() functions use it.

 * and all the *_timeout() functions use it.

 *

 *

 * @param wq Pointer to wait queue.

 * @param wq Pointer to wait queue.

 * @param usec Timeout in microseconds.

 * @param usec Timeout in microseconds.

 * @param nonblocking Blocking vs. non-blocking operation mode switch.

 * @param nonblocking Blocking vs. non-blocking operation mode switch.

 *

 *

 * the call will not return until either timeout or wakeup comes.

 * the call will not return until either timeout or wakeup comes.

 *

 *

 * will not return until wakeup comes.

 * will not return until wakeup comes.

 *

 *

 * immediately return, reporting either success or failure.

 * immediately return, reporting either success or failure.

 *

 *

 *

 *

 * of the call there was no pending wakeup.

 * of the call there was no pending wakeup.

 *

 *

 *

 *

 *

 *

 * a pending wakeup at the time of the call. The caller was not put

 * a pending wakeup at the time of the call. The caller was not put

 * asleep at all.

 * asleep at all.

 *

 *

 * attempted.

 * attempted.

 */

 */

int waitq_sleep_timeout(waitq_t *wq, __u32 usec, int nonblocking)

int waitq_sleep_timeout(waitq_t *wq, __u32 usec, int nonblocking)

{

{

    volatile ipl_t ipl; /* must be live after context_restore() */

    volatile ipl_t ipl; /* must be live after context_restore() */

restart:

restart:

    ipl = interrupts_disable();

    ipl = interrupts_disable();

    /*

    /*

     * Busy waiting for a delayed timeout.

     * Busy waiting for a delayed timeout.

     * This is an important fix for the race condition between

     * This is an important fix for the race condition between

     * a delayed timeout and a next call to waitq_sleep_timeout().

     * a delayed timeout and a next call to waitq_sleep_timeout().

     * Simply, the thread is not allowed to go to sleep if

     * Simply, the thread is not allowed to go to sleep if

     * there are timeouts in progress.

     * there are timeouts in progress.

     */

     */

    spinlock_lock(&THREAD->lock);

    spinlock_lock(&THREAD->lock);

    if (THREAD->timeout_pending) {

    if (THREAD->timeout_pending) {

        spinlock_unlock(&THREAD->lock);

        spinlock_unlock(&THREAD->lock);

        interrupts_restore(ipl);       

        interrupts_restore(ipl);       

        goto restart;

        goto restart;

    }

    }

    spinlock_unlock(&THREAD->lock);

    spinlock_unlock(&THREAD->lock);

    spinlock_lock(&wq->lock);

    spinlock_lock(&wq->lock);

    /* checks whether to go to sleep at all */

    /* checks whether to go to sleep at all */

    if (wq->missed_wakeups) {

    if (wq->missed_wakeups) {

        wq->missed_wakeups--;

        wq->missed_wakeups--;

        spinlock_unlock(&wq->lock);

        spinlock_unlock(&wq->lock);

        interrupts_restore(ipl);

        interrupts_restore(ipl);

        return ESYNCH_OK_ATOMIC;

        return ESYNCH_OK_ATOMIC;

    }

    }

    else {

    else {

        if (nonblocking && (usec == 0)) {

        if (nonblocking && (usec == 0)) {

            /* return immediatelly instead of going to sleep */

            /* return immediatelly instead of going to sleep */

            spinlock_unlock(&wq->lock);

            spinlock_unlock(&wq->lock);

            interrupts_restore(ipl);

            interrupts_restore(ipl);

            return ESYNCH_WOULD_BLOCK;

            return ESYNCH_WOULD_BLOCK;

        }

        }

    }

    }

    /*

    /*

     * Now we are firmly decided to go to sleep.

     * Now we are firmly decided to go to sleep.

     */

     */

    spinlock_lock(&THREAD->lock);

    spinlock_lock(&THREAD->lock);

    /*

    /*

     * Set context that will be restored if the sleep

     * Set context that will be restored if the sleep

     * of this thread is ever interrupted.

     * of this thread is ever interrupted.

     */

     */

    if (!context_save(&THREAD->sleep_interruption_context)) {

    if (!context_save(&THREAD->sleep_interruption_context)) {

        /* Short emulation of scheduler() return code. */

        /* Short emulation of scheduler() return code. */

        spinlock_unlock(&THREAD->lock);

        spinlock_unlock(&THREAD->lock);

        interrupts_restore(ipl);

        interrupts_restore(ipl);

        return ESYNCH_INTERRUPTED;

        return ESYNCH_INTERRUPTED;

    }

    }

    if (usec) {

    if (usec) {

        /* We use the timeout variant. */

        /* We use the timeout variant. */

        if (!context_save(&THREAD->sleep_timeout_context)) {

        if (!context_save(&THREAD->sleep_timeout_context)) {

            /* Short emulation of scheduler() return code. */

            /* Short emulation of scheduler() return code. */

            spinlock_unlock(&THREAD->lock);

            spinlock_unlock(&THREAD->lock);

            interrupts_restore(ipl);

            interrupts_restore(ipl);

            return ESYNCH_TIMEOUT;

            return ESYNCH_TIMEOUT;

        }

        }

        THREAD->timeout_pending = true;

        THREAD->timeout_pending = true;

        timeout_register(&THREAD->sleep_timeout, (__u64) usec, waitq_timeouted_sleep, THREAD);

        timeout_register(&THREAD->sleep_timeout, (__u64) usec, waitq_timeouted_sleep, THREAD);

    }

    }

    list_append(&THREAD->wq_link, &wq->head);

    list_append(&THREAD->wq_link, &wq->head);

    /*

    /*

     * Suspend execution.

     * Suspend execution.

     */

     */

    THREAD->state = Sleeping;

    THREAD->state = Sleeping;

    THREAD->sleep_queue = wq;

    THREAD->sleep_queue = wq;

    spinlock_unlock(&THREAD->lock);

    spinlock_unlock(&THREAD->lock);

    scheduler();    /* wq->lock is released in scheduler_separated_stack() */

    scheduler();    /* wq->lock is released in scheduler_separated_stack() */

    interrupts_restore(ipl);

    interrupts_restore(ipl);

    return ESYNCH_OK_BLOCKED;

    return ESYNCH_OK_BLOCKED;

}

}

/** Wake up first thread sleeping in a wait queue

/** Wake up first thread sleeping in a wait queue

 *

 *

 * Wake up first thread sleeping in a wait queue.

 * Wake up first thread sleeping in a wait queue.

 * This is the SMP- and IRQ-safe wrapper meant for

 * This is the SMP- and IRQ-safe wrapper meant for

 * general use.

 * general use.

 *

 *

 * Besides its 'normal' wakeup operation, it attempts

 * Besides its 'normal' wakeup operation, it attempts

 * to unregister possible timeout.

 * to unregister possible timeout.

 *

 *

 * @param wq Pointer to wait queue.

 * @param wq Pointer to wait queue.

 * @param all If this is non-zero, all sleeping threads

 * @param all If this is non-zero, all sleeping threads

 *        will be woken up and missed count will be zeroed.

 *        will be woken up and missed count will be zeroed.

 */

 */

void waitq_wakeup(waitq_t *wq, bool all)

void waitq_wakeup(waitq_t *wq, bool all)

{

{

    ipl_t ipl;

    ipl_t ipl;

    ipl = interrupts_disable();

    ipl = interrupts_disable();

    spinlock_lock(&wq->lock);

    spinlock_lock(&wq->lock);

    _waitq_wakeup_unsafe(wq, all);

    _waitq_wakeup_unsafe(wq, all);

    spinlock_unlock(&wq->lock);

    spinlock_unlock(&wq->lock);

    interrupts_restore(ipl);   

    interrupts_restore(ipl);   

}

}

/** Internal SMP- and IRQ-unsafe version of waitq_wakeup()

/** Internal SMP- and IRQ-unsafe version of waitq_wakeup()

 *

 *

 * This is the internal SMP- and IRQ-unsafe version

 * This is the internal SMP- and IRQ-unsafe version

 * of waitq_wakeup(). It assumes wq->lock is already

 * of waitq_wakeup(). It assumes wq->lock is already

 * locked and interrupts are already disabled.

 * locked and interrupts are already disabled.

 *

 *

 * @param wq Pointer to wait queue.

 * @param wq Pointer to wait queue.

 * @param all If this is non-zero, all sleeping threads

 * @param all If this is non-zero, all sleeping threads

 *        will be woken up and missed count will be zeroed.

 *        will be woken up and missed count will be zeroed.

 */

 */

void _waitq_wakeup_unsafe(waitq_t *wq, bool all)

void _waitq_wakeup_unsafe(waitq_t *wq, bool all)

{

{

    thread_t *t;

    thread_t *t;

loop:  

loop:  

    if (list_empty(&wq->head)) {

    if (list_empty(&wq->head)) {

        wq->missed_wakeups++;

        wq->missed_wakeups++;

        if (all)

        if (all)

            wq->missed_wakeups = 0;

            wq->missed_wakeups = 0;

        return;

        return;

    }

    }

    t = list_get_instance(wq->head.next, thread_t, wq_link);

    t = list_get_instance(wq->head.next, thread_t, wq_link);

    list_remove(&t->wq_link);

    list_remove(&t->wq_link);

    spinlock_lock(&t->lock);

    spinlock_lock(&t->lock);

    if (t->timeout_pending && timeout_unregister(&t->sleep_timeout))

    if (t->timeout_pending && timeout_unregister(&t->sleep_timeout))

        t->timeout_pending = false;

        t->timeout_pending = false;

    t->sleep_queue = NULL;

    t->sleep_queue = NULL;

    spinlock_unlock(&t->lock);

    spinlock_unlock(&t->lock);

    thread_ready(t);

    thread_ready(t);

    if (all)

    if (all)

        goto loop;

        goto loop;

}

}