mbed library for NZ32-SC151
common/InterruptManager.cpp@17:639ed60ce759, 2016-08-19 (annotated)
- Committer:
- modtronix-com
- Date:
- Fri Aug 19 15:46:42 2016 +1000
- Revision:
- 17:639ed60ce759
- Parent:
- 1:71204b8406f2
Added tag v1.1 for changeset 076cbe3e55be
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
modtronix | 1:71204b8406f2 | 1 | #include "cmsis.h" |
modtronix | 1:71204b8406f2 | 2 | #if defined(NVIC_NUM_VECTORS) |
modtronix | 1:71204b8406f2 | 3 | |
modtronix | 1:71204b8406f2 | 4 | #include "InterruptManager.h" |
modtronix | 1:71204b8406f2 | 5 | #include <string.h> |
modtronix | 1:71204b8406f2 | 6 | |
modtronix | 1:71204b8406f2 | 7 | #define CHAIN_INITIAL_SIZE 4 |
modtronix | 1:71204b8406f2 | 8 | |
modtronix | 1:71204b8406f2 | 9 | namespace mbed { |
modtronix | 1:71204b8406f2 | 10 | |
modtronix | 1:71204b8406f2 | 11 | typedef void (*pvoidf)(void); |
modtronix | 1:71204b8406f2 | 12 | |
modtronix | 1:71204b8406f2 | 13 | InterruptManager* InterruptManager::_instance = (InterruptManager*)NULL; |
modtronix | 1:71204b8406f2 | 14 | |
modtronix | 1:71204b8406f2 | 15 | InterruptManager* InterruptManager::get() { |
modtronix | 1:71204b8406f2 | 16 | if (NULL == _instance) |
modtronix | 1:71204b8406f2 | 17 | _instance = new InterruptManager(); |
modtronix | 1:71204b8406f2 | 18 | return _instance; |
modtronix | 1:71204b8406f2 | 19 | } |
modtronix | 1:71204b8406f2 | 20 | |
modtronix | 1:71204b8406f2 | 21 | InterruptManager::InterruptManager() { |
modtronix | 1:71204b8406f2 | 22 | memset(_chains, 0, NVIC_NUM_VECTORS * sizeof(CallChain*)); |
modtronix | 1:71204b8406f2 | 23 | } |
modtronix | 1:71204b8406f2 | 24 | |
modtronix | 1:71204b8406f2 | 25 | void InterruptManager::destroy() { |
modtronix | 1:71204b8406f2 | 26 | // Not a good idea to call this unless NO interrupt at all |
modtronix | 1:71204b8406f2 | 27 | // is under the control of the handler; otherwise, a system crash |
modtronix | 1:71204b8406f2 | 28 | // is very likely to occur |
modtronix | 1:71204b8406f2 | 29 | if (NULL != _instance) { |
modtronix | 1:71204b8406f2 | 30 | delete _instance; |
modtronix | 1:71204b8406f2 | 31 | _instance = (InterruptManager*)NULL; |
modtronix | 1:71204b8406f2 | 32 | } |
modtronix | 1:71204b8406f2 | 33 | } |
modtronix | 1:71204b8406f2 | 34 | |
modtronix | 1:71204b8406f2 | 35 | InterruptManager::~InterruptManager() { |
modtronix | 1:71204b8406f2 | 36 | for(int i = 0; i < NVIC_NUM_VECTORS; i++) |
modtronix | 1:71204b8406f2 | 37 | if (NULL != _chains[i]) |
modtronix | 1:71204b8406f2 | 38 | delete _chains[i]; |
modtronix | 1:71204b8406f2 | 39 | } |
modtronix | 1:71204b8406f2 | 40 | |
modtronix | 1:71204b8406f2 | 41 | bool InterruptManager::must_replace_vector(IRQn_Type irq) { |
modtronix | 1:71204b8406f2 | 42 | int irq_pos = get_irq_index(irq); |
modtronix | 1:71204b8406f2 | 43 | |
modtronix | 1:71204b8406f2 | 44 | if (NULL == _chains[irq_pos]) { |
modtronix | 1:71204b8406f2 | 45 | _chains[irq_pos] = new CallChain(CHAIN_INITIAL_SIZE); |
modtronix | 1:71204b8406f2 | 46 | _chains[irq_pos]->add((pvoidf)NVIC_GetVector(irq)); |
modtronix | 1:71204b8406f2 | 47 | return true; |
modtronix | 1:71204b8406f2 | 48 | } |
modtronix | 1:71204b8406f2 | 49 | return false; |
modtronix | 1:71204b8406f2 | 50 | } |
modtronix | 1:71204b8406f2 | 51 | |
modtronix | 1:71204b8406f2 | 52 | pFunctionPointer_t InterruptManager::add_common(void (*function)(void), IRQn_Type irq, bool front) { |
modtronix | 1:71204b8406f2 | 53 | int irq_pos = get_irq_index(irq); |
modtronix | 1:71204b8406f2 | 54 | bool change = must_replace_vector(irq); |
modtronix | 1:71204b8406f2 | 55 | |
modtronix | 1:71204b8406f2 | 56 | pFunctionPointer_t pf = front ? _chains[irq_pos]->add_front(function) : _chains[irq_pos]->add(function); |
modtronix | 1:71204b8406f2 | 57 | if (change) |
modtronix | 1:71204b8406f2 | 58 | NVIC_SetVector(irq, (uint32_t)&InterruptManager::static_irq_helper); |
modtronix | 1:71204b8406f2 | 59 | return pf; |
modtronix | 1:71204b8406f2 | 60 | } |
modtronix | 1:71204b8406f2 | 61 | |
modtronix | 1:71204b8406f2 | 62 | bool InterruptManager::remove_handler(pFunctionPointer_t handler, IRQn_Type irq) { |
modtronix | 1:71204b8406f2 | 63 | int irq_pos = get_irq_index(irq); |
modtronix | 1:71204b8406f2 | 64 | |
modtronix | 1:71204b8406f2 | 65 | if (NULL == _chains[irq_pos]) |
modtronix | 1:71204b8406f2 | 66 | return false; |
modtronix | 1:71204b8406f2 | 67 | if (!_chains[irq_pos]->remove(handler)) |
modtronix | 1:71204b8406f2 | 68 | return false; |
modtronix | 1:71204b8406f2 | 69 | // If there's a single function left in the chain, swith the interrupt vector |
modtronix | 1:71204b8406f2 | 70 | // to call that function directly. This way we save both time and space. |
modtronix | 1:71204b8406f2 | 71 | if (_chains[irq_pos]->size() == 1 && NULL != _chains[irq_pos]->get(0)->get_function()) { |
modtronix | 1:71204b8406f2 | 72 | NVIC_SetVector(irq, (uint32_t)_chains[irq_pos]->get(0)->get_function()); |
modtronix | 1:71204b8406f2 | 73 | delete _chains[irq_pos]; |
modtronix | 1:71204b8406f2 | 74 | _chains[irq_pos] = (CallChain*) NULL; |
modtronix | 1:71204b8406f2 | 75 | } |
modtronix | 1:71204b8406f2 | 76 | return true; |
modtronix | 1:71204b8406f2 | 77 | } |
modtronix | 1:71204b8406f2 | 78 | |
modtronix | 1:71204b8406f2 | 79 | void InterruptManager::irq_helper() { |
modtronix | 1:71204b8406f2 | 80 | _chains[__get_IPSR()]->call(); |
modtronix | 1:71204b8406f2 | 81 | } |
modtronix | 1:71204b8406f2 | 82 | |
modtronix | 1:71204b8406f2 | 83 | int InterruptManager::get_irq_index(IRQn_Type irq) { |
modtronix | 1:71204b8406f2 | 84 | return (int)irq + NVIC_USER_IRQ_OFFSET; |
modtronix | 1:71204b8406f2 | 85 | } |
modtronix | 1:71204b8406f2 | 86 | |
modtronix | 1:71204b8406f2 | 87 | void InterruptManager::static_irq_helper() { |
modtronix | 1:71204b8406f2 | 88 | InterruptManager::get()->irq_helper(); |
modtronix | 1:71204b8406f2 | 89 | } |
modtronix | 1:71204b8406f2 | 90 | |
modtronix | 1:71204b8406f2 | 91 | } // namespace mbed |
modtronix | 1:71204b8406f2 | 92 | |
modtronix | 1:71204b8406f2 | 93 | #endif |