radio/src/targets/sky9x/haptic_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 hapticOff()
  24 {
  25   PWM->PWM_DIS = PWM_DIS_CHID2 ;                                          // Disable channel 2
  26   PWM->PWM_OOV &= ~0x00040000 ;   // Force low
  27   PWM->PWM_OSS |= 0x00040000 ;    // Force low
  28 }
  29
  30 // pwmPercent 0-100
  31 void hapticOn( uint32_t pwmPercent )
  32 {
  33   Pwm *pwmptr ;
  34
  35   pwmptr = PWM ;
  36
  37   if (pwmPercent > 100) {
  38     pwmPercent = 100 ;
  39   }
  40
  41   pwmptr->PWM_CH_NUM[2].PWM_CDTYUPD = pwmPercent ;                // Duty
  42   pwmptr->PWM_ENA = PWM_ENA_CHID2 ;                                               // Enable channel 2
  43   pwmptr->PWM_OSC = 0x00040000 ;  // Enable output
  44 }