mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

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