Nathan Yonkee
/
Nucleo_sinewave_output_copy
init
mbed-os/drivers/InterruptManager.cpp@10:46a4cf51ee38, 2018-03-02 (annotated)
- Committer:
- Nathan Yonkee
- Date:
- Fri Mar 02 07:16:49 2018 -0700
- Revision:
- 10:46a4cf51ee38
- Parent:
- 9:d58e77ebd769
remove mbed-os
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Nathan Yonkee |
9:d58e77ebd769 | 1 | /* mbed Microcontroller Library |
Nathan Yonkee |
9:d58e77ebd769 | 2 | * Copyright (c) 2006-2013 ARM Limited |
Nathan Yonkee |
9:d58e77ebd769 | 3 | * |
Nathan Yonkee |
9:d58e77ebd769 | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
Nathan Yonkee |
9:d58e77ebd769 | 5 | * you may not use this file except in compliance with the License. |
Nathan Yonkee |
9:d58e77ebd769 | 6 | * You may obtain a copy of the License at |
Nathan Yonkee |
9:d58e77ebd769 | 7 | * |
Nathan Yonkee |
9:d58e77ebd769 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
Nathan Yonkee |
9:d58e77ebd769 | 9 | * |
Nathan Yonkee |
9:d58e77ebd769 | 10 | * Unless required by applicable law or agreed to in writing, software |
Nathan Yonkee |
9:d58e77ebd769 | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
Nathan Yonkee |
9:d58e77ebd769 | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
Nathan Yonkee |
9:d58e77ebd769 | 13 | * See the License for the specific language governing permissions and |
Nathan Yonkee |
9:d58e77ebd769 | 14 | * limitations under the License. |
Nathan Yonkee |
9:d58e77ebd769 | 15 | */ |
Nathan Yonkee |
9:d58e77ebd769 | 16 | #include "cmsis.h" |
Nathan Yonkee |
9:d58e77ebd769 | 17 | #if defined(NVIC_NUM_VECTORS) |
Nathan Yonkee |
9:d58e77ebd769 | 18 | |
Nathan Yonkee |
9:d58e77ebd769 | 19 | // Suppress deprecation warnings since this whole |
Nathan Yonkee |
9:d58e77ebd769 | 20 | // class is deprecated already |
Nathan Yonkee |
9:d58e77ebd769 | 21 | #include "mbed_toolchain.h" |
Nathan Yonkee |
9:d58e77ebd769 | 22 | #undef MBED_DEPRECATED_SINCE |
Nathan Yonkee |
9:d58e77ebd769 | 23 | #define MBED_DEPRECATED_SINCE(...) |
Nathan Yonkee |
9:d58e77ebd769 | 24 | |
Nathan Yonkee |
9:d58e77ebd769 | 25 | #include "drivers/InterruptManager.h" |
Nathan Yonkee |
9:d58e77ebd769 | 26 | #include "platform/mbed_critical.h" |
Nathan Yonkee |
9:d58e77ebd769 | 27 | #include <string.h> |
Nathan Yonkee |
9:d58e77ebd769 | 28 | |
Nathan Yonkee |
9:d58e77ebd769 | 29 | #define CHAIN_INITIAL_SIZE 4 |
Nathan Yonkee |
9:d58e77ebd769 | 30 | |
Nathan Yonkee |
9:d58e77ebd769 | 31 | namespace mbed { |
Nathan Yonkee |
9:d58e77ebd769 | 32 | |
Nathan Yonkee |
9:d58e77ebd769 | 33 | typedef void (*pvoidf)(void); |
Nathan Yonkee |
9:d58e77ebd769 | 34 | |
Nathan Yonkee |
9:d58e77ebd769 | 35 | InterruptManager* InterruptManager::_instance = (InterruptManager*)NULL; |
Nathan Yonkee |
9:d58e77ebd769 | 36 | |
Nathan Yonkee |
9:d58e77ebd769 | 37 | InterruptManager* InterruptManager::get() { |
Nathan Yonkee |
9:d58e77ebd769 | 38 | |
Nathan Yonkee |
9:d58e77ebd769 | 39 | if (NULL == _instance) { |
Nathan Yonkee |
9:d58e77ebd769 | 40 | InterruptManager* temp = new InterruptManager(); |
Nathan Yonkee |
9:d58e77ebd769 | 41 | |
Nathan Yonkee |
9:d58e77ebd769 | 42 | // Atomically set _instance |
Nathan Yonkee |
9:d58e77ebd769 | 43 | core_util_critical_section_enter(); |
Nathan Yonkee |
9:d58e77ebd769 | 44 | if (NULL == _instance) { |
Nathan Yonkee |
9:d58e77ebd769 | 45 | _instance = temp; |
Nathan Yonkee |
9:d58e77ebd769 | 46 | } |
Nathan Yonkee |
9:d58e77ebd769 | 47 | core_util_critical_section_exit(); |
Nathan Yonkee |
9:d58e77ebd769 | 48 | |
Nathan Yonkee |
9:d58e77ebd769 | 49 | // Another thread got there first so delete ours |
Nathan Yonkee |
9:d58e77ebd769 | 50 | if (temp != _instance) { |
Nathan Yonkee |
9:d58e77ebd769 | 51 | delete temp; |
Nathan Yonkee |
9:d58e77ebd769 | 52 | } |
Nathan Yonkee |
9:d58e77ebd769 | 53 | |
Nathan Yonkee |
9:d58e77ebd769 | 54 | } |
Nathan Yonkee |
9:d58e77ebd769 | 55 | return _instance; |
Nathan Yonkee |
9:d58e77ebd769 | 56 | } |
Nathan Yonkee |
9:d58e77ebd769 | 57 | |
Nathan Yonkee |
9:d58e77ebd769 | 58 | InterruptManager::InterruptManager() { |
Nathan Yonkee |
9:d58e77ebd769 | 59 | // No mutex needed in constructor |
Nathan Yonkee |
9:d58e77ebd769 | 60 | memset(_chains, 0, NVIC_NUM_VECTORS * sizeof(CallChain*)); |
Nathan Yonkee |
9:d58e77ebd769 | 61 | } |
Nathan Yonkee |
9:d58e77ebd769 | 62 | |
Nathan Yonkee |
9:d58e77ebd769 | 63 | void InterruptManager::destroy() { |
Nathan Yonkee |
9:d58e77ebd769 | 64 | // Not a good idea to call this unless NO interrupt at all |
Nathan Yonkee |
9:d58e77ebd769 | 65 | // is under the control of the handler; otherwise, a system crash |
Nathan Yonkee |
9:d58e77ebd769 | 66 | // is very likely to occur |
Nathan Yonkee |
9:d58e77ebd769 | 67 | if (NULL != _instance) { |
Nathan Yonkee |
9:d58e77ebd769 | 68 | delete _instance; |
Nathan Yonkee |
9:d58e77ebd769 | 69 | _instance = (InterruptManager*)NULL; |
Nathan Yonkee |
9:d58e77ebd769 | 70 | } |
Nathan Yonkee |
9:d58e77ebd769 | 71 | } |
Nathan Yonkee |
9:d58e77ebd769 | 72 | |
Nathan Yonkee |
9:d58e77ebd769 | 73 | InterruptManager::~InterruptManager() { |
Nathan Yonkee |
9:d58e77ebd769 | 74 | for(int i = 0; i < NVIC_NUM_VECTORS; i++) |
Nathan Yonkee |
9:d58e77ebd769 | 75 | if (NULL != _chains[i]) |
Nathan Yonkee |
9:d58e77ebd769 | 76 | delete _chains[i]; |
Nathan Yonkee |
9:d58e77ebd769 | 77 | } |
Nathan Yonkee |
9:d58e77ebd769 | 78 | |
Nathan Yonkee |
9:d58e77ebd769 | 79 | bool InterruptManager::must_replace_vector(IRQn_Type irq) { |
Nathan Yonkee |
9:d58e77ebd769 | 80 | lock(); |
Nathan Yonkee |
9:d58e77ebd769 | 81 | |
Nathan Yonkee |
9:d58e77ebd769 | 82 | int ret = false; |
Nathan Yonkee |
9:d58e77ebd769 | 83 | int irq_pos = get_irq_index(irq); |
Nathan Yonkee |
9:d58e77ebd769 | 84 | if (NULL == _chains[irq_pos]) { |
Nathan Yonkee |
9:d58e77ebd769 | 85 | _chains[irq_pos] = new CallChain(CHAIN_INITIAL_SIZE); |
Nathan Yonkee |
9:d58e77ebd769 | 86 | _chains[irq_pos]->add((pvoidf)NVIC_GetVector(irq)); |
Nathan Yonkee |
9:d58e77ebd769 | 87 | ret = true; |
Nathan Yonkee |
9:d58e77ebd769 | 88 | } |
Nathan Yonkee |
9:d58e77ebd769 | 89 | unlock(); |
Nathan Yonkee |
9:d58e77ebd769 | 90 | return ret; |
Nathan Yonkee |
9:d58e77ebd769 | 91 | } |
Nathan Yonkee |
9:d58e77ebd769 | 92 | |
Nathan Yonkee |
9:d58e77ebd769 | 93 | pFunctionPointer_t InterruptManager::add_common(void (*function)(void), IRQn_Type irq, bool front) { |
Nathan Yonkee |
9:d58e77ebd769 | 94 | lock(); |
Nathan Yonkee |
9:d58e77ebd769 | 95 | int irq_pos = get_irq_index(irq); |
Nathan Yonkee |
9:d58e77ebd769 | 96 | bool change = must_replace_vector(irq); |
Nathan Yonkee |
9:d58e77ebd769 | 97 | |
Nathan Yonkee |
9:d58e77ebd769 | 98 | pFunctionPointer_t pf = front ? _chains[irq_pos]->add_front(function) : _chains[irq_pos]->add(function); |
Nathan Yonkee |
9:d58e77ebd769 | 99 | if (change) |
Nathan Yonkee |
9:d58e77ebd769 | 100 | NVIC_SetVector(irq, (uint32_t)&InterruptManager::static_irq_helper); |
Nathan Yonkee |
9:d58e77ebd769 | 101 | unlock(); |
Nathan Yonkee |
9:d58e77ebd769 | 102 | return pf; |
Nathan Yonkee |
9:d58e77ebd769 | 103 | } |
Nathan Yonkee |
9:d58e77ebd769 | 104 | |
Nathan Yonkee |
9:d58e77ebd769 | 105 | bool InterruptManager::remove_handler(pFunctionPointer_t handler, IRQn_Type irq) { |
Nathan Yonkee |
9:d58e77ebd769 | 106 | int irq_pos = get_irq_index(irq); |
Nathan Yonkee |
9:d58e77ebd769 | 107 | bool ret = false; |
Nathan Yonkee |
9:d58e77ebd769 | 108 | |
Nathan Yonkee |
9:d58e77ebd769 | 109 | lock(); |
Nathan Yonkee |
9:d58e77ebd769 | 110 | if (_chains[irq_pos] != NULL) { |
Nathan Yonkee |
9:d58e77ebd769 | 111 | if (_chains[irq_pos]->remove(handler)) { |
Nathan Yonkee |
9:d58e77ebd769 | 112 | ret = true; |
Nathan Yonkee |
9:d58e77ebd769 | 113 | } |
Nathan Yonkee |
9:d58e77ebd769 | 114 | } |
Nathan Yonkee |
9:d58e77ebd769 | 115 | unlock(); |
Nathan Yonkee |
9:d58e77ebd769 | 116 | |
Nathan Yonkee |
9:d58e77ebd769 | 117 | return ret; |
Nathan Yonkee |
9:d58e77ebd769 | 118 | } |
Nathan Yonkee |
9:d58e77ebd769 | 119 | |
Nathan Yonkee |
9:d58e77ebd769 | 120 | void InterruptManager::irq_helper() { |
Nathan Yonkee |
9:d58e77ebd769 | 121 | _chains[__get_IPSR()]->call(); |
Nathan Yonkee |
9:d58e77ebd769 | 122 | } |
Nathan Yonkee |
9:d58e77ebd769 | 123 | |
Nathan Yonkee |
9:d58e77ebd769 | 124 | int InterruptManager::get_irq_index(IRQn_Type irq) { |
Nathan Yonkee |
9:d58e77ebd769 | 125 | // Pure function - no lock needed |
Nathan Yonkee |
9:d58e77ebd769 | 126 | return (int)irq + NVIC_USER_IRQ_OFFSET; |
Nathan Yonkee |
9:d58e77ebd769 | 127 | } |
Nathan Yonkee |
9:d58e77ebd769 | 128 | |
Nathan Yonkee |
9:d58e77ebd769 | 129 | void InterruptManager::static_irq_helper() { |
Nathan Yonkee |
9:d58e77ebd769 | 130 | InterruptManager::get()->irq_helper(); |
Nathan Yonkee |
9:d58e77ebd769 | 131 | } |
Nathan Yonkee |
9:d58e77ebd769 | 132 | |
Nathan Yonkee |
9:d58e77ebd769 | 133 | void InterruptManager::lock() { |
Nathan Yonkee |
9:d58e77ebd769 | 134 | _mutex.lock(); |
Nathan Yonkee |
9:d58e77ebd769 | 135 | } |
Nathan Yonkee |
9:d58e77ebd769 | 136 | |
Nathan Yonkee |
9:d58e77ebd769 | 137 | void InterruptManager::unlock() { |
Nathan Yonkee |
9:d58e77ebd769 | 138 | _mutex.unlock(); |
Nathan Yonkee |
9:d58e77ebd769 | 139 | } |
Nathan Yonkee |
9:d58e77ebd769 | 140 | |
Nathan Yonkee |
9:d58e77ebd769 | 141 | } // namespace mbed |
Nathan Yonkee |
9:d58e77ebd769 | 142 | |
Nathan Yonkee |
9:d58e77ebd769 | 143 | #endif |