Gan likun / The prosthetic control

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?

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