/* * Copyright (C) 2015 Jared Boone, ShareBrained Technology, Inc. * * This file is part of PortaPack. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2, or (at your option) * any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; see the file COPYING. If not, write to * the Free Software Foundation, Inc., 51 Franklin Street, * Boston, MA 02110-1301, USA. */ #ifndef __MESSAGE_QUEUE_H__ #define __MESSAGE_QUEUE_H__ #include <cstdint> #include "message.hpp" #include "fifo.hpp" #include "lpc43xx_cpp.hpp" using namespace lpc43xx; #include <ch.h> template<size_t K> class MessageQueue { public: MessageQueue() { chMtxInit(&mutex_write); } template<typename T> bool push(const T& message) { static_assert(sizeof(T) <= Message::MAX_SIZE, "Message::MAX_SIZE too small for message type"); static_assert(std::is_base_of<Message, T>::value, "type is not based on Message"); return push(&message, sizeof(message)); } Message* pop(std::array<uint8_t, Message::MAX_SIZE>& buf) { Message* const p = reinterpret_cast<Message*>(buf.data()); return fifo.out_r(buf.data(), buf.size()) ? p : nullptr; } size_t len() const { return fifo.len(); } bool is_empty() const { return fifo.is_empty(); } private: FIFO<uint8_t, K> fifo; Mutex mutex_write; bool push(const void* const buf, const size_t len) { chMtxLock(&mutex_write); const auto result = fifo.in_r(buf, len); chMtxUnlock(); const bool success = (result == len); if( success ) { signal(); } return success; } #if defined(LPC43XX_M0) void signal() { creg::m0apptxevent::assert(); } #endif #if defined(LPC43XX_M4) void signal() { creg::m4txevent::assert(); } #endif }; #endif/*__MESSAGE_QUEUE_H__*/