- fix F411 F334 systeminit when HSI used - portinout always read IDR regardless of port direction
Fork of mbed-src by
common/CallChain.cpp
- Committer:
- bogdanm
- Date:
- 2013-08-07
- Revision:
- 15:4892fe388435
- Child:
- 36:ab3ee77451e7
File content as of revision 15:4892fe388435:
#include "CallChain.h" #include "cmsis.h" namespace mbed { CallChain::CallChain(int size) : _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() { __disable_irq(); for(int i = 0; i < _elements; i ++) { delete _chain[i]; _chain[i] = NULL; } _elements = 0; __enable_irq(); } bool CallChain::remove(pFunctionPointer_t f) { int i; if ((i = find(f)) == -1) return false; __disable_irq(); if (i != _elements - 1) memmove(_chain + i, _chain + i + 1, (_elements - i - 1) * sizeof(pFunctionPointer_t)); delete f; _elements --; __enable_irq(); return true; } void CallChain::call() { for(int i = 0; i < _elements; i++) _chain[i]->call(); } void CallChain::_check_size() { if (_elements < _size) return; __disable_irq(); _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; __enable_irq(); } 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(); __disable_irq(); memmove(_chain + 1, _chain, _elements * sizeof(pFunctionPointer_t)); _chain[0] = pf; _elements ++; __enable_irq(); return pf; } } // namespace mbed