radio/src/targets/horus/led_driver.cpp

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #include "opentx.h"
  22
  23 void ledInit()
  24 {
  25   GPIO_InitTypeDef GPIO_InitStructure;
  26   GPIO_InitStructure.GPIO_Pin = LED_GPIO_PIN;
  27   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
  28   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz;
  29   GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
  30   GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
  31   GPIO_Init(LED_GPIO, &GPIO_InitStructure);
  32 }
  33
  34 #if defined(PCBX12S)
  35 void ledOff()
  36 {
  37   GPIO_InitTypeDef GPIO_InitStructure;
  38   GPIO_InitStructure.GPIO_Pin = LED_GPIO_PIN;
  39   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN;
  40   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz;
  41   GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
  42   GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
  43   GPIO_Init(LED_GPIO, &GPIO_InitStructure);
  44 }
  45
  46 void ledRed()
  47 {
  48   ledInit();
  49   GPIO_SetBits(LED_GPIO, LED_GPIO_PIN);
  50 }
  51
  52 void ledBlue()
  53 {
  54   ledInit();
  55   GPIO_ResetBits(LED_GPIO, LED_GPIO_PIN);
  56 }
  57 #elif defined(PCBX10)
  58 void ledOff()
  59 {
  60   GPIO_ResetBits(LED_GPIO, LED_GPIO_PIN);
  61 }
  62
  63 void ledRed()
  64 {
  65   ledOff();
  66   GPIO_SetBits(LED_GPIO, LED_RED_GPIO_PIN);
  67 }
  68
  69 void ledGreen()
  70 {
  71   ledOff();
  72   GPIO_SetBits(LED_GPIO, LED_GREEN_GPIO_PIN);
  73 }
  74
  75 void ledBlue()
  76 {
  77   ledOff();
  78   GPIO_SetBits(LED_GPIO, LED_BLUE_GPIO_PIN);
  79 }
  80 #endif