src/main/drivers/io.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include "platform.h"
  22
  23 #include "drivers/io.h"
  24 #include "drivers/io_impl.h"
  25 #include "drivers/rcc.h"
  26
  27 #include "common/utils.h"
  28
  29 // io ports defs are stored in array by index now
  30 struct ioPortDef_s {
  31     rccPeriphTag_t rcc;
  32 };
  33
  34 ioRec_t* IO_Rec(IO_t io)
  35 {
  36     return io;
  37 }
  38
  39 GPIO_TypeDef* IO_GPIO(IO_t io)
  40 {
  41     const ioRec_t *ioRec = IO_Rec(io);
  42     return ioRec->gpio;
  43 }
  44
  45 uint16_t IO_Pin(IO_t io)
  46 {
  47     const ioRec_t *ioRec = IO_Rec(io);
  48     return ioRec->pin;
  49 }
  50
  51 #if defined(STM32F4) || defined(APM32F4)
  52 int IO_EXTI_PortSourceGPIO(IO_t io)
  53 {
  54     return IO_GPIOPortIdx(io);
  55 }
  56 #endif
  57
  58 int IO_GPIO_PortSource(IO_t io)
  59 {
  60     return IO_GPIOPortIdx(io);
  61 }
  62
  63 // zero based pin index
  64 int IO_GPIOPinIdx(IO_t io)
  65 {
  66     if (!io) {
  67         return -1;
  68     }
  69     return 31 - __builtin_clz(IO_Pin(io));
  70 }
  71
  72 #if defined(STM32F4) || defined(APM32F4)
  73 int IO_EXTI_PinSource(IO_t io)
  74 {
  75     return IO_GPIOPinIdx(io);
  76 }
  77 #endif
  78
  79 int IO_GPIO_PinSource(IO_t io)
  80 {
  81     return IO_GPIOPinIdx(io);
  82 }
  83
  84 // claim IO pin, set owner and resources
  85 void IOInit(IO_t io, resourceOwner_e owner, uint8_t index)
  86 {
  87     if (!io) {
  88         return;
  89     }
  90     ioRec_t *ioRec = IO_Rec(io);
  91     ioRec->owner = owner;
  92     ioRec->index = index;
  93 }
  94
  95 void IORelease(IO_t io)
  96 {
  97     if (!io) {
  98         return;
  99     }
 100     ioRec_t *ioRec = IO_Rec(io);
 101     ioRec->owner = OWNER_FREE;
 102 }
 103
 104 resourceOwner_e IOGetOwner(IO_t io)
 105 {
 106     if (!io) {
 107         return OWNER_FREE;
 108     }
 109     const ioRec_t *ioRec = IO_Rec(io);
 110     return ioRec->owner;
 111 }
 112
 113 bool IOIsFreeOrPreinit(IO_t io)
 114 {
 115     resourceOwner_e owner = IOGetOwner(io);
 116
 117     if (owner == OWNER_FREE || owner == OWNER_PREINIT) {
 118         return true;
 119     }
 120
 121     return false;
 122 }
 123
 124 #if DEFIO_IO_USED_COUNT
 125 ioRec_t ioRecs[DEFIO_IO_USED_COUNT];
 126 #else
 127 // Avoid -Wpedantic warning
 128 ioRec_t ioRecs[1];
 129 #endif
 130
 131 void IOTraversePins(IOTraverseFuncPtr_t fnPtr)
 132 {
 133     for (int i = 0; i < DEFIO_IO_USED_COUNT; i++) {
 134         fnPtr(&ioRecs[i]);
 135     }
 136 }