PHung Tung / SRC_STM32F7

SPKT

Dependents:   WAV

common/CallChain.cpp@0:e87aa4c49e95, 2019-06-04 (annotated)

Committer:
phungductung
Date:
Tue Jun 04 21:51:46 2019 +0000
Revision:
0:e87aa4c49e95
libray

Who changed what in which revision?

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