Mbed SDK for XRange SX1272 LoRa module
Dependents: XRangePingPong XRange-LoRaWAN-lmic-app lora-transceiver
SX1272 LoRa RF module
https://www.netblocks.eu/xrange-sx1272-lora-datasheet/
common/CallChain.cpp@339:ac6f3fd999f3, 2016-01-07 (annotated)
- Committer:
- netblocks
- Date:
- Thu Jan 07 13:01:25 2016 +0000
- Revision:
- 339:ac6f3fd999f3
- Parent:
- 336:1e18a06a987b
HSE_VALUE set for XTAL 16Mhz
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
dudmuck | 336:1e18a06a987b | 1 | #include "CallChain.h" |
dudmuck | 336:1e18a06a987b | 2 | #include "cmsis.h" |
dudmuck | 336:1e18a06a987b | 3 | |
dudmuck | 336:1e18a06a987b | 4 | namespace mbed { |
dudmuck | 336:1e18a06a987b | 5 | |
dudmuck | 336:1e18a06a987b | 6 | CallChain::CallChain(int size) : _chain(), _size(size), _elements(0) { |
dudmuck | 336:1e18a06a987b | 7 | _chain = new pFunctionPointer_t[size](); |
dudmuck | 336:1e18a06a987b | 8 | } |
dudmuck | 336:1e18a06a987b | 9 | |
dudmuck | 336:1e18a06a987b | 10 | CallChain::~CallChain() { |
dudmuck | 336:1e18a06a987b | 11 | clear(); |
dudmuck | 336:1e18a06a987b | 12 | delete _chain; |
dudmuck | 336:1e18a06a987b | 13 | } |
dudmuck | 336:1e18a06a987b | 14 | |
dudmuck | 336:1e18a06a987b | 15 | pFunctionPointer_t CallChain::add(void (*function)(void)) { |
dudmuck | 336:1e18a06a987b | 16 | return common_add(new FunctionPointer(function)); |
dudmuck | 336:1e18a06a987b | 17 | } |
dudmuck | 336:1e18a06a987b | 18 | |
dudmuck | 336:1e18a06a987b | 19 | pFunctionPointer_t CallChain::add_front(void (*function)(void)) { |
dudmuck | 336:1e18a06a987b | 20 | return common_add_front(new FunctionPointer(function)); |
dudmuck | 336:1e18a06a987b | 21 | } |
dudmuck | 336:1e18a06a987b | 22 | |
dudmuck | 336:1e18a06a987b | 23 | int CallChain::size() const { |
dudmuck | 336:1e18a06a987b | 24 | return _elements; |
dudmuck | 336:1e18a06a987b | 25 | } |
dudmuck | 336:1e18a06a987b | 26 | |
dudmuck | 336:1e18a06a987b | 27 | pFunctionPointer_t CallChain::get(int i) const { |
dudmuck | 336:1e18a06a987b | 28 | if (i < 0 || i >= _elements) |
dudmuck | 336:1e18a06a987b | 29 | return NULL; |
dudmuck | 336:1e18a06a987b | 30 | return _chain[i]; |
dudmuck | 336:1e18a06a987b | 31 | } |
dudmuck | 336:1e18a06a987b | 32 | |
dudmuck | 336:1e18a06a987b | 33 | int CallChain::find(pFunctionPointer_t f) const { |
dudmuck | 336:1e18a06a987b | 34 | for (int i = 0; i < _elements; i++) |
dudmuck | 336:1e18a06a987b | 35 | if (f == _chain[i]) |
dudmuck | 336:1e18a06a987b | 36 | return i; |
dudmuck | 336:1e18a06a987b | 37 | return -1; |
dudmuck | 336:1e18a06a987b | 38 | } |
dudmuck | 336:1e18a06a987b | 39 | |
dudmuck | 336:1e18a06a987b | 40 | void CallChain::clear() { |
dudmuck | 336:1e18a06a987b | 41 | for(int i = 0; i < _elements; i ++) { |
dudmuck | 336:1e18a06a987b | 42 | delete _chain[i]; |
dudmuck | 336:1e18a06a987b | 43 | _chain[i] = NULL; |
dudmuck | 336:1e18a06a987b | 44 | } |
dudmuck | 336:1e18a06a987b | 45 | _elements = 0; |
dudmuck | 336:1e18a06a987b | 46 | } |
dudmuck | 336:1e18a06a987b | 47 | |
dudmuck | 336:1e18a06a987b | 48 | bool CallChain::remove(pFunctionPointer_t f) { |
dudmuck | 336:1e18a06a987b | 49 | int i; |
dudmuck | 336:1e18a06a987b | 50 | |
dudmuck | 336:1e18a06a987b | 51 | if ((i = find(f)) == -1) |
dudmuck | 336:1e18a06a987b | 52 | return false; |
dudmuck | 336:1e18a06a987b | 53 | if (i != _elements - 1) |
dudmuck | 336:1e18a06a987b | 54 | memmove(_chain + i, _chain + i + 1, (_elements - i - 1) * sizeof(pFunctionPointer_t)); |
dudmuck | 336:1e18a06a987b | 55 | delete f; |
dudmuck | 336:1e18a06a987b | 56 | _elements --; |
dudmuck | 336:1e18a06a987b | 57 | return true; |
dudmuck | 336:1e18a06a987b | 58 | } |
dudmuck | 336:1e18a06a987b | 59 | |
dudmuck | 336:1e18a06a987b | 60 | void CallChain::call() { |
dudmuck | 336:1e18a06a987b | 61 | for(int i = 0; i < _elements; i++) |
dudmuck | 336:1e18a06a987b | 62 | _chain[i]->call(); |
dudmuck | 336:1e18a06a987b | 63 | } |
dudmuck | 336:1e18a06a987b | 64 | |
dudmuck | 336:1e18a06a987b | 65 | void CallChain::_check_size() { |
dudmuck | 336:1e18a06a987b | 66 | if (_elements < _size) |
dudmuck | 336:1e18a06a987b | 67 | return; |
dudmuck | 336:1e18a06a987b | 68 | _size = (_size < 4) ? 4 : _size + 4; |
dudmuck | 336:1e18a06a987b | 69 | pFunctionPointer_t* new_chain = new pFunctionPointer_t[_size](); |
dudmuck | 336:1e18a06a987b | 70 | memcpy(new_chain, _chain, _elements * sizeof(pFunctionPointer_t)); |
dudmuck | 336:1e18a06a987b | 71 | delete _chain; |
dudmuck | 336:1e18a06a987b | 72 | _chain = new_chain; |
dudmuck | 336:1e18a06a987b | 73 | } |
dudmuck | 336:1e18a06a987b | 74 | |
dudmuck | 336:1e18a06a987b | 75 | pFunctionPointer_t CallChain::common_add(pFunctionPointer_t pf) { |
dudmuck | 336:1e18a06a987b | 76 | _check_size(); |
dudmuck | 336:1e18a06a987b | 77 | _chain[_elements] = pf; |
dudmuck | 336:1e18a06a987b | 78 | _elements ++; |
dudmuck | 336:1e18a06a987b | 79 | return pf; |
dudmuck | 336:1e18a06a987b | 80 | } |
dudmuck | 336:1e18a06a987b | 81 | |
dudmuck | 336:1e18a06a987b | 82 | pFunctionPointer_t CallChain::common_add_front(pFunctionPointer_t pf) { |
dudmuck | 336:1e18a06a987b | 83 | _check_size(); |
dudmuck | 336:1e18a06a987b | 84 | memmove(_chain + 1, _chain, _elements * sizeof(pFunctionPointer_t)); |
dudmuck | 336:1e18a06a987b | 85 | _chain[0] = pf; |
dudmuck | 336:1e18a06a987b | 86 | _elements ++; |
dudmuck | 336:1e18a06a987b | 87 | return pf; |
dudmuck | 336:1e18a06a987b | 88 | } |
dudmuck | 336:1e18a06a987b | 89 | |
dudmuck | 336:1e18a06a987b | 90 | } // namespace mbed |