ardupilot/libraries/AP_HAL_Linux/Semaphores.cpp

#include "Semaphores.h"

using namespace Linux;

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

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

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