My fork
Dependencies: BLE_API nRF51822-bluetooth-mdw
Fork of microbit-dal by
Diff: source/drivers/MicroBitMessageBus.cpp
- Revision:
- 1:8aa5cdb4ab67
- Child:
- 5:f0f1cecd65d8
diff -r fb15f7887843 -r 8aa5cdb4ab67 source/drivers/MicroBitMessageBus.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/source/drivers/MicroBitMessageBus.cpp Thu Apr 07 01:33:22 2016 +0100 @@ -0,0 +1,552 @@ +/* +The MIT License (MIT) + +Copyright (c) 2016 British Broadcasting Corporation. +This software is provided by Lancaster University by arrangement with the BBC. + +Permission is hereby granted, free of charge, to any person obtaining a +copy of this software and associated documentation files (the "Software"), +to deal in the Software without restriction, including without limitation +the rights to use, copy, modify, merge, publish, distribute, sublicense, +and/or sell copies of the Software, and to permit persons to whom the +Software is furnished to do so, subject to the following conditions: + +The above copyright notice and this permission notice shall be included in +all copies or substantial portions of the Software. + +THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR +IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, +FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL +THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER +LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING +FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER +DEALINGS IN THE SOFTWARE. +*/ + +/** + * Class definition for the MicroBitMessageBus. + * + * The MicroBitMessageBus is the common mechanism to deliver asynchronous events on the + * MicroBit platform. It serves a number of purposes: + * + * 1) It provides an eventing abstraction that is independent of the underlying substrate. + * + * 2) It provides a mechanism to decouple user code from trusted system code + * i.e. the basis of a message passing nano kernel. + * + * 3) It allows a common high level eventing abstraction across a range of hardware types.e.g. buttons, BLE... + * + * 4) It provides a mechanim for extensibility - new devices added via I/O pins can have OO based + * drivers and communicate via the message bus with minima impact on user level languages. + * + * 5) It allows for the possiblility of event / data aggregation, which in turn can save energy. + * + * It has the following design principles: + * + * 1) Maintain a low RAM footprint where possible + * + * 2) Make few assumptions about the underlying platform, but allow optimizations where possible. + */ +#include "MicroBitConfig.h" +#include "MicroBitMessageBus.h" +#include "MicroBitFiber.h" +#include "ErrorNo.h" + +/** + * Default constructor. + * + * Adds itself as a fiber component, and also configures itself to be the + * default EventModel if defaultEventBus is NULL. + */ +MicroBitMessageBus::MicroBitMessageBus() +{ + this->listeners = NULL; + this->evt_queue_head = NULL; + this->evt_queue_tail = NULL; + this->queueLength = 0; + + fiber_add_idle_component(this); + + if(EventModel::defaultEventBus == NULL) + EventModel::defaultEventBus = this; +} + +/** + * Invokes a callback on a given MicroBitListener + * + * Internal wrapper function, used to enable + * parameterised callbacks through the fiber scheduler. + */ +void async_callback(void *param) +{ + MicroBitListener *listener = (MicroBitListener *)param; + + // OK, now we need to decide how to behave depending on our configuration. + // If this a fiber f already active within this listener then check our + // configuration to determine the correct course of action. + // + + if (listener->flags & MESSAGE_BUS_LISTENER_BUSY) + { + // Drop this event, if that's how we've been configured. + if (listener->flags & MESSAGE_BUS_LISTENER_DROP_IF_BUSY) + return; + + // Queue this event up for later, if that's how we've been configured. + if (listener->flags & MESSAGE_BUS_LISTENER_QUEUE_IF_BUSY) + { + listener->queue(listener->evt); + return; + } + } + + // Determine the calling convention for the callback, and invoke... + // C++ is really bad at this! Especially as the ARM compiler is yet to support C++ 11 :-/ + + // Record that we have a fiber going into this listener... + listener->flags |= MESSAGE_BUS_LISTENER_BUSY; + + while (1) + { + // Firstly, check for a method callback into an object. + if (listener->flags & MESSAGE_BUS_LISTENER_METHOD) + listener->cb_method->fire(listener->evt); + + // Now a parameterised C function + else if (listener->flags & MESSAGE_BUS_LISTENER_PARAMETERISED) + listener->cb_param(listener->evt, listener->cb_arg); + + // We must have a plain C function + else + listener->cb(listener->evt); + + // If there are more events to process, dequeue the next one and process it. + if ((listener->flags & MESSAGE_BUS_LISTENER_QUEUE_IF_BUSY) && listener->evt_queue) + { + MicroBitEventQueueItem *item = listener->evt_queue; + + listener->evt = item->evt; + listener->evt_queue = listener->evt_queue->next; + delete item; + + // We spin the scheduler here, to preven any particular event handler from continuously holding onto resources. + schedule(); + } + else + break; + } + + // The fiber of exiting... clear our state. + listener->flags &= ~MESSAGE_BUS_LISTENER_BUSY; +} + +/** + * Queue the given event for processing at a later time. + * Add the given event at the tail of our queue. + * + * @param The event to queue. + */ +void MicroBitMessageBus::queueEvent(MicroBitEvent &evt) +{ + int processingComplete; + + MicroBitEventQueueItem *prev = evt_queue_tail; + + // Now process all handler regsitered as URGENT. + // These pre-empt the queue, and are useful for fast, high priority services. + processingComplete = this->process(evt, true); + + // If we've already processed all event handlers, we're all done. + // No need to queue the event. + if (processingComplete) + return; + + // If we need to queue, but there is no space, then there's nothg we can do. + if (queueLength >= MESSAGE_BUS_LISTENER_MAX_QUEUE_DEPTH) + return; + + // Otherwise, we need to queue this event for later processing... + // We queue this event at the tail of the queue at the point where we entered queueEvent() + // This is important as the processing above *may* have generated further events, and + // we want to maintain ordering of events. + MicroBitEventQueueItem *item = new MicroBitEventQueueItem(evt); + + // The queue was empty when we entered this function, so queue our event at the start of the queue. + __disable_irq(); + + if (prev == NULL) + { + item->next = evt_queue_head; + evt_queue_head = item; + } + else + { + item->next = prev->next; + prev->next = item; + } + + if (item->next == NULL) + evt_queue_tail = item; + + queueLength++; + + __enable_irq(); +} + +/** + * Extract the next event from the front of the event queue (if present). + * + * @return a pointer to the MicroBitEventQueueItem that is at the head of the list. + */ +MicroBitEventQueueItem* MicroBitMessageBus::dequeueEvent() +{ + MicroBitEventQueueItem *item = NULL; + + __disable_irq(); + + if (evt_queue_head != NULL) + { + item = evt_queue_head; + evt_queue_head = item->next; + + if (evt_queue_head == NULL) + evt_queue_tail = NULL; + + queueLength--; + } + + __enable_irq(); + + + return item; +} + +/** + * Cleanup any MicroBitListeners marked for deletion from the list. + * + * @return The number of listeners removed from the list. + */ +int MicroBitMessageBus::deleteMarkedListeners() +{ + MicroBitListener *l, *p; + int removed = 0; + + l = listeners; + p = NULL; + + // Walk this list of event handlers. Delete any that match the given listener. + while (l != NULL) + { + if (l->flags & MESSAGE_BUS_LISTENER_DELETING && !l->flags & MESSAGE_BUS_LISTENER_BUSY) + { + if (p == NULL) + listeners = l->next; + else + p->next = l->next; + + // delete the listener. + MicroBitListener *t = l; + l = l->next; + + delete t; + removed++; + + continue; + } + + p = l; + l = l->next; + } + + return removed; +} + +/** + * Periodic callback from MicroBit. + * + * Process at least one event from the event queue, if it is not empty. + * We then continue processing events until something appears on the runqueue. + */ +void MicroBitMessageBus::idleTick() +{ + // Clear out any listeners marked for deletion + this->deleteMarkedListeners(); + + MicroBitEventQueueItem *item = this->dequeueEvent(); + + // Whilst there are events to process and we have no useful other work to do, pull them off the queue and process them. + while (item) + { + // send the event to all standard event listeners. + this->process(item->evt); + + // Free the queue item. + delete item; + + // If we have created some useful work to do, we stop processing. + // This helps to minimise the number of blocked fibers we create at any point in time, therefore + // also reducing the RAM footprint. + if(!scheduler_runqueue_empty()) + break; + + // Pull the next event to process, if there is one. + item = this->dequeueEvent(); + } +} + +/** + * Indicates whether or not we have any background work to do. + * + * @return 1 if there are any events waitingto be processed, 0 otherwise. + */ +int MicroBitMessageBus::isIdleCallbackNeeded() +{ + return !(evt_queue_head == NULL); +} + +/** + * Queues the given event to be sent to all registered recipients. + * + * @param evt The event to send. + * + * @code + * MicroBitMessageBus bus; + * + * // Creates and sends the MicroBitEvent using bus. + * MicrobitEvent evt(MICROBIT_ID_BUTTON_A, MICROBIT_BUTTON_EVT_CLICK); + * + * // Creates the MicrobitEvent, but delays the sending of that event. + * MicrobitEvent evt1(MICROBIT_ID_BUTTON_A, MICROBIT_BUTTON_EVT_CLICK, CREATE_ONLY); + * + * bus.send(evt1); + * + * // This has the same effect! + * evt1.fire() + * @endcode + */ +int MicroBitMessageBus::send(MicroBitEvent evt) +{ + // We simply queue processing of the event until we're scheduled in normal thread context. + // We do this to avoid the possibility of executing event handler code in IRQ context, which may bring + // hidden race conditions to kids code. Queuing all events ensures causal ordering (total ordering in fact). + this->queueEvent(evt); + return MICROBIT_OK; +} + +/** + * Internal function, used to deliver the given event to all relevant recipients. + * Normally, this is called once an event has been removed from the event queue. + * + * @param evt The event to send. + * + * @param urgent The type of listeners to process (optional). If set to true, only listeners defined as urgent and non-blocking will be processed + * otherwise, all other (standard) listeners will be processed. Defaults to false. + * + * @return 1 if all matching listeners were processed, 0 if further processing is required. + * + * @note It is recommended that all external code uses the send() function instead of this function, + * or the constructors provided by MicrobitEvent. + */ +int MicroBitMessageBus::process(MicroBitEvent &evt, bool urgent) +{ + MicroBitListener *l; + int complete = 1; + bool listenerUrgent; + + l = listeners; + while (l != NULL) + { + if((l->id == evt.source || l->id == MICROBIT_ID_ANY) && (l->value == evt.value || l->value == MICROBIT_EVT_ANY)) + { + listenerUrgent = (l->flags & MESSAGE_BUS_LISTENER_IMMEDIATE) == MESSAGE_BUS_LISTENER_IMMEDIATE; + if(listenerUrgent == urgent && !(l->flags & MESSAGE_BUS_LISTENER_DELETING)) + { + l->evt = evt; + + // OK, if this handler has regisitered itself as non-blocking, we just execute it directly... + // This is normally only done for trusted system components. + // Otherwise, we invoke it in a 'fork on block' context, that will automatically create a fiber + // should the event handler attempt a blocking operation, but doesn't have the overhead + // of creating a fiber needlessly. (cool huh?) + if (l->flags & MESSAGE_BUS_LISTENER_NONBLOCKING || !fiber_scheduler_running()) + async_callback(l); + else + invoke(async_callback, l); + } + else + { + complete = 0; + } + } + + l = l->next; + } + + return complete; +} + +/** + * Add the given MicroBitListener to the list of event handlers, unconditionally. + * + * @param listener The MicroBitListener to add. + * + * @return MICROBIT_OK if the listener is valid, MICROBIT_INVALID_PARAMETER otherwise. + */ +int MicroBitMessageBus::add(MicroBitListener *newListener) +{ + MicroBitListener *l, *p; + int methodCallback; + + //handler can't be NULL! + if (newListener == NULL) + return MICROBIT_INVALID_PARAMETER; + + l = listeners; + + // Firstly, we treat a listener as an idempotent operation. Ensure we don't already have this handler + // registered in a that will already capture these events. If we do, silently ignore. + + // We always check the ID, VALUE and CB_METHOD fields. + // If we have a callback to a method, check the cb_method class. Otherwise, the cb function point is sufficient. + while (l != NULL) + { + methodCallback = (newListener->flags & MESSAGE_BUS_LISTENER_METHOD) && (l->flags & MESSAGE_BUS_LISTENER_METHOD); + + if (l->id == newListener->id && l->value == newListener->value && (methodCallback ? *l->cb_method == *newListener->cb_method : l->cb == newListener->cb)) + { + // We have a perfect match for this event listener already registered. + // If it's marked for deletion, we simply resurrect the listener, and we're done. + // Either way, we return an error code, as the *new* listener should be released... + if(l->flags & MESSAGE_BUS_LISTENER_DELETING) + l->flags &= ~MESSAGE_BUS_LISTENER_DELETING; + + return MICROBIT_NOT_SUPPORTED; + } + + l = l->next; + } + + // We have a valid, new event handler. Add it to the list. + // if listeners is null - we can automatically add this listener to the list at the beginning... + if (listeners == NULL) + { + listeners = newListener; + MicroBitEvent(MICROBIT_ID_MESSAGE_BUS_LISTENER, newListener->id); + + return MICROBIT_OK; + } + + // We maintain an ordered list of listeners. + // The chain is held stictly in increasing order of ID (first level), then value code (second level). + // Find the correct point in the chain for this event. + // Adding a listener is a rare occurance, so we just walk the list... + + p = listeners; + l = listeners; + + while (l != NULL && l->id < newListener->id) + { + p = l; + l = l->next; + } + + while (l != NULL && l->id == newListener->id && l->value < newListener->value) + { + p = l; + l = l->next; + } + + //add at front of list + if (p == listeners && (newListener->id < p->id || (p->id == newListener->id && p->value > newListener->value))) + { + newListener->next = p; + + //this new listener is now the front! + listeners = newListener; + } + + //add after p + else + { + newListener->next = p->next; + p->next = newListener; + } + + MicroBitEvent(MICROBIT_ID_MESSAGE_BUS_LISTENER, newListener->id); + return MICROBIT_OK; +} + +/** + * Remove the given MicroBitListener from the list of event handlers. + * + * @param listener The MicroBitListener to remove. + * + * @return MICROBIT_OK if the listener is valid, MICROBIT_INVALID_PARAMETER otherwise. + */ +int MicroBitMessageBus::remove(MicroBitListener *listener) +{ + MicroBitListener *l; + int removed = 0; + + //handler can't be NULL! + if (listener == NULL) + return MICROBIT_INVALID_PARAMETER; + + l = listeners; + + // Walk this list of event handlers. Delete any that match the given listener. + while (l != NULL) + { + if ((listener->flags & MESSAGE_BUS_LISTENER_METHOD) == (l->flags & MESSAGE_BUS_LISTENER_METHOD)) + { + if(((listener->flags & MESSAGE_BUS_LISTENER_METHOD) && (*l->cb_method == *listener->cb_method)) || + ((!(listener->flags & MESSAGE_BUS_LISTENER_METHOD) && l->cb == listener->cb))) + { + if ((listener->id == MICROBIT_ID_ANY || listener->id == l->id) && (listener->value == MICROBIT_EVT_ANY || listener->value == l->value)) + { + // Found a match. mark this to be removed from the list. + l->flags |= MESSAGE_BUS_LISTENER_DELETING; + removed++; + } + } + } + + l = l->next; + } + + if (removed > 0) + return MICROBIT_OK; + else + return MICROBIT_INVALID_PARAMETER; +} + +/** + * Returns the microBitListener with the given position in our list. + * + * @param n The position in the list to return. + * + * @return the MicroBitListener at postion n in the list, or NULL if the position is invalid. + */ +MicroBitListener* MicroBitMessageBus::elementAt(int n) +{ + MicroBitListener *l = listeners; + + while (n > 0) + { + if (l == NULL) + return NULL; + + n--; + l = l->next; + } + + return l; +} + +/** + * Destructor for MicroBitMessageBus, where we deregister this instance from the array of fiber components. + */ +MicroBitMessageBus::~MicroBitMessageBus() +{ + fiber_remove_idle_component(this); +}