radio/src/targets/horus/backlight_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 backlightInit()
  24 {
  25   // PIN init
  26   GPIO_InitTypeDef GPIO_InitStructure;
  27   GPIO_InitStructure.GPIO_Pin = BACKLIGHT_GPIO_PIN;
  28   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
  29   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz;
  30   GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
  31   GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
  32   GPIO_Init(BACKLIGHT_GPIO, &GPIO_InitStructure);
  33   GPIO_PinAFConfig(BACKLIGHT_GPIO, BACKLIGHT_GPIO_PinSource, BACKLIGHT_GPIO_AF);
  34
  35   // TIMER init
  36 #if defined(PCBX12S) && PCBREV >= 13
  37   BACKLIGHT_TIMER->ARR = 100;
  38   BACKLIGHT_TIMER->PSC = BACKLIGHT_TIMER_FREQ / 10000 - 1; // 1kHz
  39   BACKLIGHT_TIMER->CCMR2 = TIM_CCMR2_OC4M_1 | TIM_CCMR2_OC4M_2; // PWM
  40   BACKLIGHT_TIMER->CCER = TIM_CCER_CC4E;
  41   BACKLIGHT_TIMER->CCR4 = 0;
  42   BACKLIGHT_TIMER->EGR = 0;
  43   BACKLIGHT_TIMER->CR1 = TIM_CR1_CEN; // Counter enable
  44 #elif defined(PCBX12S)
  45   BACKLIGHT_TIMER->ARR = 100;
  46   BACKLIGHT_TIMER->PSC = BACKLIGHT_TIMER_FREQ / 10000 - 1; // 1kHz
  47   BACKLIGHT_TIMER->CCMR1 = TIM_CCMR1_OC1M_1 | TIM_CCMR1_OC1M_2; // PWM
  48   BACKLIGHT_TIMER->CCER = TIM_CCER_CC1E | TIM_CCER_CC1NE;
  49   BACKLIGHT_TIMER->CCR1 = 100;
  50   BACKLIGHT_TIMER->EGR = 1;
  51   BACKLIGHT_TIMER->CR1 |= TIM_CR1_CEN; // Counter enable
  52   BACKLIGHT_TIMER->BDTR |= TIM_BDTR_MOE;
  53 #elif defined(PCBX10)
  54   BACKLIGHT_TIMER->ARR = 100;
  55   BACKLIGHT_TIMER->PSC = BACKLIGHT_TIMER_FREQ / 1000000 - 1; // 10kHz (same as FrOS)
  56   BACKLIGHT_TIMER->CCMR2 = TIM_CCMR2_OC3M_1 | TIM_CCMR2_OC3M_2 | TIM_CCMR2_OC3PE; // PWM mode 1
  57   BACKLIGHT_TIMER->CCER = TIM_CCER_CC3E | TIM_CCER_CC3NE;
  58   BACKLIGHT_TIMER->CCR3 = 100;
  59   BACKLIGHT_TIMER->EGR = TIM_EGR_UG;
  60   BACKLIGHT_TIMER->CR1 |= TIM_CR1_CEN; // Counter enable
  61   BACKLIGHT_TIMER->BDTR |= TIM_BDTR_MOE;
  62 #endif
  63 }
  64
  65 void backlightEnable(uint8_t dutyCycle)
  66 {
  67 #if defined(PCBX12S) && PCBREV >= 13
  68   BACKLIGHT_TIMER->CCR4 = dutyCycle;
  69 #elif defined(PCBX12S)
  70   BACKLIGHT_TIMER->CCR1 = BACKLIGHT_LEVEL_MAX - dutyCycle;
  71 #elif defined(PCBX10)
  72   BACKLIGHT_TIMER->CCR3 = BACKLIGHT_LEVEL_MAX - dutyCycle;
  73 #endif
  74
  75   if (dutyCycle == 0) {
  76     BACKLIGHT_TIMER->BDTR &= ~TIM_BDTR_MOE;
  77   }
  78   else if ((BACKLIGHT_TIMER->BDTR & TIM_BDTR_MOE) == 0) {
  79     BACKLIGHT_TIMER->BDTR |= TIM_BDTR_MOE;
  80   }
  81 }