MuditaOS/module-sys/Service/Mailbox.hpp

/*
 * Mailbox.hpp
 *
 *  Created on: Mar 7, 2019
 *      Author: mati
 */

#ifndef SYSTEMMANAGER_MAILBOX_HPP_
#define SYSTEMMANAGER_MAILBOX_HPP_


#include <deque>
#include "thread.hpp"
#include <mutex.hpp>
#include <condition_variable.hpp>

using namespace cpp_freertos;

template <typename T>
class Mailbox
{
public:

	Mailbox(Thread* thread): thread_(thread)
	{
	}

    T peek()
    {

        LockGuard mlock(mutex_);
        while (queue_.empty())
        {
            thread_->Wait(cond_,mutex_);
        }
        auto item = queue_.front();
        return item;
    }

	T pop(uint32_t timeout = portMAX_DELAY)
	{

		LockGuard mlock(mutex_);
		while (queue_.empty())
		{
			if(thread_->Wait(cond_,mutex_,timeout) == false){
			    return nullptr;
			}
		}
		auto item = queue_.front();
		queue_.pop_front();
		return item;
	}

	void pop(T& item)
	{
		LockGuard mlock(mutex_);
		while (queue_.empty())
		{
			thread_->Wait(cond_,mutex_);
		}
		item = queue_.front();
		queue_.pop_front();
	}

	void push_front(const T& item)
    {
        mutex_.Lock();
        queue_.push_front(item);
        mutex_.Unlock();
    }

	void push(const T& item)
	{
		mutex_.Lock();
		queue_.push_back(item);
		mutex_.Unlock();
		cond_.Signal();
	}

	void push(T&& item)
	{
		mutex_.Lock();
		queue_.push_back(std::move(item));
		mutex_.Unlock();
		cond_.Signal();
	}

private:
	Thread*		 thread_;
	std::deque<T> queue_;
	MutexStandard mutex_;
	ConditionVariable cond_;

};


#endif /* SYSTEMMANAGER_MAILBOX_HPP_ */