src/main/drivers/inverter.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 <stdbool.h>
  22 #include <stdint.h>
  23
  24 #include "platform.h"
  25
  26 #ifdef USE_INVERTER
  27
  28 #include "io/serial.h" // For SERIAL_PORT_IDENTIFIER_TO_INDEX
  29 #include "drivers/io.h"
  30 #include "drivers/serial.h"
  31
  32 #include "inverter.h"
  33
  34 static const serialPinConfig_t *pSerialPinConfig;
  35
  36 static void inverterSet(int identifier, bool on)
  37 {
  38     IO_t pin = IOGetByTag(pSerialPinConfig->ioTagInverter[SERIAL_PORT_IDENTIFIER_TO_INDEX(identifier)]);
  39
  40     if (pin) {
  41         IOWrite(pin, on);
  42     }
  43 }
  44
  45 static void initInverter(int identifier)
  46 {
  47     int uartIndex = SERIAL_PORT_IDENTIFIER_TO_INDEX(identifier);
  48     IO_t pin = IOGetByTag(pSerialPinConfig->ioTagInverter[uartIndex]);
  49
  50     if (pin) {
  51         IOInit(pin, OWNER_INVERTER, RESOURCE_INDEX(uartIndex));
  52         IOConfigGPIO(pin, IOCFG_OUT_PP);
  53
  54         inverterSet(identifier, false);
  55     }
  56 }
  57
  58 void initInverters(const serialPinConfig_t *serialPinConfigToUse)
  59 {
  60     pSerialPinConfig = serialPinConfigToUse;
  61
  62 #ifdef USE_UART1
  63     initInverter(SERIAL_PORT_USART1);
  64 #endif
  65
  66 #ifdef USE_UART2
  67     initInverter(SERIAL_PORT_USART2);
  68 #endif
  69
  70 #ifdef USE_UART3
  71     initInverter(SERIAL_PORT_USART3);
  72 #endif
  73
  74 #ifdef USE_UART4
  75     initInverter(SERIAL_PORT_UART4);
  76 #endif
  77
  78 #ifdef USE_UART5
  79     initInverter(SERIAL_PORT_UART5);
  80 #endif
  81
  82 #ifdef USE_UART6
  83     initInverter(SERIAL_PORT_USART6);
  84 #endif
  85 }
  86
  87 void enableInverter(USART_TypeDef *USARTx, bool on)
  88 {
  89     int identifier = SERIAL_PORT_NONE;
  90
  91 #ifdef USE_UART1
  92     if (USARTx == USART1) {
  93         identifier = SERIAL_PORT_USART1;
  94     }
  95 #endif
  96
  97 #ifdef USE_UART2
  98     if (USARTx == USART2) {
  99         identifier = SERIAL_PORT_USART2;
 100     }
 101 #endif
 102
 103 #ifdef USE_UART3
 104     if (USARTx == USART3) {
 105         identifier = SERIAL_PORT_USART3;
 106     }
 107 #endif
 108
 109 #ifdef USE_UART4
 110     if (USARTx == UART4) {
 111         identifier = SERIAL_PORT_UART4;
 112     }
 113 #endif
 114
 115 #ifdef USE_UART5
 116     if (USARTx == UART5) {
 117         identifier = SERIAL_PORT_UART5;
 118     }
 119 #endif
 120
 121 #ifdef USE_UART6
 122     if (USARTx == USART6) {
 123         identifier = SERIAL_PORT_USART6;
 124     }
 125 #endif
 126
 127     if (identifier != SERIAL_PORT_NONE) {
 128         inverterSet(identifier, on);
 129     }
 130 }
 131 #endif // USE_INVERTER