FifoQueueBase.hpp

Go to the documentation of this file.

#ifndef INCLUDE_DISTORTOS_INTERNAL_SYNCHRONIZATION_FIFOQUEUEBASE_HPP_
#define INCLUDE_DISTORTOS_INTERNAL_SYNCHRONIZATION_FIFOQUEUEBASE_HPP_

#include "distortos/Semaphore.hpp"

#include "distortos/internal/synchronization/QueueFunctor.hpp"
#include "distortos/internal/synchronization/SemaphoreFunctor.hpp"

#include <memory>

namespace distortos
{

namespace internal
{

class FifoQueueBase
{
public:

    using StorageUniquePointer = std::unique_ptr<void, void(&)(void*)>;

    FifoQueueBase(StorageUniquePointer&& storageUniquePointer, size_t elementSize, size_t maxElements);

    ~FifoQueueBase();

    size_t getCapacity() const
    {
        return popSemaphore_.getMaxValue();
    }

    size_t getElementSize() const
    {
        return elementSize_;
    }

    int pop(const SemaphoreFunctor& waitSemaphoreFunctor, const QueueFunctor& functor)
    {
        return popPush(waitSemaphoreFunctor, functor, popSemaphore_, pushSemaphore_, readPosition_);
    }

    int push(const SemaphoreFunctor& waitSemaphoreFunctor, const QueueFunctor& functor)
    {
        return popPush(waitSemaphoreFunctor, functor, pushSemaphore_, popSemaphore_, writePosition_);
    }

private:

    int popPush(const SemaphoreFunctor& waitSemaphoreFunctor, const QueueFunctor& functor, Semaphore& waitSemaphore,
            Semaphore& postSemaphore, void*& storage);

    Semaphore popSemaphore_;

    Semaphore pushSemaphore_;

    const StorageUniquePointer storageUniquePointer_;

    const void* const storageEnd_;

    void* readPosition_;

    void* writePosition_;

    const size_t elementSize_;
};

}   // namespace internal

}   // namespace distortos

#endif  // INCLUDE_DISTORTOS_INTERNAL_SYNCHRONIZATION_FIFOQUEUEBASE_HPP_