semaphore.c

Go to the documentation of this file.

 
#include "icarus/semaphore.h"
#include "icarus/kernel.h"
#include "icarus/scheduler.h"
 
/* ============================================================================
 * SECTION PLACEMENT MACROS
 * ========================================================================= */
 
/* Defined centrally in icarus/config.h — included via icarus/kernel.h */
 
/* ============================================================================
 * SEMAPHORE IMPLEMENTATION
 * ========================================================================= */
 
ITCM_FUNC bool __semaphore_init(uint8_t semaphore_idx, uint32_t semaphore_count) {
    if ((semaphore_idx < (uint8_t)ICARUS_MAX_SEMAPHORES) && (semaphore_count > 0u)) {
        if (!semaphore_list[semaphore_idx]->engaged) {
            semaphore_list[semaphore_idx]->count = semaphore_count;
            semaphore_list[semaphore_idx]->max_count = semaphore_count;
            semaphore_list[semaphore_idx]->tick_updated_at = os_tick_count;
            semaphore_list[semaphore_idx]->engaged = true;
            return true;
        }
    }
 
    return false;
}
 
ITCM_FUNC bool __semaphore_feed(uint8_t semaphore_idx) {
#ifdef HOST_TEST
    /* In host tests, check validity directly (no MPU) */
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return false;
    }
#else
    /* On target, index check only — gate checks engaged via SVC */
    if (semaphore_idx >= ICARUS_MAX_SEMAPHORES) {
        return false;
    }
#endif
 
    while (!sem_can_feed(semaphore_idx)) {
        (void)task_active_sleep(1);
    }
 
    sem_increment(semaphore_idx);
    return true;
}
 
ITCM_FUNC bool __semaphore_consume(uint8_t semaphore_idx) {
#ifdef HOST_TEST
    /* In host tests, check validity directly (no MPU) */
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return false;
    }
#else
    /* On target, index check only — gate checks engaged via SVC */
    if (semaphore_idx >= ICARUS_MAX_SEMAPHORES) {
        return false;
    }
#endif
 
    while (!sem_can_consume(semaphore_idx)) {
        (void)task_active_sleep(1);
    }
 
    sem_decrement(semaphore_idx);
    return true;
}
 
ITCM_FUNC bool __semaphore_consume_timeout(uint8_t semaphore_idx,
                                            uint32_t max_ticks) {
#ifdef HOST_TEST
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return false;
    }
#else
    if (semaphore_idx >= ICARUS_MAX_SEMAPHORES) {
        return false;
    }
#endif
 
    uint32_t waited = 0;
    while (!sem_can_consume(semaphore_idx)) {
        if (waited >= max_ticks) {
            return false;
        }
        (void)task_active_sleep(1);
        waited++;
    }
 
    sem_decrement(semaphore_idx);
    return true;
}
 
ITCM_FUNC uint32_t __semaphore_get_count(uint8_t semaphore_idx) {
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return 0;
    }
    return semaphore_list[semaphore_idx]->count;
}
 
ITCM_FUNC uint32_t __semaphore_get_max_count(uint8_t semaphore_idx) {
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return 0;
    }
    return semaphore_list[semaphore_idx]->max_count;
}
 
ITCM_FUNC bool __sem_can_feed(uint8_t semaphore_idx) {
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return false;
    }
    return semaphore_list[semaphore_idx]->count <
           semaphore_list[semaphore_idx]->max_count;
}
 
ITCM_FUNC bool __sem_can_consume(uint8_t semaphore_idx) {
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return false;
    }
    return semaphore_list[semaphore_idx]->count > 0u;
}
 
ITCM_FUNC void __sem_increment(uint8_t semaphore_idx) {
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return;
    }
    ++semaphore_list[semaphore_idx]->count;
    semaphore_list[semaphore_idx]->tick_updated_at = os_tick_count;
}
 
ITCM_FUNC void __sem_decrement(uint8_t semaphore_idx) {
    if ((semaphore_idx >= (uint8_t)ICARUS_MAX_SEMAPHORES) ||
        (!semaphore_list[semaphore_idx]->engaged)) {
        return;
    }
    --semaphore_list[semaphore_idx]->count;
    semaphore_list[semaphore_idx]->tick_updated_at = os_tick_count;
}