tool/mbed/mbed-sdk/libraries/mbed/common/CallChain.cpp

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