init

Dependencies:   mbed

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?

UserRevisionLine numberNew 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