The prosthetic control(MIT)
drivers/InterruptIn.cpp@0:20e0c61e0684, 2022-06-23 (annotated)
- Committer:
- ganlikun
- Date:
- Thu Jun 23 05:23:34 2022 +0000
- Revision:
- 0:20e0c61e0684
01
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ganlikun | 0:20e0c61e0684 | 1 | /* mbed Microcontroller Library |
ganlikun | 0:20e0c61e0684 | 2 | * Copyright (c) 2006-2013 ARM Limited |
ganlikun | 0:20e0c61e0684 | 3 | * |
ganlikun | 0:20e0c61e0684 | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
ganlikun | 0:20e0c61e0684 | 5 | * you may not use this file except in compliance with the License. |
ganlikun | 0:20e0c61e0684 | 6 | * You may obtain a copy of the License at |
ganlikun | 0:20e0c61e0684 | 7 | * |
ganlikun | 0:20e0c61e0684 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
ganlikun | 0:20e0c61e0684 | 9 | * |
ganlikun | 0:20e0c61e0684 | 10 | * Unless required by applicable law or agreed to in writing, software |
ganlikun | 0:20e0c61e0684 | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
ganlikun | 0:20e0c61e0684 | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
ganlikun | 0:20e0c61e0684 | 13 | * See the License for the specific language governing permissions and |
ganlikun | 0:20e0c61e0684 | 14 | * limitations under the License. |
ganlikun | 0:20e0c61e0684 | 15 | */ |
ganlikun | 0:20e0c61e0684 | 16 | #include "drivers/InterruptIn.h" |
ganlikun | 0:20e0c61e0684 | 17 | |
ganlikun | 0:20e0c61e0684 | 18 | #if DEVICE_INTERRUPTIN |
ganlikun | 0:20e0c61e0684 | 19 | |
ganlikun | 0:20e0c61e0684 | 20 | namespace mbed { |
ganlikun | 0:20e0c61e0684 | 21 | |
ganlikun | 0:20e0c61e0684 | 22 | InterruptIn::InterruptIn(PinName pin) : gpio(), |
ganlikun | 0:20e0c61e0684 | 23 | gpio_irq(), |
ganlikun | 0:20e0c61e0684 | 24 | _rise(NULL), |
ganlikun | 0:20e0c61e0684 | 25 | _fall(NULL) { |
ganlikun | 0:20e0c61e0684 | 26 | // No lock needed in the constructor |
ganlikun | 0:20e0c61e0684 | 27 | |
ganlikun | 0:20e0c61e0684 | 28 | gpio_irq_init(&gpio_irq, pin, (&InterruptIn::_irq_handler), (uint32_t)this); |
ganlikun | 0:20e0c61e0684 | 29 | gpio_init_in(&gpio, pin); |
ganlikun | 0:20e0c61e0684 | 30 | } |
ganlikun | 0:20e0c61e0684 | 31 | |
ganlikun | 0:20e0c61e0684 | 32 | InterruptIn::~InterruptIn() { |
ganlikun | 0:20e0c61e0684 | 33 | // No lock needed in the destructor |
ganlikun | 0:20e0c61e0684 | 34 | gpio_irq_free(&gpio_irq); |
ganlikun | 0:20e0c61e0684 | 35 | } |
ganlikun | 0:20e0c61e0684 | 36 | |
ganlikun | 0:20e0c61e0684 | 37 | int InterruptIn::read() { |
ganlikun | 0:20e0c61e0684 | 38 | // Read only |
ganlikun | 0:20e0c61e0684 | 39 | return gpio_read(&gpio); |
ganlikun | 0:20e0c61e0684 | 40 | } |
ganlikun | 0:20e0c61e0684 | 41 | |
ganlikun | 0:20e0c61e0684 | 42 | void InterruptIn::mode(PinMode pull) { |
ganlikun | 0:20e0c61e0684 | 43 | core_util_critical_section_enter(); |
ganlikun | 0:20e0c61e0684 | 44 | gpio_mode(&gpio, pull); |
ganlikun | 0:20e0c61e0684 | 45 | core_util_critical_section_exit(); |
ganlikun | 0:20e0c61e0684 | 46 | } |
ganlikun | 0:20e0c61e0684 | 47 | |
ganlikun | 0:20e0c61e0684 | 48 | void InterruptIn::rise(Callback<void()> func) { |
ganlikun | 0:20e0c61e0684 | 49 | core_util_critical_section_enter(); |
ganlikun | 0:20e0c61e0684 | 50 | if (func) { |
ganlikun | 0:20e0c61e0684 | 51 | _rise = func; |
ganlikun | 0:20e0c61e0684 | 52 | gpio_irq_set(&gpio_irq, IRQ_RISE, 1); |
ganlikun | 0:20e0c61e0684 | 53 | } else { |
ganlikun | 0:20e0c61e0684 | 54 | _rise = NULL; |
ganlikun | 0:20e0c61e0684 | 55 | gpio_irq_set(&gpio_irq, IRQ_RISE, 0); |
ganlikun | 0:20e0c61e0684 | 56 | } |
ganlikun | 0:20e0c61e0684 | 57 | core_util_critical_section_exit(); |
ganlikun | 0:20e0c61e0684 | 58 | } |
ganlikun | 0:20e0c61e0684 | 59 | |
ganlikun | 0:20e0c61e0684 | 60 | void InterruptIn::fall(Callback<void()> func) { |
ganlikun | 0:20e0c61e0684 | 61 | core_util_critical_section_enter(); |
ganlikun | 0:20e0c61e0684 | 62 | if (func) { |
ganlikun | 0:20e0c61e0684 | 63 | _fall = func; |
ganlikun | 0:20e0c61e0684 | 64 | gpio_irq_set(&gpio_irq, IRQ_FALL, 1); |
ganlikun | 0:20e0c61e0684 | 65 | } else { |
ganlikun | 0:20e0c61e0684 | 66 | _fall = NULL; |
ganlikun | 0:20e0c61e0684 | 67 | gpio_irq_set(&gpio_irq, IRQ_FALL, 0); |
ganlikun | 0:20e0c61e0684 | 68 | } |
ganlikun | 0:20e0c61e0684 | 69 | core_util_critical_section_exit(); |
ganlikun | 0:20e0c61e0684 | 70 | } |
ganlikun | 0:20e0c61e0684 | 71 | |
ganlikun | 0:20e0c61e0684 | 72 | void InterruptIn::_irq_handler(uint32_t id, gpio_irq_event event) { |
ganlikun | 0:20e0c61e0684 | 73 | InterruptIn *handler = (InterruptIn*)id; |
ganlikun | 0:20e0c61e0684 | 74 | switch (event) { |
ganlikun | 0:20e0c61e0684 | 75 | case IRQ_RISE: |
ganlikun | 0:20e0c61e0684 | 76 | if (handler->_rise) { |
ganlikun | 0:20e0c61e0684 | 77 | handler->_rise(); |
ganlikun | 0:20e0c61e0684 | 78 | } |
ganlikun | 0:20e0c61e0684 | 79 | break; |
ganlikun | 0:20e0c61e0684 | 80 | case IRQ_FALL: |
ganlikun | 0:20e0c61e0684 | 81 | if (handler->_fall) { |
ganlikun | 0:20e0c61e0684 | 82 | handler->_fall(); |
ganlikun | 0:20e0c61e0684 | 83 | } |
ganlikun | 0:20e0c61e0684 | 84 | break; |
ganlikun | 0:20e0c61e0684 | 85 | case IRQ_NONE: break; |
ganlikun | 0:20e0c61e0684 | 86 | } |
ganlikun | 0:20e0c61e0684 | 87 | } |
ganlikun | 0:20e0c61e0684 | 88 | |
ganlikun | 0:20e0c61e0684 | 89 | void InterruptIn::enable_irq() { |
ganlikun | 0:20e0c61e0684 | 90 | core_util_critical_section_enter(); |
ganlikun | 0:20e0c61e0684 | 91 | gpio_irq_enable(&gpio_irq); |
ganlikun | 0:20e0c61e0684 | 92 | core_util_critical_section_exit(); |
ganlikun | 0:20e0c61e0684 | 93 | } |
ganlikun | 0:20e0c61e0684 | 94 | |
ganlikun | 0:20e0c61e0684 | 95 | void InterruptIn::disable_irq() { |
ganlikun | 0:20e0c61e0684 | 96 | core_util_critical_section_enter(); |
ganlikun | 0:20e0c61e0684 | 97 | gpio_irq_disable(&gpio_irq); |
ganlikun | 0:20e0c61e0684 | 98 | core_util_critical_section_exit(); |
ganlikun | 0:20e0c61e0684 | 99 | } |
ganlikun | 0:20e0c61e0684 | 100 | |
ganlikun | 0:20e0c61e0684 | 101 | InterruptIn::operator int() { |
ganlikun | 0:20e0c61e0684 | 102 | // Underlying call is atomic |
ganlikun | 0:20e0c61e0684 | 103 | return read(); |
ganlikun | 0:20e0c61e0684 | 104 | } |
ganlikun | 0:20e0c61e0684 | 105 | |
ganlikun | 0:20e0c61e0684 | 106 | } // namespace mbed |
ganlikun | 0:20e0c61e0684 | 107 | |
ganlikun | 0:20e0c61e0684 | 108 | #endif |
ganlikun | 0:20e0c61e0684 | 109 |