PHung Tung / WAV2

SPKT

Dependencies:   F746_GUI SD_PlayerSkeleton F746_SAI_IO

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

Committer:
phungductung
Date:
Tue Jun 04 09:08:29 2019 +0000
Revision:
0:aa3fc5ad02f7
SPKT

Who changed what in which revision?

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