Kev Mann / mbed-dev-OS5_10_4

RTC auf true

drivers/InterruptManager.cpp@2:7aab896b1a3b, 2019-03-13 (annotated)

Committer:
kevman
Date:
Wed Mar 13 11:03:24 2019 +0000
Revision:
2:7aab896b1a3b
Parent:
0:38ceb79fef03 
2019-03-13

Who changed what in which revision?

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