fix LPC812 PWM
Fork of mbed-dev by
common/CallChain.cpp
- Committer:
- nameless129
- Date:
- 2016-05-16
- Revision:
- 129:2e517c56bcfb
- Parent:
- 0:9b334a45a8ff
File content as of revision 129:2e517c56bcfb:
#include "CallChain.h" #include "cmsis.h" namespace mbed { CallChain::CallChain(int size) : _chain(), _size(size), _elements(0) { _chain = new pFunctionPointer_t[size](); } CallChain::~CallChain() { clear(); delete _chain; } pFunctionPointer_t CallChain::add(void (*function)(void)) { return common_add(new FunctionPointer(function)); } pFunctionPointer_t CallChain::add_front(void (*function)(void)) { return common_add_front(new FunctionPointer(function)); } int CallChain::size() const { return _elements; } pFunctionPointer_t CallChain::get(int i) const { if (i < 0 || i >= _elements) return NULL; return _chain[i]; } int CallChain::find(pFunctionPointer_t f) const { for (int i = 0; i < _elements; i++) if (f == _chain[i]) return i; return -1; } void CallChain::clear() { for(int i = 0; i < _elements; i ++) { delete _chain[i]; _chain[i] = NULL; } _elements = 0; } bool CallChain::remove(pFunctionPointer_t f) { int i; if ((i = find(f)) == -1) return false; if (i != _elements - 1) memmove(_chain + i, _chain + i + 1, (_elements - i - 1) * sizeof(pFunctionPointer_t)); delete f; _elements --; return true; } void CallChain::call() { for(int i = 0; i < _elements; i++) _chain[i]->call(); } void CallChain::_check_size() { if (_elements < _size) return; _size = (_size < 4) ? 4 : _size + 4; pFunctionPointer_t* new_chain = new pFunctionPointer_t[_size](); memcpy(new_chain, _chain, _elements * sizeof(pFunctionPointer_t)); delete _chain; _chain = new_chain; } pFunctionPointer_t CallChain::common_add(pFunctionPointer_t pf) { _check_size(); _chain[_elements] = pf; _elements ++; return pf; } pFunctionPointer_t CallChain::common_add_front(pFunctionPointer_t pf) { _check_size(); memmove(_chain + 1, _chain, _elements * sizeof(pFunctionPointer_t)); _chain[0] = pf; _elements ++; return pf; } } // namespace mbed