Tamura Mizuki / STM32F746_FFT

fft

Dependencies:   BSP_DISCO_F746NG SDFileSystem_Warning_Fixed

mbed_src_STM32F7/common/CallChain.cpp@0:3e46577dc273, 2016-10-09 (annotated)

Committer:
MikamiUitOpen
Date:
Sun Oct 09 10:11:14 2016 +0000
Revision:
0:3e46577dc273
1

Who changed what in which revision?

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