modtronix H / mbed_nz32sc151

mbed library for NZ32-SC151

common/CallChain.cpp@17:639ed60ce759, 2016-08-19 (annotated)

Committer:
modtronix-com
Date:
Fri Aug 19 15:46:42 2016 +1000
Revision:
17:639ed60ce759
Parent:
1:71204b8406f2 
Added tag v1.1 for changeset 076cbe3e55be

Who changed what in which revision?

UserRevisionLine numberNew contents of line
modtronix 1:71204b8406f2 1 #include "CallChain.h"
modtronix 1:71204b8406f2 2 #include "cmsis.h"
modtronix 1:71204b8406f2 3
modtronix 1:71204b8406f2 4 namespace mbed {
modtronix 1:71204b8406f2 5
modtronix 1:71204b8406f2 6 CallChain::CallChain(int size) : _chain(), _size(size), _elements(0) {
modtronix 1:71204b8406f2 7 _chain = new pFunctionPointer_t[size]();
modtronix 1:71204b8406f2 8 }
modtronix 1:71204b8406f2 9
modtronix 1:71204b8406f2 10 CallChain::~CallChain() {
modtronix 1:71204b8406f2 11 clear();
modtronix 1:71204b8406f2 12 delete _chain;
modtronix 1:71204b8406f2 13 }
modtronix 1:71204b8406f2 14
modtronix 1:71204b8406f2 15 pFunctionPointer_t CallChain::add(void (*function)(void)) {
modtronix 1:71204b8406f2 16 return common_add(new FunctionPointer(function));
modtronix 1:71204b8406f2 17 }
modtronix 1:71204b8406f2 18
modtronix 1:71204b8406f2 19 pFunctionPointer_t CallChain::add_front(void (*function)(void)) {
modtronix 1:71204b8406f2 20 return common_add_front(new FunctionPointer(function));
modtronix 1:71204b8406f2 21 }
modtronix 1:71204b8406f2 22
modtronix 1:71204b8406f2 23 int CallChain::size() const {
modtronix 1:71204b8406f2 24 return _elements;
modtronix 1:71204b8406f2 25 }
modtronix 1:71204b8406f2 26
modtronix 1:71204b8406f2 27 pFunctionPointer_t CallChain::get(int i) const {
modtronix 1:71204b8406f2 28 if (i < 0 || i >= _elements)
modtronix 1:71204b8406f2 29 return NULL;
modtronix 1:71204b8406f2 30 return _chain[i];
modtronix 1:71204b8406f2 31 }
modtronix 1:71204b8406f2 32
modtronix 1:71204b8406f2 33 int CallChain::find(pFunctionPointer_t f) const {
modtronix 1:71204b8406f2 34 for (int i = 0; i < _elements; i++)
modtronix 1:71204b8406f2 35 if (f == _chain[i])
modtronix 1:71204b8406f2 36 return i;
modtronix 1:71204b8406f2 37 return -1;
modtronix 1:71204b8406f2 38 }
modtronix 1:71204b8406f2 39
modtronix 1:71204b8406f2 40 void CallChain::clear() {
modtronix 1:71204b8406f2 41 for(int i = 0; i < _elements; i ++) {
modtronix 1:71204b8406f2 42 delete _chain[i];
modtronix 1:71204b8406f2 43 _chain[i] = NULL;
modtronix 1:71204b8406f2 44 }
modtronix 1:71204b8406f2 45 _elements = 0;
modtronix 1:71204b8406f2 46 }
modtronix 1:71204b8406f2 47
modtronix 1:71204b8406f2 48 bool CallChain::remove(pFunctionPointer_t f) {
modtronix 1:71204b8406f2 49 int i;
modtronix 1:71204b8406f2 50
modtronix 1:71204b8406f2 51 if ((i = find(f)) == -1)
modtronix 1:71204b8406f2 52 return false;
modtronix 1:71204b8406f2 53 if (i != _elements - 1)
modtronix 1:71204b8406f2 54 memmove(_chain + i, _chain + i + 1, (_elements - i - 1) * sizeof(pFunctionPointer_t));
modtronix 1:71204b8406f2 55 delete f;
modtronix 1:71204b8406f2 56 _elements --;
modtronix 1:71204b8406f2 57 return true;
modtronix 1:71204b8406f2 58 }
modtronix 1:71204b8406f2 59
modtronix 1:71204b8406f2 60 void CallChain::call() {
modtronix 1:71204b8406f2 61 for(int i = 0; i < _elements; i++)
modtronix 1:71204b8406f2 62 _chain[i]->call();
modtronix 1:71204b8406f2 63 }
modtronix 1:71204b8406f2 64
modtronix 1:71204b8406f2 65 void CallChain::_check_size() {
modtronix 1:71204b8406f2 66 if (_elements < _size)
modtronix 1:71204b8406f2 67 return;
modtronix 1:71204b8406f2 68 _size = (_size < 4) ? 4 : _size + 4;
modtronix 1:71204b8406f2 69 pFunctionPointer_t* new_chain = new pFunctionPointer_t[_size]();
modtronix 1:71204b8406f2 70 memcpy(new_chain, _chain, _elements * sizeof(pFunctionPointer_t));
modtronix 1:71204b8406f2 71 delete _chain;
modtronix 1:71204b8406f2 72 _chain = new_chain;
modtronix 1:71204b8406f2 73 }
modtronix 1:71204b8406f2 74
modtronix 1:71204b8406f2 75 pFunctionPointer_t CallChain::common_add(pFunctionPointer_t pf) {
modtronix 1:71204b8406f2 76 _check_size();
modtronix 1:71204b8406f2 77 _chain[_elements] = pf;
modtronix 1:71204b8406f2 78 _elements ++;
modtronix 1:71204b8406f2 79 return pf;
modtronix 1:71204b8406f2 80 }
modtronix 1:71204b8406f2 81
modtronix 1:71204b8406f2 82 pFunctionPointer_t CallChain::common_add_front(pFunctionPointer_t pf) {
modtronix 1:71204b8406f2 83 _check_size();
modtronix 1:71204b8406f2 84 memmove(_chain + 1, _chain, _elements * sizeof(pFunctionPointer_t));
modtronix 1:71204b8406f2 85 _chain[0] = pf;
modtronix 1:71204b8406f2 86 _elements ++;
modtronix 1:71204b8406f2 87 return pf;
modtronix 1:71204b8406f2 88 }
modtronix 1:71204b8406f2 89
modtronix 1:71204b8406f2 90 } // namespace mbed