wait.c

Go to the documentation of this file.

#include <kernel/cpu/irq.h>
#include <kernel/sched/wait.h>
 
#include <kernel/cpu/cpu.h>
#include <kernel/log/log.h>
#include <kernel/log/panic.h>
#include <kernel/sched/sched.h>
#include <kernel/sched/sys_time.h>
#include <kernel/sched/thread.h>
#include <kernel/sched/timer.h>
#include <kernel/sync/lock.h>
 
#include <assert.h>
#include <errno.h>
#include <stdatomic.h>
#include <stdlib.h>
#include <sys/list.h>
 
static void wait_remove_wait_entries(thread_t* thread, errno_t err)
{
    assert(atomic_load(&thread->state) == THREAD_UNBLOCKING);
 
    thread->wait.err = err;
 
    wait_entry_t* temp;
    wait_entry_t* entry;
    LIST_FOR_EACH_SAFE(entry, temp, &thread->wait.entries, threadEntry)
    {
        lock_acquire(&entry->queue->lock);
        list_remove(&entry->queue->entries, &entry->queueEntry);
        lock_release(&entry->queue->lock);
 
        list_remove(&entry->thread->wait.entries, &entry->threadEntry); // Belongs to thread, no lock needed.
        free(entry);
    }
}
 
void wait_queue_init(wait_queue_t* queue)
{
    lock_init(&queue->lock);
    list_init(&queue->entries);
}
 
void wait_queue_deinit(wait_queue_t* queue)
{
    LOCK_SCOPE(&queue->lock);
 
    if (!list_is_empty(&queue->entries))
    {
        panic(NULL, "Wait queue with pending threads freed");
    }
}
 
void wait_client_init(wait_client_t* client)
{
    list_entry_init(&client->entry);
    list_init(&client->entries);
    client->err = EOK;
    client->deadline = 0;
    client->owner = NULL;
}
 
void wait_init(wait_t* wait)
{
    list_init(&wait->blockedThreads);
    lock_init(&wait->lock);
}
 
void wait_check_timeouts(interrupt_frame_t* frame, cpu_t* self)
{
    (void)frame; // Unused
 
    LOCK_SCOPE(&self->wait.lock);
 
    while (1)
    {
        thread_t* thread = CONTAINER_OF_SAFE(list_first(&self->wait.blockedThreads), thread_t, wait.entry);
        if (thread == NULL)
        {
            return;
        }
 
        clock_t uptime = sys_time_uptime();
        if (thread->wait.deadline > uptime)
        {
            timer_set(uptime, thread->wait.deadline);
            return;
        }
 
        list_remove(&self->wait.blockedThreads, &thread->wait.entry);
 
        thread_state_t expected = THREAD_BLOCKED;
        if (!atomic_compare_exchange_strong(&thread->state, &expected, THREAD_UNBLOCKING)) // Already unblocking.
        {
            continue;
        }
 
        wait_remove_wait_entries(thread, ETIMEDOUT);
        sched_submit(thread);
    }
}
 
uint64_t wait_block_prepare(wait_queue_t** waitQueues, uint64_t amount, clock_t timeout)
{
    if (waitQueues == NULL || amount == 0)
    {
        errno = EINVAL;
        return ERR;
    }
 
    // Disable interrupts and retrieve thread.
    thread_t* thread = cpu_get()->sched.runThread;
 
    assert(thread != NULL);
 
    for (uint64_t i = 0; i < amount; i++)
    {
        lock_acquire(&waitQueues[i]->lock);
    }
 
    for (uint64_t i = 0; i < amount; i++)
    {
        wait_entry_t* entry = malloc(sizeof(wait_entry_t));
        if (entry == NULL)
        {
            while (1)
            {
                wait_entry_t* other =
                    CONTAINER_OF_SAFE(list_pop_first(&thread->wait.entries), wait_entry_t, threadEntry);
                if (other == NULL)
                {
                    break;
                }
                free(other);
            }
 
            for (uint64_t j = 0; j < amount; j++)
            {
                lock_release(&waitQueues[j]->lock);
            }
 
            cpu_put(); // Interrupts enable.
            errno = ENOMEM;
            return ERR;
        }
        list_entry_init(&entry->queueEntry);
        list_entry_init(&entry->threadEntry);
        entry->queue = waitQueues[i];
        entry->thread = thread;
 
        list_push_back(&thread->wait.entries, &entry->threadEntry);
        list_push_back(&entry->queue->entries, &entry->queueEntry);
    }
 
    thread->wait.err = EOK;
    thread->wait.deadline = CLOCKS_DEADLINE(timeout, sys_time_uptime());
    thread->wait.owner = NULL;
 
    for (uint64_t i = 0; i < amount; i++)
    {
        lock_release(&waitQueues[i]->lock);
    }
 
    thread_state_t expected = THREAD_ACTIVE;
    if (!atomic_compare_exchange_strong(&thread->state, &expected, THREAD_PRE_BLOCK))
    {
        if (expected != THREAD_UNBLOCKING)
        {
            panic(NULL, "Thread in invalid state in wait_block_prepare() state=%d", expected);
        }
        // We wait until the wait_block_commit() or wait_block_cancel() to actually do the early unblock.
    }
 
    // Return without enabling interrupts, they will be enabled in wait_block_commit() or wait_block_cancel().
    return 0;
}
 
void wait_block_cancel(void)
{
    assert(!(rflags_read() & RFLAGS_INTERRUPT_ENABLE));
 
    thread_t* thread = cpu_get_unsafe()->sched.runThread;
    assert(thread != NULL);
 
    thread_state_t state = atomic_exchange(&thread->state, THREAD_UNBLOCKING);
 
    // State might already be unblocking if the thread unblocked prematurely.
    assert(state == THREAD_PRE_BLOCK || state == THREAD_UNBLOCKING);
 
    wait_remove_wait_entries(thread, EOK);
 
    thread_state_t newState = atomic_exchange(&thread->state, THREAD_ACTIVE);
    assert(newState == THREAD_UNBLOCKING); // Make sure state did not change.
 
    cpu_put(); // Release cpu from wait_block_prepare().
    assert(rflags_read() & RFLAGS_INTERRUPT_ENABLE);
}
 
uint64_t wait_block_commit(void)
{
    thread_t* thread = cpu_get_unsafe()->sched.runThread;
 
    assert(!(rflags_read() & RFLAGS_INTERRUPT_ENABLE));
 
    thread_state_t state = atomic_load(&thread->state);
    switch (state)
    {
    case THREAD_UNBLOCKING:
        wait_remove_wait_entries(thread, EOK);
        atomic_store(&thread->state, THREAD_ACTIVE);
        cpu_put(); // Release cpu from wait_block_prepare().
        break;
    case THREAD_PRE_BLOCK:
        cpu_put(); // Release cpu from wait_block_prepare().
        ipi_invoke();
        break;
    default:
        panic(NULL, "Invalid thread state %d in wait_block_commit()", state);
    }
 
    assert(rflags_read() & RFLAGS_INTERRUPT_ENABLE);
 
    if (thread->wait.err != EOK)
    {
        errno = thread->wait.err;
        return ERR;
    }
    return 0;
}
 
bool wait_block_finalize(interrupt_frame_t* frame, cpu_t* self, thread_t* thread, clock_t uptime)
{
    (void)frame; // Unused
 
    thread->wait.owner = &self->wait;
    LOCK_SCOPE(&self->wait.lock);
 
    thread_t* lastThread = (CONTAINER_OF(list_last(&self->wait.blockedThreads), thread_t, wait.entry));
 
    // Sort blocked threads by deadline
    if (thread->wait.deadline == CLOCKS_NEVER || list_is_empty(&self->wait.blockedThreads) ||
        lastThread->wait.deadline <= thread->wait.deadline)
    {
        list_push_back(&self->wait.blockedThreads, &thread->wait.entry);
    }
    else
    {
        thread_t* other;
        LIST_FOR_EACH(other, &self->wait.blockedThreads, wait.entry)
        {
            if (other->wait.deadline > thread->wait.deadline)
            {
                list_prepend(&self->wait.blockedThreads, &other->wait.entry, &thread->wait.entry);
                break;
            }
        }
    }
 
    thread_state_t expected = THREAD_PRE_BLOCK;
    if (!atomic_compare_exchange_strong(&thread->state, &expected, THREAD_BLOCKED)) // Prematurely unblocked
    {
        list_remove(&self->wait.blockedThreads, &thread->wait.entry);
        wait_remove_wait_entries(thread, EOK);
        atomic_store(&thread->state, THREAD_ACTIVE);
        return false;
    }
 
    if (thread_is_note_pending(thread))
    {
        thread_state_t expected = THREAD_BLOCKED;
        if (atomic_compare_exchange_strong(&thread->state, &expected, THREAD_UNBLOCKING))
        {
            list_remove(&self->wait.blockedThreads, &thread->wait.entry);
            wait_remove_wait_entries(thread, EINTR);
            atomic_store(&thread->state, THREAD_ACTIVE);
            return false;
        }
    }
 
    timer_set(uptime, thread->wait.deadline);
    return true;
}
 
void wait_unblock_thread(thread_t* thread, errno_t err)
{
    assert(atomic_load(&thread->state) == THREAD_UNBLOCKING);
 
    lock_acquire(&thread->wait.owner->lock);
    list_remove(&thread->wait.owner->blockedThreads, &thread->wait.entry);
    wait_remove_wait_entries(thread, err);
    lock_release(&thread->wait.owner->lock);
 
    sched_submit(thread);
}
 
uint64_t wait_unblock(wait_queue_t* queue, uint64_t amount, errno_t err)
{
    uint64_t amountUnblocked = 0;
 
    const uint64_t threadsPerBatch = 64;
    while (1)
    {
        // For consistent lock ordering we first remove from the wait queue, release the wait queues lock and then
        // acquire the threads cpu lock. Such that every time we acquire the locks its, cpu lock -> wait queue lock.
 
        thread_t* threads[threadsPerBatch];
        uint64_t toUnblock = amount < threadsPerBatch ? amount : threadsPerBatch;
 
        lock_acquire(&queue->lock);
 
        wait_entry_t* temp;
        wait_entry_t* waitEntry;
        uint64_t collected = 0;
        LIST_FOR_EACH_SAFE(waitEntry, temp, &queue->entries, queueEntry)
        {
            if (collected == toUnblock)
            {
                break;
            }
 
            thread_t* thread = waitEntry->thread;
 
            if (atomic_exchange(&thread->state, THREAD_UNBLOCKING) == THREAD_BLOCKED)
            {
                list_remove(&queue->entries, &waitEntry->queueEntry);
                list_remove(&thread->wait.entries, &waitEntry->threadEntry);
                free(waitEntry);
                threads[collected] = thread;
                collected++;
            }
        }
 
        lock_release(&queue->lock);
 
        if (collected == 0)
        {
            break;
        }
 
        for (uint64_t i = 0; i < collected; i++)
        {
            lock_acquire(&threads[i]->wait.owner->lock);
            list_remove(&threads[i]->wait.owner->blockedThreads, &threads[i]->wait.entry);
            wait_remove_wait_entries(threads[i], err);
            lock_release(&threads[i]->wait.owner->lock);
 
            sched_submit(threads[i]);
            amountUnblocked++;
        }
    }
 
    return amountUnblocked;
}