From 0c5ba0b879baa5291d35dd0a5028ab9a5d52560d Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Thu, 21 Mar 2013 21:20:18 +0100 Subject: digital/io-hub/src/apbirthday: add FSM queue --- digital/io-hub/src/common-cc/fsm_queue.cc | 50 +++++++++++++++++++++++++++++++ 1 file changed, 50 insertions(+) create mode 100644 digital/io-hub/src/common-cc/fsm_queue.cc (limited to 'digital/io-hub/src/common-cc/fsm_queue.cc') diff --git a/digital/io-hub/src/common-cc/fsm_queue.cc b/digital/io-hub/src/common-cc/fsm_queue.cc new file mode 100644 index 00000000..816d836d --- /dev/null +++ b/digital/io-hub/src/common-cc/fsm_queue.cc @@ -0,0 +1,50 @@ +// io-hub - Modular Input/Output. {{{ +// +// Copyright (C) 2013 Nicolas Schodet +// +// APBTeam: +// Web: http://apbteam.org/ +// Email: team AT apbteam DOT org +// +// 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 of the License, 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; if not, write to the Free Software +// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. +// +// }}} +#include "fsm_queue.hh" + +FsmQueue::FsmQueue () + : head_ (0), nb_ (0) +{ +} + +void +FsmQueue::post (Event e) +{ + ucoo::assert (nb_ < queue_size_); + int tail = (head_ + nb_) % queue_size_; + events_[tail] = e; + nb_++; +} + +FsmQueue::Event +FsmQueue::pop () +{ + Event e; + ucoo::assert (nb_ > 0); + e = events_[head_]; + nb_--; + head_ = (head_ + 1) % queue_size_; + return e; +} + -- cgit v1.2.3