watchrobot/libraries/AP_HAL_Empty/Semaphores.cpp

#include "Semaphores.h"

using namespace Empty;

bool Semaphore::give() {
    if (_taken) {
        _taken = false;
        return true;
    } else {
        return false;
    }
}

bool Semaphore::take(uint32_t timeout_ms) {
    return take_nonblocking();
}

bool Semaphore::take_nonblocking() {
    /* No syncronisation primitives to garuntee this is correct */
    if (!_taken) {
        _taken = true;
        return true;
    } else {
        return false;
    }
}