RIOT/sys/sema/sema.c

/*
 * Copyright (C) 2016 TriaGnoSys GmbH
 *               2013-15 Freie Universität Berlin
 *
 * This file is subject to the terms and conditions of the GNU Lesser
 * General Public License v2.1. See the file LICENSE in the top level
 * directory for more details.
 */

/**
 * @{
 *
 * @file
 *
 * @author  Víctor Ariño <victor.arino@zii.aero>
 */

#include <errno.h>
#include "irq.h"
#include "assert.h"
#include "sema.h"
#include "xtimer.h"

#define ENABLE_DEBUG (0)
#include "debug.h"

void sema_create(sema_t *sema, unsigned int value)
{
    assert(sema != NULL);

    sema->value = value;
    sema->state = SEMA_OK;
    mutex_init(&sema->mutex);
    if (value == 0) {
        mutex_lock(&sema->mutex);
    }
}

void sema_destroy(sema_t *sema)
{
    assert(sema != NULL);

    sema->state = SEMA_DESTROY;
    mutex_unlock(&sema->mutex);
}

int sema_try_wait(sema_t *sema)
{
    assert(sema != NULL);

    int ret = -ECANCELED;
    if (sema->state == SEMA_OK) {
        ret = -EAGAIN;
        unsigned old = irq_disable();
        if (sema->value > 0) {
            --sema->value;
            ret = 0;
        }
        irq_restore(old);
    }

    return ret;
}

int sema_wait_timed(sema_t *sema, uint64_t us)
{
    assert(sema != NULL);

    if (sema->state != SEMA_OK) {
        return -ECANCELED;
    }

    unsigned old = irq_disable();
    if (sema->value == 0) {
        irq_restore(old);
        int timeout = xtimer_mutex_lock_timeout(&sema->mutex, us);

        if (sema->state != SEMA_OK) {
            mutex_unlock(&sema->mutex);
            return -ECANCELED;
        }

        if (timeout) {
            return -ETIMEDOUT;
        }

        old = irq_disable();
    }

    unsigned int value = --sema->value;
    irq_restore(old);

    if (value > 0) {
        mutex_unlock(&sema->mutex);
    }

    return 0;
}

int sema_post(sema_t *sema)
{
    assert(sema != NULL);

    unsigned old = irq_disable();
    if (sema->value == UINT_MAX) {
        irq_restore(old);
        return -EOVERFLOW;
    }

    unsigned value = sema->value++;
    irq_restore(old);

    if (value == 0) {
        mutex_unlock(&sema->mutex);
    }

    return 0;
}
/** @} */