Denislam Valeev / Mbed OS Nucleo_rtos_basic

1

mbed-os/drivers/InterruptManager.cpp@0:e056ac8fecf8, 2018-03-13 (annotated)

Committer:
valeyev
Date:
Tue Mar 13 07:17:50 2018 +0000
Revision:
0:e056ac8fecf8
looking for...

Who changed what in which revision?

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