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 +++++++++++++++++++++++++ digital/io-hub/src/common-cc/fsm_queue.hh | 62 +++++++++++++++++++++++++++++++ 2 files changed, 112 insertions(+) create mode 100644 digital/io-hub/src/common-cc/fsm_queue.cc create mode 100644 digital/io-hub/src/common-cc/fsm_queue.hh (limited to 'digital/io-hub/src/common-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; +} + diff --git a/digital/io-hub/src/common-cc/fsm_queue.hh b/digital/io-hub/src/common-cc/fsm_queue.hh new file mode 100644 index 00000000..333bea80 --- /dev/null +++ b/digital/io-hub/src/common-cc/fsm_queue.hh @@ -0,0 +1,62 @@ +#ifndef fsm_queue_hh +#define fsm_queue_hh +// 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 "ucoolib/common.hh" + +extern "C" { +#define ANGFSM_NAME AI +#include "angfsm.h" +} + +/// Handle asynchronous FSM event queue. +class FsmQueue +{ + public: +#ifdef TARGET_host + typedef uint16_t Event; +#else + typedef angfsm_AI_event_t Event; +#endif + public: + /// Constructor. + FsmQueue (); + /// Post an event to be processed in the next main loop. + void post (Event e); + /// Poll for event (return true if there is an event pending). + bool poll () const { return nb_ != 0; } + /// Pop one event from the queue. + Event pop (); + private: + /// Maximum number of events in the queue. + static const int queue_size_ = 8; + /// Events to post to the FSM in next iteration. + Event events_[queue_size_]; + /// First event in the queue. + int head_; + /// Number of events in the queue. + int nb_; +}; + +#endif // fsm_queue_hh -- cgit v1.2.3