RtosMsgBox.hpp

//------------------------------------------------------------------------------
//This file is part of embKernel. 
//See license.txt for the full license governing this code.
//------------------------------------------------------------------------------
#ifndef RTOS_MSG_BOX_HPP_
#define RTOS_MSG_BOX_HPP_

#include "RtosSyncObject.hpp"

template<class T, int N>
class RtosMsgBox: public RtosSyncObject {
public:
    RtosMsgBox();
    ~RtosMsgBox();

    T mArray[N];

    int mIdxIn;
    int mIdxOut;

    bool give(T& msg, Rtos::TICK tick);
    bool giveFromInt(T& msg);
    bool take(T& msg, Rtos::TICK tick);
    bool takeFromInt(T& msg);
};

template<class T, int N>
RtosMsgBox<T, N>::RtosMsgBox() :
        RtosSyncObject(N, 0) {
    mIdxIn = 0;
    mIdxOut = 0;
}

template<class T, int N>
RtosMsgBox<T, N>::~RtosMsgBox() {

}

template<class T, int N>
bool RtosMsgBox<T, N>::give(T& msg, Rtos::TICK tick) {
    bool result = internalGive(tick, 1);
    if (result) {
        mArray[mIdxIn] = msg;
        mIdxIn = (mIdxIn + 1) % N;
        internalWakeUpWaitingToTake();
    }
    exitCritical();
    return result;
}

template<class T, int N>
bool RtosMsgBox<T, N>::giveFromInt(T& msg) {
    if (mCurrentCount < mMaxCount) {
        mCurrentCount++;
        mArray[mIdxIn] = msg;
        mIdxIn = (mIdxIn + 1) % N;
        internalWakeUpWaitingToTake();
        return true;
    }
    return false;
}

template<class T, int N>
bool RtosMsgBox<T, N>::take(T& msg, Rtos::TICK tick) {
    bool result = internalTake(tick, 1);
    if (result) {
        msg = mArray[mIdxOut];
        mIdxOut = (mIdxOut + 1) % N;
        internalWakeUpWaitingToGive();
    }
    exitCritical();
    return result;
}

template<class T, int N>
bool RtosMsgBox<T, N>::takeFromInt(T& msg) {
    if (mCurrentCount >= 0) {
        mCurrentCount--;
        msg = mArray[mIdxOut];
        mIdxOut = (mIdxOut + 1) % N;
        internalWakeUpWaitingToGive();
        return true;
    }
    return false;
}

#endif /* RTOS_MSG_BOX_HPP_ */